Annotation of sys/arch/jornada/jornada/jornada720_start.S.test, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: armish_start.S,v 1.2 2006/05/29 17:30:26 drahn Exp $ */
! 2: /* $NetBSD: iq80321_start.S,v 1.4 2002/10/14 22:32:54 bjh21 Exp $ */
! 3:
! 4: /*
! 5: * Copyright (c) 2002 Wasabi Systems, Inc.
! 6: * All rights reserved.
! 7: *
! 8: * Written by Jason R. Thorpe for Wasabi Systems, Inc.
! 9: *
! 10: * Redistribution and use in source and binary forms, with or without
! 11: * modification, are permitted provided that the following conditions
! 12: * are met:
! 13: * 1. Redistributions of source code must retain the above copyright
! 14: * notice, this list of conditions and the following disclaimer.
! 15: * 2. Redistributions in binary form must reproduce the above copyright
! 16: * notice, this list of conditions and the following disclaimer in the
! 17: * documentation and/or other materials provided with the distribution.
! 18: * 3. All advertising materials mentioning features or use of this software
! 19: * must display the following acknowledgement:
! 20: * This product includes software developed for the NetBSD Project by
! 21: * Wasabi Systems, Inc.
! 22: * 4. The name of Wasabi Systems, Inc. may not be used to endorse
! 23: * or promote products derived from this software without specific prior
! 24: * written permission.
! 25: *
! 26: * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
! 27: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
! 28: * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
! 29: * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC
! 30: * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
! 31: * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
! 32: * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
! 33: * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
! 34: * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
! 35: * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
! 36: * POSSIBILITY OF SUCH DAMAGE.
! 37: */
! 38:
! 39: #include <machine/asm.h>
! 40: #include <arm/armreg.h>
! 41: #include <arm/pte.h>
! 42:
! 43: .section .start,"ax",%progbits
! 44:
! 45: .global _C_LABEL(jornada720_start)
! 46: _C_LABEL(jornada720_start):
! 47: #define notsure
! 48: #ifdef notsure
! 49: /* Put the processer in SVC mode */
! 50: mov r5, sp
! 51: mrs r4, cpsr_all
! 52: bic r4, r4, #31
! 53: orr r4, r4, #(PSR_SVC32_MODE)
! 54: msr cpsr_all, r4
! 55: mov sp, r5
! 56:
! 57: /* Disable PID virtual address mapping */
! 58: mov r4, #0
! 59: mcr 15, 0, r4, c13, c0, 0
! 60: #endif
! 61: #undef notsure
! 62: /*
! 63: * We will go ahead and disable the MMU here so that we don't
! 64: * have to worry about flushing caches, etc.
! 65: *
! 66: * Note that we may not currently be running VA==PA, which means
! 67: * we'll need to leap to the next insn after disabing the MMU.
! 68: */
! 69: adr r8, Lunmapped
! 70: // bic r8, r8, #0xff000000 /* clear upper 8 bits */
! 71: // orr r8, r8, #0xc0000000 /* OR in physical base address */
! 72:
! 73:
! 74: #if 0
! 75: mrc p15, 0, r2, c1, c0, 0
! 76: bic r2, r2, #CPU_CONTROL_MMU_ENABLE
! 77: mcr p15, 0, r2, c1, c0, 0
! 78: #endif
! 79: nop
! 80: nop
! 81: nop
! 82:
! 83: mov pc, r8 /* Heave-ho! */
! 84:
! 85: Lunmapped:
! 86: /*
! 87: * We want to construct a memory map that maps us
! 88: * VA==PA (SDRAM at 0xc0000000) and also double-maps
! 89: * that space at 0xc0000000 (where the kernel address
! 90: * space starts). We create these mappings uncached
! 91: * and unbuffered to be safe.
! 92: *
! 93: * We also want to map the various devices we want to
! 94: * talk to VA==PA during bootstrap.
! 95: *
! 96: * We just use section mappings for all of this to make it easy.
! 97: *
! 98: * We will put the L1 table to do all this at 0xc0004000.
! 99: */
! 100: adr r0, Lstart
! 101: mov pc, r0
! 102: #if 0
! 103: /*
! 104: * Step 1: Map the entire address space VA==PA.
! 105: */
! 106: adr r0, Ltable
! 107: ldr r0, [r0] /* r0 = &l1table */
! 108:
! 109: mov r3, #(L1_S_AP(AP_KRW))
! 110: orr r3, r3, #(L1_TYPE_S)
! 111: mov r2, #0x100000 /* advance by 1MB */
! 112: mov r1, #0x1000 /* 4096MB */
! 113: 1:
! 114: str r3, [r0], #0x04
! 115: add r3, r3, r2
! 116: subs r1, r1, #1
! 117: bgt 1b
! 118:
! 119:
! 120: /*
! 121: * Step 2: Map VA 0xc0000000->0xc1ffffff to PA 0xc0000000->0xc1ffffff.
! 122: */
! 123: adr r0, Ltable /* r0 = &l1table */
! 124: ldr r0, [r0]
! 125:
! 126: mov r3, #(L1_S_AP(AP_KRW))
! 127: orr r3, r3, #(L1_TYPE_S)
! 128: orr r3, r3, #0xc0000000
! 129: add r0, r0, #(0xc00 * 4) /* offset to 0xc00xxxxx */
! 130: mov r1, #0x20 /* 32MB */
! 131: 1:
! 132: str r3, [r0], #0x04
! 133: add r3, r3, r2
! 134: subs r1, r1, #1
! 135: bgt 1b
! 136:
! 137: /* OK! Page table is set up. Give it to the CPU. */
! 138: adr r0, Ltable
! 139: ldr r0, [r0]
! 140: mcr p15, 0, r0, c2, c0, 0
! 141:
! 142: /* Flush the old TLBs, just in case. */
! 143: mcr p15, 0, r0, c8, c7, 0
! 144:
! 145: /* Set the Domain Access register. Very important! */
! 146: mov r0, #1
! 147: mcr p15, 0, r0, c3, c0, 0
! 148:
! 149: /* Get ready to jump to the "real" kernel entry point... */
! 150: ldr r0, Lstart
! 151:
! 152: /* OK, let's enable the MMU. */
! 153: mrc p15, 0, r2, c1, c0, 0
! 154: orr r2, r2, #CPU_CONTROL_MMU_ENABLE
! 155: mcr p15, 0, r2, c1, c0, 0
! 156:
! 157: nop
! 158: nop
! 159: nop
! 160:
! 161: /* CPWAIT sequence to make sure the MMU is on... */
! 162: mrc p15, 0, r2, c2, c0, 0 /* arbitrary read of CP15 */
! 163: mov r2, r2 /* force it to complete */
! 164: mov pc, r0 /* leap to kernel entry point! */
! 165:
! 166: Ltable:
! 167: .word 0xc0004000
! 168: #endif /* 0 */
! 169: Lstart:
! 170: .word start
CVSweb