intmmu.S revision 1.2 1 1.2 thorpej /* $NetBSD: intmmu.S,v 1.2 2001/11/23 17:39:05 thorpej Exp $ */
2 1.1 rearnsha
3 1.1 rearnsha /*
4 1.1 rearnsha * Copyright (c) 2001 ARM Ltd
5 1.1 rearnsha * All rights reserved.
6 1.1 rearnsha *
7 1.1 rearnsha * Redistribution and use in source and binary forms, with or without
8 1.1 rearnsha * modification, are permitted provided that the following conditions
9 1.1 rearnsha * are met:
10 1.1 rearnsha * 1. Redistributions of source code must retain the above copyright
11 1.1 rearnsha * notice, this list of conditions and the following disclaimer.
12 1.1 rearnsha * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 rearnsha * notice, this list of conditions and the following disclaimer in the
14 1.1 rearnsha * documentation and/or other materials provided with the distribution.
15 1.1 rearnsha * 3. The name of the company may not be used to endorse or promote
16 1.1 rearnsha * products derived from this software without specific prior written
17 1.1 rearnsha * permission.
18 1.1 rearnsha *
19 1.1 rearnsha * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
20 1.1 rearnsha * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
21 1.1 rearnsha * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
22 1.1 rearnsha * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
23 1.1 rearnsha * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
24 1.1 rearnsha * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
25 1.1 rearnsha * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 1.1 rearnsha * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 1.1 rearnsha * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 1.1 rearnsha * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 1.1 rearnsha * SUCH DAMAGE.
30 1.1 rearnsha */
31 1.2 thorpej
32 1.1 rearnsha #include "assym.h"
33 1.1 rearnsha #include <machine/asm.h>
34 1.1 rearnsha #include <arm/armreg.h>
35 1.2 thorpej #include <arm/arm32/pte.h>
36 1.1 rearnsha
37 1.1 rearnsha .text
38 1.1 rearnsha
39 1.1 rearnsha ASENTRY_NP(integrator_start)
40 1.1 rearnsha mov r6, #0x16000000 /* UART0 Physical base*/
41 1.1 rearnsha mov r3, #'A'
42 1.1 rearnsha str r3, [r6] /* Let the world know we are alive */
43 1.1 rearnsha
44 1.1 rearnsha /*
45 1.1 rearnsha * At this time the MMU is off.
46 1.1 rearnsha * We build up an initial memory map at 0x8000 that we can use to get
47 1.1 rearnsha * the kernel running from the top of memory. All mappings in this table
48 1.1 rearnsha * use L1 section maps.
49 1.1 rearnsha */
50 1.1 rearnsha
51 1.1 rearnsha /*
52 1.1 rearnsha * Set Virtual == Physical
53 1.1 rearnsha */
54 1.1 rearnsha mov r3, #(AP_KRW << AP_SECTION_SHIFT)
55 1.1 rearnsha add r3, r3, #(L1_SECTION)
56 1.1 rearnsha mov r2, #0x100000 /* advance by 1MB */
57 1.1 rearnsha mov r1, #0x8000 /* page table start */
58 1.1 rearnsha mov r0, #0x1000 /* page table size */
59 1.1 rearnsha
60 1.1 rearnsha Lflat:
61 1.1 rearnsha str r3, [r1], #0x0004
62 1.1 rearnsha add r3, r3, r2
63 1.1 rearnsha subs r0, r0, #1
64 1.1 rearnsha bgt Lflat
65 1.1 rearnsha
66 1.1 rearnsha /*
67 1.1 rearnsha * Map VA 0xa0100000->0xa03fffff to PA 0x00000000->0x002fffff
68 1.1 rearnsha */
69 1.1 rearnsha mov r3, #(AP_KRW << AP_SECTION_SHIFT)
70 1.1 rearnsha add r3, r3, #(L1_SECTION)
71 1.1 rearnsha mov r1, #0x8000 /* page table start */
72 1.1 rearnsha add r1, r1, #(0xa00 * 4) /* offset to 0xa00xxxxx */
73 1.1 rearnsha add r1, r1, #(0x001 * 4) /* offset to 0xa01xxxxx */
74 1.1 rearnsha mov r0, #47
75 1.1 rearnsha Lkern:
76 1.1 rearnsha str r3, [r1], #0x0004 /* 0xa010000-0xa03fffff */
77 1.1 rearnsha add r3, r3, r2
78 1.1 rearnsha subs r0, r0, #1
79 1.1 rearnsha bgt Lkern
80 1.1 rearnsha /*
81 1.1 rearnsha * Mapping the peripheral register region (0x10000000->0x1fffffff) linearly
82 1.1 rearnsha * would require 256MB of virtual memory (as much space as the entire kernel
83 1.1 rearnsha * virtual space). So we map the first 1M of each 16MB sub-space into the
84 1.1 rearnsha * region VA 0xfd000000->0xfdffffff; this should map enough of the peripheral
85 1.1 rearnsha * space to at least get us up and running.
86 1.1 rearnsha */
87 1.1 rearnsha mov r3, #(AP_KRW << AP_SECTION_SHIFT)
88 1.1 rearnsha add r3, r3, #L1_SECTION
89 1.1 rearnsha add r3, r3, #0x10000000 /* Peripherals base */
90 1.1 rearnsha mov r1, #0x8000 /* page table start */
91 1.1 rearnsha add r1, r1, #(0xfd0 * 4)
92 1.1 rearnsha mov r2, #0x01000000 /* 16MB increment. */
93 1.1 rearnsha mov r0, #16
94 1.1 rearnsha Lperiph:
95 1.1 rearnsha str r3, [r1], #4 /* 0xfd000000-0xfdffffff */
96 1.1 rearnsha add r3, r3, r2
97 1.1 rearnsha subs r0, r0, #1
98 1.1 rearnsha bgt Lperiph
99 1.1 rearnsha
100 1.1 rearnsha /*
101 1.1 rearnsha * We now have our page table ready, so load it up and light the blue
102 1.1 rearnsha * touch paper.
103 1.1 rearnsha */
104 1.1 rearnsha
105 1.1 rearnsha /* set the location of the L1 page table */
106 1.1 rearnsha mov r1, #0x8000
107 1.1 rearnsha mcr p15, 0, r1, c2, c0, 0
108 1.1 rearnsha
109 1.1 rearnsha /* Flush the old TLBs (just in case) */
110 1.1 rearnsha mcr p15, 0, r1, c8, c7, 0
111 1.1 rearnsha mov r2, #'B'
112 1.1 rearnsha strb r2, [r6]
113 1.1 rearnsha
114 1.1 rearnsha /* Set the Domain Access register. Very important! */
115 1.1 rearnsha mov r1, #1
116 1.1 rearnsha mcr p15, 0, r1, c3, c0, 0
117 1.1 rearnsha
118 1.1 rearnsha /*
119 1.1 rearnsha * set mmu bit (don't set anything else for now, we don't know
120 1.1 rearnsha * what sort of CPU we have yet.
121 1.1 rearnsha */
122 1.1 rearnsha mov r1, #CPU_CONTROL_MMU_ENABLE
123 1.1 rearnsha
124 1.1 rearnsha /*
125 1.1 rearnsha * This is where it might all start to go wrong if the cpu fitted to your
126 1.1 rearnsha * integrator does not have an MMU.
127 1.1 rearnsha */
128 1.1 rearnsha /* fetch current control state */
129 1.1 rearnsha mrc p15, 0, r2, c1, c0, 0
130 1.1 rearnsha orr r2, r2, r1
131 1.1 rearnsha
132 1.1 rearnsha /* set new control state */
133 1.1 rearnsha mcr p15, 0, r2, c1, c0, 0
134 1.1 rearnsha
135 1.1 rearnsha mov r0, r0
136 1.1 rearnsha mov r0, r0
137 1.1 rearnsha mov r0, r0
138 1.1 rearnsha
139 1.1 rearnsha /* emit a char. Uart is now at 0xfd600000 */
140 1.1 rearnsha mov r6, #0xfd000000
141 1.1 rearnsha add r6, r6, #0x00600000
142 1.1 rearnsha mov r2, #'C'
143 1.1 rearnsha strb r2, [r6]
144 1.1 rearnsha
145 1.1 rearnsha /* jump to kernel space */
146 1.1 rearnsha mov r0, #0x0200
147 1.1 rearnsha
148 1.1 rearnsha /* Switch to kernel VM and really set the ball rolling. */
149 1.1 rearnsha ldr pc, Lstart
150 1.1 rearnsha
151 1.1 rearnsha Lstart: .long start
152