git.sur5r.net Git - u-boot/blob - cpu/arm720t/cpu.c

   1 /*
   2  * (C) Copyright 2002
   3  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
   4  * Marius Groeger <mgroeger@sysgo.de>
   5  *
   6  * (C) Copyright 2002
   7  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
   8  * Alex Zuepke <azu@sysgo.de>
   9  *
  10  * See file CREDITS for list of people who contributed to this
  11  * project.
  12  *
  13  * This program is free software; you can redistribute it and/or
  14  * modify it under the terms of the GNU General Public License as
  15  * published by the Free Software Foundation; either version 2 of
  16  * the License, or (at your option) any later version.
  17  *
  18  * This program is distributed in the hope that it will be useful,
  19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  21  * GNU General Public License for more details.
  22  *
  23  * You should have received a copy of the GNU General Public License
  24  * along with this program; if not, write to the Free Software
  25  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  26  * MA 02111-1307 USA
  27  */
  28
  29 /*
  30  * CPU specific code
  31  */
  32
  33 #include <common.h>
  34 #include <command.h>
  35 #include <clps7111.h>
  36 #include <asm/hardware.h>
  37 #include <asm/system.h>
  38
  39 int cpu_init (void)
  40 {
  41         /*
  42          * setup up stacks if necessary
  43          */
  44 #ifdef CONFIG_USE_IRQ
  45         IRQ_STACK_START = _armboot_start - CONFIG_SYS_MALLOC_LEN - CONFIG_SYS_GBL_DATA_SIZE - 4;
  46         FIQ_STACK_START = IRQ_STACK_START - CONFIG_STACKSIZE_IRQ;
  47 #endif
  48         return 0;
  49 }
  50
  51 int cleanup_before_linux (void)
  52 {
  53         /*
  54          * this function is called just before we call linux
  55          * it prepares the processor for linux
  56          *
  57          * we turn off caches etc ...
  58          * and we set the CPU-speed to 73 MHz - see start.S for details
  59          */
  60
  61 #if defined(CONFIG_IMPA7) || defined(CONFIG_EP7312) || defined(CONFIG_ARMADILLO)
  62         unsigned long i;
  63
  64         disable_interrupts ();
  65
  66         /* turn off I-cache */
  67         asm ("mrc p15, 0, %0, c1, c0, 0":"=r" (i));
  68         i &= ~0x1000;
  69         asm ("mcr p15, 0, %0, c1, c0, 0": :"r" (i));
  70
  71         /* flush I-cache */
  72         asm ("mcr p15, 0, %0, c7, c5, 0": :"r" (i));
  73 #ifdef CONFIG_ARM7_REVD
  74         /* go to high speed */
  75         IO_SYSCON3 = (IO_SYSCON3 & ~CLKCTL) | CLKCTL_73;
  76 #endif
  77 #elif defined(CONFIG_NETARM) || defined(CONFIG_S3C4510B) || defined(CONFIG_LPC2292)
  78         disable_interrupts ();
  79         /* Nothing more needed */
  80 #elif defined(CONFIG_INTEGRATOR) && defined(CONFIG_ARCH_INTEGRATOR)
  81         /* No cleanup before linux for IntegratorAP/CM720T as yet */
  82 #else
  83 #error No cleanup_before_linux() defined for this CPU type
  84 #endif
  85         return 0;
  86 }
  87
  88 int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
  89 {
  90         disable_interrupts ();
  91         reset_cpu (0);
  92         /*NOTREACHED*/
  93         return (0);
  94 }
  95
  96 /*
  97  * Instruction and Data cache enable and disable functions
  98  *
  99  */
 100
 101 #if defined(CONFIG_IMPA7) || defined(CONFIG_EP7312) || defined(CONFIG_NETARM) || defined(CONFIG_ARMADILLO)
 102 static void cp_delay (void)
 103 {
 104         volatile int i;
 105
 106         /* copro seems to need some delay between reading and writing */
 107         for (i = 0; i < 100; i++);
 108 }
 109
 110 void icache_enable (void)
 111 {
 112         ulong reg;
 113
 114         reg = get_cr ();
 115         cp_delay ();
 116         set_cr (reg | CR_C);
 117 }
 118
 119 void icache_disable (void)
 120 {
 121         ulong reg;
 122
 123         reg = get_cr ();
 124         cp_delay ();
 125         set_cr (reg & ~CR_C);
 126 }
 127
 128 int icache_status (void)
 129 {
 130         return (get_cr () & CR_C) != 0;
 131 }
 132
 133 void dcache_enable (void)
 134 {
 135         ulong reg;
 136
 137         reg = get_cr ();
 138         cp_delay ();
 139         set_cr (reg | CR_C);
 140 }
 141
 142 void dcache_disable (void)
 143 {
 144         ulong reg;
 145
 146         reg = get_cr ();
 147         cp_delay ();
 148         set_cr (reg & ~CR_C);
 149 }
 150
 151 int dcache_status (void)
 152 {
 153         return (get_cr () & CR_C) != 0;
 154 }
 155 #elif defined(CONFIG_INTEGRATOR) && defined(CONFIG_ARCH_INTEGRATOR)
 156         /* No specific cache setup for IntegratorAP/CM720T as yet */
 157         void icache_enable (void)
 158         {
 159         }
 160 #endif