| /* |
| * Copyright (C) 2009 Wind River Systems Inc |
| * Implemented by fredrik.markstrom@gmail.com and ivarholmqvist@gmail.com |
| * Copyright (C) 2004 Microtronix Datacom Ltd |
| * Copyright (C) 2001 Vic Phillips, Microtronix Datacom Ltd. |
| * |
| * Based on head.S for Altera's Excalibur development board with nios processor |
| * |
| * Based on the following from the Excalibur sdk distribution: |
| * NA_MemoryMap.s, NR_JumpToStart.s, NR_Setup.s, NR_CWPManager.s |
| * |
| * This file is subject to the terms and conditions of the GNU General Public |
| * License. See the file "COPYING" in the main directory of this archive |
| * for more details. |
| */ |
| |
| #include <linux/init.h> |
| #include <linux/linkage.h> |
| #include <asm/thread_info.h> |
| #include <asm/processor.h> |
| #include <asm/cache.h> |
| #include <asm/page.h> |
| #include <asm/asm-offsets.h> |
| #include <asm/asm-macros.h> |
| |
| /* |
| * ZERO_PAGE is a special page that is used for zero-initialized |
| * data and COW. |
| */ |
| .data |
| .global empty_zero_page |
| .align 12 |
| empty_zero_page: |
| .space PAGE_SIZE |
| |
| /* |
| * This global variable is used as an extension to the nios' |
| * STATUS register to emulate a user/supervisor mode. |
| */ |
| .data |
| .align 2 |
| .set noat |
| |
| .global _current_thread |
| _current_thread: |
| .long 0 |
| /* |
| * Input(s): passed from u-boot |
| * r4 - Optional pointer to a board information structure. |
| * r5 - Optional pointer to the physical starting address of the init RAM |
| * disk. |
| * r6 - Optional pointer to the physical ending address of the init RAM |
| * disk. |
| * r7 - Optional pointer to the physical starting address of any kernel |
| * command-line parameters. |
| */ |
| |
| /* |
| * First executable code - detected and jumped to by the ROM bootstrap |
| * if the code resides in flash (looks for "Nios" at offset 0x0c from |
| * the potential executable image). |
| */ |
| __HEAD |
| ENTRY(_start) |
| wrctl status, r0 /* Disable interrupts */ |
| |
| /* Initialize all cache lines within the instruction cache */ |
| movia r1, NIOS2_ICACHE_SIZE |
| movui r2, NIOS2_ICACHE_LINE_SIZE |
| |
| icache_init: |
| initi r1 |
| sub r1, r1, r2 |
| bgt r1, r0, icache_init |
| br 1f |
| |
| /* |
| * This is the default location for the exception handler. Code in jump |
| * to our handler |
| */ |
| ENTRY(exception_handler_hook) |
| movia r24, inthandler |
| jmp r24 |
| |
| ENTRY(fast_handler) |
| nextpc et |
| helper: |
| stw r3, r3save - helper(et) |
| |
| rdctl r3 , pteaddr |
| srli r3, r3, 12 |
| slli r3, r3, 2 |
| movia et, pgd_current |
| |
| ldw et, 0(et) |
| add r3, et, r3 |
| ldw et, 0(r3) |
| |
| rdctl r3, pteaddr |
| andi r3, r3, 0xfff |
| add et, r3, et |
| ldw et, 0(et) |
| wrctl tlbacc, et |
| nextpc et |
| helper2: |
| ldw r3, r3save - helper2(et) |
| subi ea, ea, 4 |
| eret |
| r3save: |
| .word 0x0 |
| ENTRY(fast_handler_end) |
| |
| 1: |
| /* |
| * After the instruction cache is initialized, the data cache must |
| * also be initialized. |
| */ |
| movia r1, NIOS2_DCACHE_SIZE |
| movui r2, NIOS2_DCACHE_LINE_SIZE |
| |
| dcache_init: |
| initd 0(r1) |
| sub r1, r1, r2 |
| bgt r1, r0, dcache_init |
| |
| nextpc r1 /* Find out where we are */ |
| chkadr: |
| movia r2, chkadr |
| beq r1, r2,finish_move /* We are running in RAM done */ |
| addi r1, r1,(_start - chkadr) /* Source */ |
| movia r2, _start /* Destination */ |
| movia r3, __bss_start /* End of copy */ |
| |
| loop_move: /* r1: src, r2: dest, r3: last dest */ |
| ldw r8, 0(r1) /* load a word from [r1] */ |
| stw r8, 0(r2) /* store a word to dest [r2] */ |
| flushd 0(r2) /* Flush cache for safety */ |
| addi r1, r1, 4 /* inc the src addr */ |
| addi r2, r2, 4 /* inc the dest addr */ |
| blt r2, r3, loop_move |
| |
| movia r1, finish_move /* VMA(_start)->l1 */ |
| jmp r1 /* jmp to _start */ |
| |
| finish_move: |
| |
| /* Mask off all possible interrupts */ |
| wrctl ienable, r0 |
| |
| /* Clear .bss */ |
| movia r2, __bss_start |
| movia r1, __bss_stop |
| 1: |
| stb r0, 0(r2) |
| addi r2, r2, 1 |
| bne r1, r2, 1b |
| |
| movia r1, init_thread_union /* set stack at top of the task union */ |
| addi sp, r1, THREAD_SIZE |
| movia r2, _current_thread /* Remember current thread */ |
| stw r1, 0(r2) |
| |
| movia r1, nios2_boot_init /* save args r4-r7 passed from u-boot */ |
| callr r1 |
| |
| movia r1, start_kernel /* call start_kernel as a subroutine */ |
| callr r1 |
| |
| /* If we return from start_kernel, break to the oci debugger and |
| * buggered we are. |
| */ |
| break |
| |
| /* End of startup code */ |
| .set at |
