Subversion Repositories HelenOS-historic

Rev

Rev 1166 | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1166 Rev 1395
1 
#
 1 
#
2 
# Copyright (C) 2006 Martin Decky
 2 
# Copyright (C) 2006 Martin Decky
3 
# All rights reserved.
 3 
# All rights reserved.
4 
#
 4 
#
5 
# Redistribution and use in source and binary forms, with or without
 5 
# Redistribution and use in source and binary forms, with or without
6 
# modification, are permitted provided that the following conditions
 6 
# modification, are permitted provided that the following conditions
7 
# are met:
 7 
# are met:
8 
#
 8 
#
9 
# - Redistributions of source code must retain the above copyright
 9 
# - Redistributions of source code must retain the above copyright
10 
#   notice, this list of conditions and the following disclaimer.
 10 
#   notice, this list of conditions and the following disclaimer.
11 
# - Redistributions in binary form must reproduce the above copyright
 11 
# - Redistributions in binary form must reproduce the above copyright
12 
#   notice, this list of conditions and the following disclaimer in the
 12 
#   notice, this list of conditions and the following disclaimer in the
13 
#   documentation and/or other materials provided with the distribution.
 13 
#   documentation and/or other materials provided with the distribution.
14 
# - The name of the author may not be used to endorse or promote products
 14 
# - The name of the author may not be used to endorse or promote products
15 
#   derived from this software without specific prior written permission.
 15 
#   derived from this software without specific prior written permission.
16 
#
 16 
#
17 
# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 17 
# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 
# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 18 
# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 
# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 19 
# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 
# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 20 
# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 21 
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 
# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 22 
# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 
# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 23 
# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 
# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 24 
# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 
# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 25 
# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 
# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 26 
# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 
#
 27 
#
28 
 
 28 
 
29 
#include "asm.h"
 29 
#include "asm.h"
30 
#include "regname.h"
 30 
#include "regname.h"
31 
 
 31 
 
32 
.text
 32 
.text
33 
 
 33 
 
34 
.global halt
 34 
.global halt
35 
.global memcpy
 35 
.global memcpy
36 
.global jump_to_kernel
 36 
.global jump_to_kernel
37 
 
 37 
 
38 
halt:
 38 
halt:
39 
	b halt
 39 
	b halt
40 
 
 40 
 
41 
memcpy:
 41 
memcpy:
42 
	srwi. r7, r5, 3
 42 
	srwi. r7, r5, 3
43 
	addi r6, r3, -4
 43 
	addi r6, r3, -4
44 
	addi r4, r4, -4
 44 
	addi r4, r4, -4
45 
	beq	2f
 45 
	beq	2f
46
46
47 
	andi. r0, r6, 3
 47 
	andi. r0, r6, 3
48 
	mtctr r7
 48 
	mtctr r7
49 
	bne 5f
 49 
	bne 5f
50
50
51 
	1:
 51 
	1:
52
52
53 
	lwz r7, 4(r4)
 53 
	lwz r7, 4(r4)
54 
	lwzu r8, 8(r4)
 54 
	lwzu r8, 8(r4)
55 
	stw r7, 4(r6)
 55 
	stw r7, 4(r6)
56 
	stwu r8, 8(r6)
 56 
	stwu r8, 8(r6)
57 
	bdnz 1b
 57 
	bdnz 1b
58
58
59 
	andi. r5, r5, 7
 59 
	andi. r5, r5, 7
60
60
61 
	2:
 61 
	2:
62
62
63 
	cmplwi 0, r5, 4
 63 
	cmplwi 0, r5, 4
64 
	blt 3f
 64 
	blt 3f
65
65
66 
	lwzu r0, 4(r4)
 66 
	lwzu r0, 4(r4)
67 
	addi r5, r5, -4
 67 
	addi r5, r5, -4
68 
	stwu r0, 4(r6)
 68 
	stwu r0, 4(r6)
69
69
70 
	3:
 70 
	3:
71
71
72 
	cmpwi 0, r5, 0
 72 
	cmpwi 0, r5, 0
73 
	beqlr
 73 
	beqlr
74 
	mtctr r5
 74 
	mtctr r5
75 
	addi r4, r4, 3
 75 
	addi r4, r4, 3
76 
	addi r6, r6, 3
 76 
	addi r6, r6, 3
77
77
78 
	4:
 78 
	4:
79
79
80 
	lbzu r0, 1(r4)
 80 
	lbzu r0, 1(r4)
81 
	stbu r0, 1(r6)
 81 
	stbu r0, 1(r6)
82 
	bdnz 4b
 82 
	bdnz 4b
83 
	blr
 83 
	blr
84
84
85 
	5:
 85 
	5:
86
86
87 
	subfic r0, r0, 4
 87 
	subfic r0, r0, 4
88 
	mtctr r0
 88 
	mtctr r0
89
89
90 
	6:
 90 
	6:
91
91
92 
	lbz r7, 4(r4)
 92 
	lbz r7, 4(r4)
93 
	addi r4, r4, 1
 93 
	addi r4, r4, 1
94 
	stb r7, 4(r6)
 94 
	stb r7, 4(r6)
95 
	addi r6, r6, 1
 95 
	addi r6, r6, 1
96 
	bdnz 6b
 96 
	bdnz 6b
97 
	subf r5, r0, r5
 97 
	subf r5, r0, r5
98 
	rlwinm. r7, r5, 32-3, 3, 31
 98 
	rlwinm. r7, r5, 32-3, 3, 31
99 
	beq 2b
 99 
	beq 2b
100 
	mtctr r7
 100 
	mtctr r7
101 
	b 1b
 101 
	b 1b
102 
 
 102 
 
103 
 
 103 
 
104 
jump_to_kernel:
 104 
jump_to_kernel:
105
105
106 
	# r3 = bootinfo (pa)
 106 
	# r3 = bootinfo (pa)
107 
	# r4 = bootinfo_size
 107 
	# r4 = bootinfo_size
108 
	# r5 = trans (pa)
 108 
	# r5 = trans (pa)
109 
	# r6 = kernel size
 109 
	# r6 = bytes to copy
110 
	# r7 = framebuffer (pa)
 - 
 
111 
	# r8 = real_mode (pa)
 110 
	# r7 = real_mode (pa)
112
111
- 
 
 112 
	# disable interrupts
- 
 
 113
- 
 
 114 
	mfmsr r31
- 
 
 115 
	rlwinm r31, r31, 0, 17, 15
- 
 
 116 
	mtmsr r31
- 
 
 117
- 
 
 118 
	# set real_mode meeting point address
- 
 
 119
113 
	mtspr srr0, r8
 120 
	mtspr srr0, r7
114
121
115 
	# jumps to real_mode
 122 
	# jumps to real_mode
116
123
117 
	mfmsr r31
 124 
	mfmsr r31
118 
	lis r30, ~0@h
 125 
	lis r30, ~0@h
119 
	ori r30, r30, ~(msr_ir | msr_dr)@l
 126 
	ori r30, r30, ~(msr_ir | msr_dr)@l
120 
	and r31, r31, r30
 127 
	and r31, r31, r30
121 
	mtspr srr1, r31
 128 
	mtspr srr1, r31
122
129
123 
	sync
 130 
	sync
124 
	isync
 131 
	isync
125 
	rfid
 132 
	rfid
126 
 
 133 
 
127 
.section REALMODE
 134 
.section REALMODE, "ax"
128 
.align PAGE_WIDTH
 135 
.align PAGE_WIDTH
129 
.global real_mode
 136 
.global real_mode
130 
 
 137 
 
131 
real_mode:
 138 
real_mode:
132
139
133 
	# copy kernel to proper location
 140 
	# copy kernel to proper location
134 
	#
 141 
	#
135 
	# r5 = trans (pa)
 142 
	# r5 = trans (pa)
136 
	# r6 = kernel size
 143 
	# r6 = bytes to copy
137 
	# r7 = framebuffer (pa)
 - 
 
138
144
139 
	li r31, PAGE_SIZE >> 2
 145 
	li r31, PAGE_SIZE >> 2
140 
	li r30, 0
 146 
	li r30, 0
141
147
142 
	page_copy:
 148 
	page_copy:
143
149
144 
		cmpwi r6, 0
 150 
		cmpwi r6, 0
145 
		beq copy_end
 151 
		beq copy_end
146
152
147 
		# copy page
 153 
		# copy page
148
154
149 
		mtctr r31
 155 
		mtctr r31
150 
		lwz r29, 0(r5)
 156 
		lwz r29, 0(r5)
151
157
152 
		copy_loop:
 158 
		copy_loop:
153
159
154 
			lwz r28, 0(r29)
 160 
			lwz r28, 0(r29)
155 
			stw r28, 0(r30)
 161 
			stw r28, 0(r30)
156
162
157 
			addi r29, r29, 4
 163 
			addi r29, r29, 4
158 
			addi r30, r30, 4
 164 
			addi r30, r30, 4
159 
			subi r6, r6, 4
 165 
			subi r6, r6, 4
160
166
161 
			cmpwi r6, 0
 167 
			cmpwi r6, 0
162 
			beq copy_end
 168 
			beq copy_end
163
169
164 
			bdnz copy_loop
 170 
			bdnz copy_loop
165
171
166 
		addi r5, r5, 4
 172 
		addi r5, r5, 4
167 
		b page_copy
 173 
		b page_copy
168
174
169 
	copy_end:
 175 
	copy_end:
170
176
171 
	# invalidate segment registers
 177 
	# initially fill segment registers
172 
 
 178 
 
173 
	li r31, 16
 179 
	li r31, 16
174 
	mtctr r31
 180 
	mtctr r31
175 
	li r31, 0
 181 
	li r31, 0
176 
	li r30, 0
 182 
	li r30, 0x2000
177 
 
 183 
 
178 
	seg_fill:
 184 
	seg_fill:
179
185
180 
		mtsrin r30, r31
 186 
		mtsrin r30, r31
- 
 
 187 
		addi r30, r30, 0x111
181 
		addis r31, r31, 0x1000    # move to next SR
 188 
		addis r31, r31, 0x1000    # move to next SR
182
189
183 
		bdnz seg_fill
 190 
		bdnz seg_fill
184
191
185 
	# invalidate block address translation registers
 - 
 
186
- 
 
187 
	mtspr ibat0u, r30
 - 
 
188 
	mtspr ibat0l, r30
 - 
 
189
- 
 
190 
	mtspr ibat1u, r30
 - 
 
191 
	mtspr ibat1l, r30
 - 
 
192
- 
 
193 
	mtspr ibat2u, r30
 - 
 
194 
	mtspr ibat2l, r30
 - 
 
195
- 
 
196 
	mtspr ibat3u, r30
 - 
 
197 
	mtspr ibat3l, r30
 - 
 
198
- 
 
199 
	mtspr dbat0u, r30
 - 
 
200 
	mtspr dbat0l, r30
 - 
 
201
- 
 
202 
	mtspr dbat1u, r30
 - 
 
203 
	mtspr dbat1l, r30
 - 
 
204
- 
 
205 
	mtspr dbat2u, r30
 - 
 
206 
	mtspr dbat2l, r30
 - 
 
207
- 
 
208 
	mtspr dbat3u, r30
 - 
 
209 
	mtspr dbat3l, r30
 - 
 
210
- 
 
211 
	# create identity mapping
 - 
 
212
- 
 
213 
	# FIXME: map exactly the size of RAM
 - 
 
214
- 
 
215 
	lis r31, 0x8000
 - 
 
216 
	ori r31, r31, 0x0ffe
 - 
 
217
- 
 
218 
	lis r30, 0x0000
 - 
 
219 
	ori r30, r30, 0x0002
 - 
 
220
- 
 
221 
	mtspr ibat0u, r31
 - 
 
222 
	mtspr ibat0l, r30
 - 
 
223
- 
 
224 
	mtspr dbat0u, r31
 - 
 
225 
	mtspr dbat0l, r30
 - 
 
226
- 
 
227 
	# FIXME: temporal framebuffer mapping
 - 
 
228
- 
 
229 
	lis r31, 0xf000
 - 
 
230 
	ori r31, r31, 0x0ffe
 - 
 
231
- 
 
232 
	mr r30, r7
 - 
 
233 
	ori r30, r30, 0x0002
 - 
 
234
- 
 
235 
	mtspr dbat1u, r31
 - 
 
236 
	mtspr dbat1l, r30
 - 
 
237
- 
 
238 
	tlbia
 192 
	tlbia
- 
 
 193 
	tlbsync
239
194
240 
	# start the kernel
 195 
	# start the kernel
241 
	#
 196 
	#
242 
	# r3 = bootinfo (pa)
 197 
	# r3 = bootinfo (pa)
243
198
244 
	lis r31, KERNEL_START_ADDR@ha
 199 
	lis r31, KERNEL_START_ADDR@ha
245 
	addi r31, r31, KERNEL_START_ADDR@l
 200 
	addi r31, r31, KERNEL_START_ADDR@l
246
201
247 
	mtspr srr0, r31
 202 
	mtspr srr0, r31
248
203
249 
	mfmsr r31
 204 
	mfmsr r31
250 
	ori r31, r31, (msr_ir | msr_dr)@l
 205 
	ori r31, r31, (msr_ir | msr_dr)@l
251 
	mtspr srr1, r31
 206 
	mtspr srr1, r31
252
207
253 
	sync
 208 
	sync
254 
	isync
 209 
	isync
255 
	rfid
 210 
	rfid
256 
 
 211 
 
257 
.align PAGE_WIDTH
 212 
.align PAGE_WIDTH
258 
.global trans
 213 
.global trans
259 
trans:
 214 
trans:
260 
	.space (TRANS_SIZE * TRANS_ITEM_SIZE)
 215 
	.space (TRANS_SIZE * TRANS_ITEM_SIZE)
261 
 
 216