arch/m68k/cpu/mcf532x/start.S

   1 /* SPDX-License-Identifier: GPL-2.0+ */
   2 /*
   3  * Copyright (C) 2003   Josef Baumgartner <josef.baumgartner@telex.de>
   4  * Based on code from Bernhard Kuhn <bkuhn@metrowerks.com>
   5  *
   6  * (C) Copyright 2004-2008 Freescale Semiconductor, Inc.
   7  * TsiChung Liew (Tsi-Chung.Liew@freescale.com)
   8  */
   9
  10 #include <asm-offsets.h>
  11 #include <config.h>
  12 #include <asm/cache.h>
  13
  14 #define _START  _start
  15 #define _FAULT  _fault
  16
  17 #define SAVE_ALL                                                \
  18         move.w  #0x2700,%sr;            /* disable intrs */     \
  19         subl    #60,%sp;                /* space for 15 regs */ \
  20         moveml  %d0-%d7/%a0-%a6,%sp@;
  21
  22 #define RESTORE_ALL                                             \
  23         moveml  %sp@,%d0-%d7/%a0-%a6;                           \
  24         addl    #60,%sp;                /* space for 15 regs */ \
  25         rte;
  26
  27 #if !defined(CONFIG_MONITOR_IS_IN_RAM)
  28
  29 .text
  30
  31 /*
  32  * Vector table. This is used for initial platform startup.
  33  * These vectors are to catch any un-intended traps.
  34  */
  35 _vectors:
  36 INITSP: .long   0x00000000              /* Initial SP   */
  37 INITPC: .long   _START                  /* Initial PC           */
  38
  39 vector02_0F:
  40 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  41 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  42
  43 /* Reserved */
  44 vector10_17:
  45 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  46
  47 vector18_1F:
  48 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  49
  50 /* TRAP #0 - #15 */
  51 vector20_2F:
  52 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  53 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  54
  55 /* Reserved     */
  56 vector30_3F:
  57 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  58 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  59
  60 vector64_127:
  61 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  62 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  63 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  64 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  65 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  66 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  67 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  68 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  69
  70 vector128_191:
  71 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  72 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  73 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  74 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  75 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  76 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  77 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  78 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  79
  80 vector192_255:
  81 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  82 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  83 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  84 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  85 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  86 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  87 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  88 .long   _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
  89 #endif /* !defined(CONFIG_MONITOR_IS_IN_RAM) */
  90
  91 .text
  92
  93 .globl _start
  94 _start:
  95         nop
  96         nop
  97         move.w  #0x2700,%sr     /* Mask off Interrupt */
  98
  99 #if !defined(CONFIG_MONITOR_IS_IN_RAM)
 100         /* Set vector base register at the beginning of the Flash */
 101         move.l  #CFG_SYS_FLASH_BASE, %d0
 102         movec   %d0, %VBR
 103 #endif
 104
 105         move.l  #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_INIT_RAM_CTRL), %d0
 106         movec   %d0, %RAMBAR1
 107
 108         /* invalidate and disable cache */
 109         move.l  #CF_CACR_CINVA, %d0             /* Invalidate cache cmd */
 110         movec   %d0, %CACR                      /* Invalidate cache */
 111         move.l  #0, %d0
 112         movec   %d0, %ACR0
 113         movec   %d0, %ACR1
 114
 115 #ifdef CONFIG_MCF5301x
 116         move.l  #(0xFC0a0010), %a0
 117         move.w  (%a0), %d0
 118         and.l   %d0, 0xEFFF
 119
 120         move.w  %d0, (%a0)
 121 #endif
 122
 123         /* initialize general use internal ram */
 124         move.l  #0, %d0
 125         move.l  #(ICACHE_STATUS), %a1   /* icache */
 126         move.l  #(DCACHE_STATUS), %a2   /* icache */
 127         move.l  %d0, (%a1)
 128         move.l  %d0, (%a2)
 129
 130         /* put relocation table address to a5 */
 131         move.l  #__got_start, %a5
 132
 133         /* setup stack initially on top of internal static ram  */
 134         move.l  #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_INIT_RAM_SIZE), %sp
 135
 136         /*
 137          * if configured, malloc_f arena will be reserved first,
 138          * then (and always) gd struct space will be reserved
 139          */
 140         move.l  %sp, -(%sp)
 141         move.l  #board_init_f_alloc_reserve, %a1
 142         jsr     (%a1)
 143
 144         /* update stack and frame-pointers */
 145         move.l  %d0, %sp
 146         move.l  %sp, %fp
 147
 148         /* initialize reserved area */
 149         move.l  %d0, -(%sp)
 150         move.l  #board_init_f_init_reserve, %a1
 151         jsr     (%a1)
 152
 153         /* run low-level CPU init code (from flash) */
 154         move.l  #cpu_init_f, %a1
 155         jsr     (%a1)
 156
 157         /* run low-level board init code (from flash) */
 158         clr.l   %sp@-
 159         move.l #board_init_f, %a1
 160         jsr (%a1)
 161
 162         /* board_init_f() does not return */
 163
 164 /******************************************************************************/
 165
 166 /*
 167  * void relocate_code(addr_sp, gd, addr_moni)
 168  *
 169  * This "function" does not return, instead it continues in RAM
 170  * after relocating the monitor code.
 171  *
 172  * r3 = dest
 173  * r4 = src
 174  * r5 = length in bytes
 175  * r6 = cachelinesize
 176  */
 177 .globl relocate_code
 178 relocate_code:
 179         link.w  %a6,#0
 180         move.l  8(%a6), %sp             /* set new stack pointer */
 181
 182         move.l  12(%a6), %d0            /* Save copy of Global Data pointer */
 183         move.l  16(%a6), %a0            /* Save copy of Destination Address */
 184
 185         move.l  #CONFIG_SYS_MONITOR_BASE, %a1
 186         move.l  #__init_end, %a2
 187         move.l  %a0, %a3
 188
 189         /* copy the code to RAM */
 190 1:
 191         move.l  (%a1)+, (%a3)+
 192         cmp.l   %a1,%a2
 193         bgt.s   1b
 194
 195 /*
 196  * We are done. Do not return, instead branch to second part of board
 197  * initialization, now running from RAM.
 198  */
 199         move.l  %a0, %a1
 200         add.l   #(in_ram - CONFIG_SYS_MONITOR_BASE), %a1
 201         jmp     (%a1)
 202
 203 in_ram:
 204
 205 clear_bss:
 206         /*
 207          * Now clear BSS segment
 208          */
 209         move.l  %a0, %a1
 210         add.l   #(_sbss - CONFIG_SYS_MONITOR_BASE),%a1
 211         move.l  %a0, %d1
 212         add.l   #(_ebss - CONFIG_SYS_MONITOR_BASE),%d1
 213 6:
 214         clr.l   (%a1)+
 215         cmp.l   %a1,%d1
 216         bgt.s   6b
 217
 218         /*
 219          * fix got table in RAM
 220          */
 221         move.l  %a0, %a1
 222         add.l   #(__got_start - CONFIG_SYS_MONITOR_BASE),%a1
 223         move.l  %a1,%a5                 /* fix got pointer register a5 */
 224
 225         move.l  %a0, %a2
 226         add.l   #(__got_end - CONFIG_SYS_MONITOR_BASE),%a2
 227
 228 7:
 229         move.l  (%a1),%d1
 230         sub.l   #_start,%d1
 231         add.l   %a0,%d1
 232         move.l  %d1,(%a1)+
 233         cmp.l   %a2, %a1
 234         bne     7b
 235
 236         /* calculate relative jump to board_init_r in ram */
 237         move.l  %a0, %a1
 238         add.l   #(board_init_r - CONFIG_SYS_MONITOR_BASE), %a1
 239
 240         /* set parameters for board_init_r */
 241         move.l  %a0,-(%sp)              /* dest_addr */
 242         move.l  %d0,-(%sp)              /* gd */
 243         jsr     (%a1)
 244
 245 /******************************************************************************/
 246
 247 /* exception code */
 248 .globl _fault
 249 _fault:
 250         bra _fault
 251
 252 .globl _exc_handler
 253 _exc_handler:
 254         SAVE_ALL
 255         movel   %sp,%sp@-
 256         bsr     exc_handler
 257         addql   #4,%sp
 258         RESTORE_ALL
 259
 260 .globl _int_handler
 261 _int_handler:
 262         SAVE_ALL
 263         movel   %sp,%sp@-
 264         bsr     int_handler
 265         addql   #4,%sp
 266         RESTORE_ALL
 267
 268 /******************************************************************************/
 269
 270 .align 4