1/* 2 * Copyright (C) 2003 Josef Baumgartner <josef.baumgartner@telex.de> 3 * Based on code from Bernhard Kuhn <bkuhn@metrowerks.com> 4 * 5 * See file CREDITS for list of people who contributed to this 6 * project. 7 * 8 * This program is free software; you can redistribute it and/or 9 * modify it under the terms of the GNU General Public License as 10 * published by the Free Software Foundation; either version 2 of 11 * the License, or (at your option) any later version. 12 * 13 * This program is distributed in the hope that it will be useful, 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16 * GNU General Public License for more details. 17 * 18 * You should have received a copy of the GNU General Public License 19 * along with this program; if not, write to the Free Software 20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 21 * MA 02111-1307 USA 22 */ 23 24#include <asm-offsets.h> 25#include <config.h> 26#include <timestamp.h> 27#include "version.h" 28#include <asm/cache.h> 29 30#ifndef CONFIG_IDENT_STRING 31#define CONFIG_IDENT_STRING "" 32#endif 33 34#define _START _start 35#define _FAULT _fault 36 37#define SAVE_ALL \ 38 move.w #0x2700,%sr; /* disable intrs */ \ 39 subl #60,%sp; /* space for 15 regs */ \ 40 moveml %d0-%d7/%a0-%a6,%sp@; 41 42#define RESTORE_ALL \ 43 moveml %sp@,%d0-%d7/%a0-%a6; \ 44 addl #60,%sp; /* space for 15 regs */ \ 45 rte; 46 47.text 48/* 49 * Vector table. This is used for initial platform startup. 50 * These vectors are to catch any un-intended traps. 51 */ 52_vectors: 53 54INITSP: .long 0x00000000 /* Initial SP */ 55INITPC: .long _START /* Initial PC */ 56vector02: .long _FAULT /* Access Error */ 57vector03: .long _FAULT /* Address Error */ 58vector04: .long _FAULT /* Illegal Instruction */ 59vector05: .long _FAULT /* Reserved */ 60vector06: .long _FAULT /* Reserved */ 61vector07: .long _FAULT /* Reserved */ 62vector08: .long _FAULT /* Privilege Violation */ 63vector09: .long _FAULT /* Trace */ 64vector0A: .long _FAULT /* Unimplemented A-Line */ 65vector0B: .long _FAULT /* Unimplemented F-Line */ 66vector0C: .long _FAULT /* Debug Interrupt */ 67vector0D: .long _FAULT /* Reserved */ 68vector0E: .long _FAULT /* Format Error */ 69vector0F: .long _FAULT /* Unitialized Int. */ 70 71/* Reserved */ 72vector10_17: 73.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 74 75vector18: .long _FAULT /* Spurious Interrupt */ 76vector19: .long _FAULT /* Autovector Level 1 */ 77vector1A: .long _FAULT /* Autovector Level 2 */ 78vector1B: .long _FAULT /* Autovector Level 3 */ 79vector1C: .long _FAULT /* Autovector Level 4 */ 80vector1D: .long _FAULT /* Autovector Level 5 */ 81vector1E: .long _FAULT /* Autovector Level 6 */ 82vector1F: .long _FAULT /* Autovector Level 7 */ 83 84/* TRAP #0 - #15 */ 85vector20_2F: 86.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 87.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 88 89/* Reserved */ 90vector30_3F: 91.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 92.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 93 94vector64_127: 95.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 96.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 97.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 98.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 99.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 100.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 101.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 102.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 103 104vector128_191: 105.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 106.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 107.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 108.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 109.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 110.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 111.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 112.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 113 114vector192_255: 115.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 116.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 117.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 118.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 119.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 120.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 121.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 122.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT 123 124 .text 125 126 .globl _start 127_start: 128 nop 129 nop 130 move.w #0x2700,%sr /* Mask off Interrupt */ 131 132 /* Set vector base register at the beginning of the Flash */ 133 move.l #CONFIG_SYS_FLASH_BASE, %d0 134 movec %d0, %VBR 135 136 move.l #(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_RAM_CTRL), %d0 137 movec %d0, %RAMBAR1 138 139 /* invalidate and disable cache */ 140 move.l #CF_CACR_CINV, %d0 /* Invalidate cache cmd */ 141 movec %d0, %CACR /* Invalidate cache */ 142 nop 143 move.l #0, %d0 144 movec %d0, %ACR0 145 movec %d0, %ACR1 146 147 /* initialize general use internal ram */ 148 move.l #0, %d0 149 move.l #(ICACHE_STATUS), %a1 /* icache */ 150 move.l #(DCACHE_STATUS), %a2 /* icache */ 151 move.l %d0, (%a1) 152 move.l %d0, (%a2) 153 154 /* set stackpointer to end of internal ram to get some stackspace for the 155 first c-code */ 156 move.l #(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_SP_OFFSET), %sp 157 clr.l %sp@- 158 159 move.l #__got_start, %a5 /* put relocation table address to a5 */ 160 161 bsr cpu_init_f /* run low-level CPU init code (from flash) */ 162 bsr board_init_f /* run low-level board init code (from flash) */ 163 164 /* board_init_f() does not return */ 165 166/*------------------------------------------------------------------------------*/ 167 168/* 169 * void relocate_code (addr_sp, gd, addr_moni) 170 * 171 * This "function" does not return, instead it continues in RAM 172 * after relocating the monitor code. 173 * 174 * r3 = dest 175 * r4 = src 176 * r5 = length in bytes 177 * r6 = cachelinesize 178 */ 179 .globl relocate_code 180relocate_code: 181 link.w %a6,#0 182 move.l 8(%a6), %sp /* set new stack pointer */ 183 184 move.l 12(%a6), %d0 /* Save copy of Global Data pointer */ 185 move.l 16(%a6), %a0 /* Save copy of Destination Address */ 186 187 move.l #CONFIG_SYS_MONITOR_BASE, %a1 188 move.l #__init_end, %a2 189 move.l %a0, %a3 190 191 /* copy the code to RAM */ 1921: 193 move.l (%a1)+, (%a3)+ 194 cmp.l %a1,%a2 195 bgt.s 1b 196 197/* 198 * We are done. Do not return, instead branch to second part of board 199 * initialization, now running from RAM. 200 */ 201 move.l %a0, %a1 202 add.l #(in_ram - CONFIG_SYS_MONITOR_BASE), %a1 203 jmp (%a1) 204 205in_ram: 206 207clear_bss: 208 /* 209 * Now clear BSS segment 210 */ 211 move.l %a0, %a1 212 add.l #(_sbss - CONFIG_SYS_MONITOR_BASE),%a1 213 move.l %a0, %d1 214 add.l #(_ebss - CONFIG_SYS_MONITOR_BASE),%d1 2156: 216 clr.l (%a1)+ 217 cmp.l %a1,%d1 218 bgt.s 6b 219 220 /* 221 * fix got table in RAM 222 */ 223 move.l %a0, %a1 224 add.l #(__got_start - CONFIG_SYS_MONITOR_BASE),%a1 225 move.l %a1,%a5 /* * fix got pointer register a5 */ 226 227 move.l %a0, %a2 228 add.l #(__got_end - CONFIG_SYS_MONITOR_BASE),%a2 229 2307: 231 move.l (%a1),%d1 232 sub.l #_start,%d1 233 add.l %a0,%d1 234 move.l %d1,(%a1)+ 235 cmp.l %a2, %a1 236 bne 7b 237 238 /* calculate relative jump to board_init_r in ram */ 239 move.l %a0, %a1 240 add.l #(board_init_r - CONFIG_SYS_MONITOR_BASE), %a1 241 242 /* set parameters for board_init_r */ 243 move.l %a0,-(%sp) /* dest_addr */ 244 move.l %d0,-(%sp) /* gd */ 245 jsr (%a1) 246 247/*------------------------------------------------------------------------------*/ 248/* exception code */ 249 .globl _fault 250_fault: 251 jmp _fault 252 .globl _exc_handler 253 254_exc_handler: 255 SAVE_ALL 256 movel %sp,%sp@- 257 bsr exc_handler 258 addql #4,%sp 259 RESTORE_ALL 260 261 .globl _int_handler 262_int_handler: 263 SAVE_ALL 264 movel %sp,%sp@- 265 bsr int_handler 266 addql #4,%sp 267 RESTORE_ALL 268 269/*------------------------------------------------------------------------------*/ 270 271 .globl version_string 272version_string: 273 .ascii U_BOOT_VERSION 274 .ascii " (", U_BOOT_DATE, " - ", U_BOOT_TIME, ")" 275 .ascii CONFIG_IDENT_STRING, "\0" 276 .align 4 277