2 * Copyright (C) 2013-2014 Synopsys, Inc. All rights reserved.
4 * SPDX-License-Identifier: GPL-2.0+
7 #include <asm-offsets.h>
9 #include <linux/linkage.h>
10 #include <asm/arcregs.h>
13 * Note on the LD/ST addressing modes with address register write-back
17 * LD.a reg1, [reg2, x] => Pre Incr
18 * Eff Addr for load = [reg2 + x]
20 * LD.ab reg1, [reg2, x] => Post Incr
21 * Eff Addr for load = [reg2]
61 /* saving %r0 to reg->r0 in advance since we read %ecr into it */
63 lr %r0, [%ecr] /* all stack addressing is manual so far */
66 /* now move %sp to reg->r0 position so we can do "push" automatically */
82 .macro SAVE_EXCEPTION_SOURCE
84 /* If MMU exists exception faulting address is loaded in EFA reg */
87 /* Otherwise in ERET (exception return) reg */
93 /* Setup interrupt vector base that matches "__text_start" */
94 sr __ivt_start, [ARC_AUX_INTR_VEC_BASE]
96 /* Setup stack pointer */
97 mov %sp, CONFIG_SYS_INIT_SP_ADDR
106 brlt %r0, %r1, clear_bss
108 /* Zero the one and only argument of "board_init_f" */
115 SAVE_EXCEPTION_SOURCE
118 ENDPROC(memory_error)
120 ENTRY(instruction_error)
122 SAVE_EXCEPTION_SOURCE
124 j do_instruction_error
125 ENDPROC(instruction_error)
127 ENTRY(interrupt_handler)
128 /* Todo - save and restore CPU context when interrupts will be in use */
129 bl do_interrupt_handler
131 ENDPROC(interrupt_handler)
133 ENTRY(EV_MachineCheck)
135 SAVE_EXCEPTION_SOURCE
137 j do_machine_check_fault
138 ENDPROC(EV_MachineCheck)
154 SAVE_EXCEPTION_SOURCE
156 j do_tlb_prot_violation
162 j do_privilege_violation
163 ENDPROC(EV_PrivilegeV)
175 ENDPROC(EV_Extension)
178 * void relocate_code (addr_sp, gd, addr_moni)
180 * This "function" does not return, instead it continues in RAM
181 * after relocating the monitor code.
189 * r0-r12 might be clobbered by C functions
190 * so we use r13-r16 for storage here
192 mov %r13, %r0 /* save addr_sp */
193 mov %r14, %r1 /* save addr of gd */
194 mov %r15, %r2 /* save addr of destination */
196 mov %r16, %r2 /* %r9 - relocation offset */
197 sub %r16, %r16, __image_copy_start
199 /* Set up the stack */
204 /* Check if monitor is loaded right in place for relocation */
205 mov %r0, __image_copy_start
206 cmp %r0, %r15 /* skip relocation if code loaded */
207 bz do_board_init_r /* in target location already */
209 /* Copy data (__image_copy_start - __image_copy_end) to new location */
211 mov %r2, __image_copy_end
212 sub %r2, %r2, %r0 /* r3 <- amount of bytes to copy */
213 asr %r2, %r2, 2 /* r3 <- amount of words to copy */
220 /* Fix relocations related issues */
221 bl do_elf_reloc_fixups
222 #ifndef CONFIG_SYS_ICACHE_OFF
223 bl invalidate_icache_all
225 #ifndef CONFIG_SYS_DCACHE_OFF
229 /* Update position of intterupt vector table */
230 lr %r0, [ARC_AUX_INTR_VEC_BASE] /* Read current position */
231 add %r0, %r0, %r16 /* Update address */
232 sr %r0, [ARC_AUX_INTR_VEC_BASE] /* Write new position */
235 /* Prepare for exection of "board_init_r" in relocated monitor */
236 mov %r2, board_init_r /* old address of "board_init_r()" */
237 add %r2, %r2, %r16 /* new address of "board_init_r()" */
238 mov %r0, %r14 /* 1-st parameter: gd_t */
239 mov %r1, %r15 /* 2-nd parameter: dest_addr */
241 ENDPROC(relocate_code)