intmmu.S revision 1.1 1 1.1 rearnsha /* $NetBSD: intmmu.S,v 1.1 2001/10/27 16:17:52 rearnsha 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.1 rearnsha #include "assym.h"
32 1.1 rearnsha #include <machine/asm.h>
33 1.1 rearnsha #include <arm/armreg.h>
34 1.1 rearnsha #include <arm/pte.h>
35 1.1 rearnsha
36 1.1 rearnsha .text
37 1.1 rearnsha
38 1.1 rearnsha ASENTRY_NP(integrator_start)
39 1.1 rearnsha mov r6, #0x16000000 /* UART0 Physical base*/
40 1.1 rearnsha mov r3, #'A'
41 1.1 rearnsha str r3, [r6] /* Let the world know we are alive */
42 1.1 rearnsha
43 1.1 rearnsha /*
44 1.1 rearnsha * At this time the MMU is off.
45 1.1 rearnsha * We build up an initial memory map at 0x8000 that we can use to get
46 1.1 rearnsha * the kernel running from the top of memory. All mappings in this table
47 1.1 rearnsha * use L1 section maps.
48 1.1 rearnsha */
49 1.1 rearnsha
50 1.1 rearnsha /*
51 1.1 rearnsha * Set Virtual == Physical
52 1.1 rearnsha */
53 1.1 rearnsha mov r3, #(AP_KRW << AP_SECTION_SHIFT)
54 1.1 rearnsha add r3, r3, #(L1_SECTION)
55 1.1 rearnsha mov r2, #0x100000 /* advance by 1MB */
56 1.1 rearnsha mov r1, #0x8000 /* page table start */
57 1.1 rearnsha mov r0, #0x1000 /* page table size */
58 1.1 rearnsha
59 1.1 rearnsha Lflat:
60 1.1 rearnsha str r3, [r1], #0x0004
61 1.1 rearnsha add r3, r3, r2
62 1.1 rearnsha subs r0, r0, #1
63 1.1 rearnsha bgt Lflat
64 1.1 rearnsha
65 1.1 rearnsha /*
66 1.1 rearnsha * Map VA 0xa0100000->0xa03fffff to PA 0x00000000->0x002fffff
67 1.1 rearnsha */
68 1.1 rearnsha mov r3, #(AP_KRW << AP_SECTION_SHIFT)
69 1.1 rearnsha add r3, r3, #(L1_SECTION)
70 1.1 rearnsha mov r1, #0x8000 /* page table start */
71 1.1 rearnsha add r1, r1, #(0xa00 * 4) /* offset to 0xa00xxxxx */
72 1.1 rearnsha add r1, r1, #(0x001 * 4) /* offset to 0xa01xxxxx */
73 1.1 rearnsha mov r0, #47
74 1.1 rearnsha Lkern:
75 1.1 rearnsha str r3, [r1], #0x0004 /* 0xa010000-0xa03fffff */
76 1.1 rearnsha add r3, r3, r2
77 1.1 rearnsha subs r0, r0, #1
78 1.1 rearnsha bgt Lkern
79 1.1 rearnsha /*
80 1.1 rearnsha * Mapping the peripheral register region (0x10000000->0x1fffffff) linearly
81 1.1 rearnsha * would require 256MB of virtual memory (as much space as the entire kernel
82 1.1 rearnsha * virtual space). So we map the first 1M of each 16MB sub-space into the
83 1.1 rearnsha * region VA 0xfd000000->0xfdffffff; this should map enough of the peripheral
84 1.1 rearnsha * space to at least get us up and running.
85 1.1 rearnsha */
86 1.1 rearnsha mov r3, #(AP_KRW << AP_SECTION_SHIFT)
87 1.1 rearnsha add r3, r3, #L1_SECTION
88 1.1 rearnsha add r3, r3, #0x10000000 /* Peripherals base */
89 1.1 rearnsha mov r1, #0x8000 /* page table start */
90 1.1 rearnsha add r1, r1, #(0xfd0 * 4)
91 1.1 rearnsha mov r2, #0x01000000 /* 16MB increment. */
92 1.1 rearnsha mov r0, #16
93 1.1 rearnsha Lperiph:
94 1.1 rearnsha str r3, [r1], #4 /* 0xfd000000-0xfdffffff */
95 1.1 rearnsha add r3, r3, r2
96 1.1 rearnsha subs r0, r0, #1
97 1.1 rearnsha bgt Lperiph
98 1.1 rearnsha
99 1.1 rearnsha /*
100 1.1 rearnsha * We now have our page table ready, so load it up and light the blue
101 1.1 rearnsha * touch paper.
102 1.1 rearnsha */
103 1.1 rearnsha
104 1.1 rearnsha /* set the location of the L1 page table */
105 1.1 rearnsha mov r1, #0x8000
106 1.1 rearnsha mcr p15, 0, r1, c2, c0, 0
107 1.1 rearnsha
108 1.1 rearnsha /* Flush the old TLBs (just in case) */
109 1.1 rearnsha mcr p15, 0, r1, c8, c7, 0
110 1.1 rearnsha mov r2, #'B'
111 1.1 rearnsha strb r2, [r6]
112 1.1 rearnsha
113 1.1 rearnsha /* Set the Domain Access register. Very important! */
114 1.1 rearnsha mov r1, #1
115 1.1 rearnsha mcr p15, 0, r1, c3, c0, 0
116 1.1 rearnsha
117 1.1 rearnsha /*
118 1.1 rearnsha * set mmu bit (don't set anything else for now, we don't know
119 1.1 rearnsha * what sort of CPU we have yet.
120 1.1 rearnsha */
121 1.1 rearnsha mov r1, #CPU_CONTROL_MMU_ENABLE
122 1.1 rearnsha
123 1.1 rearnsha /*
124 1.1 rearnsha * This is where it might all start to go wrong if the cpu fitted to your
125 1.1 rearnsha * integrator does not have an MMU.
126 1.1 rearnsha */
127 1.1 rearnsha /* fetch current control state */
128 1.1 rearnsha mrc p15, 0, r2, c1, c0, 0
129 1.1 rearnsha orr r2, r2, r1
130 1.1 rearnsha
131 1.1 rearnsha /* set new control state */
132 1.1 rearnsha mcr p15, 0, r2, c1, c0, 0
133 1.1 rearnsha
134 1.1 rearnsha mov r0, r0
135 1.1 rearnsha mov r0, r0
136 1.1 rearnsha mov r0, r0
137 1.1 rearnsha
138 1.1 rearnsha /* emit a char. Uart is now at 0xfd600000 */
139 1.1 rearnsha mov r6, #0xfd000000
140 1.1 rearnsha add r6, r6, #0x00600000
141 1.1 rearnsha mov r2, #'C'
142 1.1 rearnsha strb r2, [r6]
143 1.1 rearnsha
144 1.1 rearnsha /* jump to kernel space */
145 1.1 rearnsha mov r0, #0x0200
146 1.1 rearnsha
147 1.1 rearnsha /* Switch to kernel VM and really set the ball rolling. */
148 1.1 rearnsha ldr pc, Lstart
149 1.1 rearnsha
150 1.1 rearnsha Lstart: .long start
151