mpcsa_start.S revision 1.2.4.2
1 1.2.4.2 wrstuden /* 2 1.2.4.2 wrstuden * mpcsa_start.S 3 1.2.4.2 wrstuden * Copyright (c) 2007, S. Kantoluoto <sami.kantoluoto (at) iki.fi> 4 1.2.4.2 wrstuden * All rights reserved. 5 1.2.4.2 wrstuden * 6 1.2.4.2 wrstuden * Based on vx115_vep_start.S 7 1.2.4.2 wrstuden * Copyright (c) 2007, J. Sevy <jsevy (at) cs.drexel.edu> 8 1.2.4.2 wrstuden * 9 1.2.4.2 wrstuden * Based on g42xxeb_start.S 10 1.2.4.2 wrstuden * Copyright (c) 2002, 2003 Genetec Corporation. All rights reserved. 11 1.2.4.2 wrstuden * Written by Hiroyuki Bessho for Genetec Corporation. 12 1.2.4.2 wrstuden * 13 1.2.4.2 wrstuden * Redistribution and use in source and binary forms, with or without 14 1.2.4.2 wrstuden * modification, are permitted provided that the following conditions 15 1.2.4.2 wrstuden * are met: 16 1.2.4.2 wrstuden * 1. Redistributions of source code must retain the above copyright 17 1.2.4.2 wrstuden * notice, this list of conditions and the following disclaimer. 18 1.2.4.2 wrstuden * 2. Redistributions in binary form must reproduce the above copyright 19 1.2.4.2 wrstuden * notice, this list of conditions and the following disclaimer in the 20 1.2.4.2 wrstuden * documentation and/or other materials provided with the distribution. 21 1.2.4.2 wrstuden * 3. The name of Genetec Corporation may not be used to endorse or 22 1.2.4.2 wrstuden * promote products derived from this software without specific prior 23 1.2.4.2 wrstuden * written permission. 24 1.2.4.2 wrstuden * 25 1.2.4.2 wrstuden * THIS SOFTWARE IS PROVIDED BY GENETEC CORPORATION ``AS IS'' AND 26 1.2.4.2 wrstuden * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 27 1.2.4.2 wrstuden * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 28 1.2.4.2 wrstuden * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL GENETEC CORPORATION 29 1.2.4.2 wrstuden * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 30 1.2.4.2 wrstuden * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 31 1.2.4.2 wrstuden * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 32 1.2.4.2 wrstuden * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 33 1.2.4.2 wrstuden * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 34 1.2.4.2 wrstuden * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 35 1.2.4.2 wrstuden * POSSIBILITY OF SUCH DAMAGE. 36 1.2.4.2 wrstuden */ 37 1.2.4.2 wrstuden 38 1.2.4.2 wrstuden #include <machine/asm.h> 39 1.2.4.2 wrstuden #include <arm/armreg.h> 40 1.2.4.2 wrstuden #include <arm/arm32/pte.h> 41 1.2.4.2 wrstuden #include <arm/arm32/pmap.h> /* for PMAP_DOMAIN_KERNEL */ 42 1.2.4.2 wrstuden 43 1.2.4.2 wrstuden #ifndef FLASH_START 44 1.2.4.2 wrstuden #define FLASH_START 0x10020000 45 1.2.4.2 wrstuden #endif 46 1.2.4.2 wrstuden 47 1.2.4.2 wrstuden #ifndef SDRAM_START 48 1.2.4.2 wrstuden #define SDRAM_START 0x20000000 49 1.2.4.2 wrstuden #endif 50 1.2.4.2 wrstuden 51 1.2.4.2 wrstuden #define MODBASE 0x20200000 52 1.2.4.2 wrstuden 53 1.2.4.2 wrstuden /* 54 1.2.4.2 wrstuden * CPWAIT -- Canonical method to wait for CP15 update. 55 1.2.4.2 wrstuden * NOTE: Clobbers the specified temp reg. 56 1.2.4.2 wrstuden * copied from arm/arm/cpufunc_asm_xscale.S 57 1.2.4.2 wrstuden * XXX: better be in a common header file. 58 1.2.4.2 wrstuden */ 59 1.2.4.2 wrstuden #define CPWAIT_BRANCH \ 60 1.2.4.2 wrstuden sub pc, pc, #4 61 1.2.4.2 wrstuden 62 1.2.4.2 wrstuden #define CPWAIT(tmp) \ 63 1.2.4.2 wrstuden mrc p15, 0, tmp, c2, c0, 0 /* arbitrary read of CP15 */ ;\ 64 1.2.4.2 wrstuden mov tmp, tmp /* wait for it to complete */ ;\ 65 1.2.4.2 wrstuden CPWAIT_BRANCH /* branch to next insn */ 66 1.2.4.2 wrstuden 67 1.2.4.2 wrstuden /* 68 1.2.4.2 wrstuden * Kernel start routine for MPCSA board. 69 1.2.4.2 wrstuden * This code is executed from Flash when the bootloader jumps to it. 70 1.2.4.2 wrstuden */ 71 1.2.4.2 wrstuden .text 72 1.2.4.2 wrstuden 73 1.2.4.2 wrstuden .global _C_LABEL(mpcsa_start) 74 1.2.4.2 wrstuden _C_LABEL(mpcsa_start): 75 1.2.4.2 wrstuden 76 1.2.4.2 wrstuden /* make sure we're in supervisor mode */ 77 1.2.4.2 wrstuden mov r0,sp 78 1.2.4.2 wrstuden msr CPSR_c,#I32_bit | F32_bit | PSR_SVC32_MODE 79 1.2.4.2 wrstuden mov sp,r0 80 1.2.4.2 wrstuden 81 1.2.4.2 wrstuden /* move code to RAM */ 82 1.2.4.2 wrstuden ldr r1, Lcopy_size 83 1.2.4.2 wrstuden adr r0, _C_LABEL(mpcsa_start) 84 1.2.4.2 wrstuden add r1, r1, #3 85 1.2.4.2 wrstuden mov r1, r1, LSR #2 /* get size of code in words */ 86 1.2.4.2 wrstuden mov r2, #SDRAM_START 87 1.2.4.2 wrstuden add r2, r2, #0x200000 /* code placed 2MB above kernel base */ 88 1.2.4.2 wrstuden mov r4, r2 89 1.2.4.2 wrstuden 90 1.2.4.2 wrstuden /* copy kernel to RAM */ 91 1.2.4.2 wrstuden 5: ldr r3, [r0], #4 92 1.2.4.2 wrstuden subs r1, r1, #1 93 1.2.4.2 wrstuden str r3, [r2], #4 94 1.2.4.2 wrstuden bhi 5b 95 1.2.4.2 wrstuden 96 1.2.4.2 wrstuden /* jump to RAM */ 97 1.2.4.2 wrstuden ldr r0, Lstart_off 98 1.2.4.2 wrstuden add pc, r4, r0 99 1.2.4.2 wrstuden 100 1.2.4.2 wrstuden 101 1.2.4.2 wrstuden Lcopy_size: .word _edata-_C_LABEL(mpcsa_start) 102 1.2.4.2 wrstuden Lstart_off: .word mpcsa_start_ram-_C_LABEL(mpcsa_start) 103 1.2.4.2 wrstuden 104 1.2.4.2 wrstuden mpcsa_start_ram: 105 1.2.4.2 wrstuden /* 106 1.2.4.2 wrstuden * Kernel is loaded in SDRAM (0x20200000), and is expected to run 107 1.2.4.2 wrstuden * in VA 0xc0200000. 108 1.2.4.2 wrstuden */ 109 1.2.4.2 wrstuden 110 1.2.4.2 wrstuden /* build page table from scratch */ 111 1.2.4.2 wrstuden ldr r0, Lstartup_pagetable 112 1.2.4.2 wrstuden adr r4, mmu_init_table 113 1.2.4.2 wrstuden b 3f 114 1.2.4.2 wrstuden 115 1.2.4.2 wrstuden 2: 116 1.2.4.2 wrstuden str r3, [r0, r2] 117 1.2.4.2 wrstuden add r2, r2, #4 118 1.2.4.2 wrstuden add r3, r3, #(L1_S_SIZE) 119 1.2.4.2 wrstuden adds r1, r1, #-1 120 1.2.4.2 wrstuden bhi 2b 121 1.2.4.2 wrstuden 3: 122 1.2.4.2 wrstuden ldmia r4!, {r1,r2,r3} /* # of sections, PA|attr, VA */ 123 1.2.4.2 wrstuden cmp r1, #0 124 1.2.4.2 wrstuden bne 2b 125 1.2.4.2 wrstuden 126 1.2.4.2 wrstuden 127 1.2.4.2 wrstuden mcr p15, 0, r0, c2, c0, 0 /* Set TTB */ 128 1.2.4.2 wrstuden mcr p15, 0, r0, c8, c7, 0 /* Flush TLB */ 129 1.2.4.2 wrstuden 130 1.2.4.2 wrstuden /* Set the Domain Access register. Very important! */ 131 1.2.4.2 wrstuden mov r0, #((DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL*2)) | DOMAIN_CLIENT) 132 1.2.4.2 wrstuden mcr p15, 0, r0, c3, c0, 0 133 1.2.4.2 wrstuden 134 1.2.4.2 wrstuden /* Enable MMU */ 135 1.2.4.2 wrstuden mrc p15, 0, r0, c1, c0, 0 136 1.2.4.2 wrstuden orr r0, r0, #CPU_CONTROL_MMU_ENABLE 137 1.2.4.2 wrstuden mcr p15, 0, r0, c1, c0, 0 138 1.2.4.2 wrstuden CPWAIT(r0) 139 1.2.4.2 wrstuden 140 1.2.4.2 wrstuden /* Jump to kernel code in TRUE VA */ 141 1.2.4.2 wrstuden adr r0, Lstart 142 1.2.4.2 wrstuden ldr pc, [r0] 143 1.2.4.2 wrstuden 144 1.2.4.2 wrstuden Lstart: 145 1.2.4.2 wrstuden .word start 146 1.2.4.2 wrstuden 147 1.2.4.2 wrstuden 148 1.2.4.2 wrstuden #define MMU_INIT(va,pa,n_sec,attr) \ 149 1.2.4.2 wrstuden .word n_sec ;\ 150 1.2.4.2 wrstuden .word 4*((va)>>L1_S_SHIFT) ;\ 151 1.2.4.2 wrstuden .word (pa) | (attr) 152 1.2.4.2 wrstuden 153 1.2.4.2 wrstuden #define STARTUP_PAGETABLE_ADDR 0x20100000 + 0x4000 154 1.2.4.2 wrstuden 155 1.2.4.2 wrstuden Lstartup_pagetable: 156 1.2.4.2 wrstuden .word STARTUP_PAGETABLE_ADDR 157 1.2.4.2 wrstuden 158 1.2.4.2 wrstuden mmu_init_table: 159 1.2.4.2 wrstuden /* fill all table VA==PA */ 160 1.2.4.2 wrstuden MMU_INIT(0x00000000, 0x00000000, 1<<(32-L1_S_SHIFT), L1_TYPE_S|L1_S_AP(AP_KRW)) 161 1.2.4.2 wrstuden /* map in peripheral space */ 162 1.2.4.2 wrstuden MMU_INIT(0xfff00000, 0xfff00000, 1, L1_TYPE_S|L1_S_AP(AP_KRW)) 163 1.2.4.2 wrstuden /* map SDRAM VA==PA, WT cacheable */ 164 1.2.4.2 wrstuden MMU_INIT(0x20100000, 0x20100000, 63, L1_TYPE_S|L1_S_C|L1_S_AP(AP_KRW)) 165 1.2.4.2 wrstuden /* map VA 0xc0000000..0xc0efffff to PA 0x20100000..0x23ffffff */ 166 1.2.4.2 wrstuden MMU_INIT(0xc0000000, 0x20000000, 63, L1_TYPE_S|L1_S_C|L1_S_AP(AP_KRW)) 167 1.2.4.2 wrstuden .word 0 /* end of table */ 168 1.2.4.2 wrstuden 169 1.2.4.2 wrstuden .align 7 170 1.2.4.2 wrstuden jme_module_header: 171 1.2.4.2 wrstuden .word 0xe990510e /* magic number */ 172 1.2.4.2 wrstuden .string "NetBSD/mpcsa\0\0\0" /* module name */ 173 1.2.4.2 wrstuden .short 0 /* build flags */ 174 1.2.4.2 wrstuden .short 0 /* flags */ 175 1.2.4.2 wrstuden .word 0 /* version */ 176 1.2.4.2 wrstuden .word 0 /* compile / link timestamp */ 177 1.2.4.2 wrstuden .word MODBASE /* pointer to init routine */ 178 1.2.4.2 wrstuden .word MODBASE /* start address */ 179 1.2.4.2 wrstuden .word (_edata-(_C_LABEL(mpcsa_start))) /* length of module */ 180 1.2.4.2 wrstuden .word (jme_module_header-_C_LABEL(mpcsa_start)+MODBASE) /* back pointer to module struct*/ 181 1.2.4.2 wrstuden .word 0 /* data pointer (ignored but SBZ)*/ 182 1.2.4.2 wrstuden .word 0 /* data length (ignored but SBZ)*/ 183 1.2.4.2 wrstuden .word 0x20200000 /* alternate address */ 184 1.2.4.2 wrstuden .word 0 /* reserved, SBZ */ 185 1.2.4.2 wrstuden 186 1.2.4.2 wrstuden jme_kmodule_header: 187 1.2.4.2 wrstuden .word 0xe000301e /* magic number */ 188 1.2.4.2 wrstuden .string "JME kernel\0\0\0\0\0" /* module name */ 189 1.2.4.2 wrstuden .short 0 /* build flags */ 190 1.2.4.2 wrstuden .short 0 /* flags */ 191 1.2.4.2 wrstuden .word 0 /* version */ 192 1.2.4.2 wrstuden .word 0 /* compile / link timestamp */ 193 1.2.4.2 wrstuden .word MODBASE /* pointer to init routine */ 194 1.2.4.2 wrstuden .word MODBASE /* start address */ 195 1.2.4.2 wrstuden .word (_edata-(_C_LABEL(mpcsa_start))) /* length of module */ 196 1.2.4.2 wrstuden .word (jme_kmodule_header-_C_LABEL(mpcsa_start)+MODBASE) /* back pointer to module struct*/ 197 1.2.4.2 wrstuden .word 0 /* data pointer (ignored but SBZ)*/ 198 1.2.4.2 wrstuden .word 0 /* data length (ignored but SBZ)*/ 199 1.2.4.2 wrstuden .word 0x20200000 /* alternate address */ 200 1.2.4.2 wrstuden .word 0 /* reserved, SBZ */ 201
Indexes created Tue Oct 21 07:10:13 GMT 2025