Subversion Repositories HelenOS

Rev

Rev 1787 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1787 Rev 1800
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 
#include "debug.inc"
31 
 
 32 
 
32 
.text
 33 
.text
33 
 
 34 
 
34 
.global halt
 35 
.global halt
35 
.global memcpy
 36 
.global memcpy
36 
.global jump_to_kernel
 37 
.global jump_to_kernel
37 
 
 38 
 
38 
halt:
 39 
halt:
39 
	b halt
 40 
	b halt
40 
 
 41 
 
41 
memcpy:
 42 
memcpy:
42 
	srwi. r7, r5, 3
 43 
	srwi. r7, r5, 3
43 
	addi r6, r3, -4
 44 
	addi r6, r3, -4
44 
	addi r4, r4, -4
 45 
	addi r4, r4, -4
45 
	beq	2f
 46 
	beq	2f
46
47
47 
	andi. r0, r6, 3
 48 
	andi. r0, r6, 3
48 
	mtctr r7
 49 
	mtctr r7
49 
	bne 5f
 50 
	bne 5f
50
51
51 
	1:
 52 
	1:
52
53
53 
	lwz r7, 4(r4)
 54 
	lwz r7, 4(r4)
54 
	lwzu r8, 8(r4)
 55 
	lwzu r8, 8(r4)
55 
	stw r7, 4(r6)
 56 
	stw r7, 4(r6)
56 
	stwu r8, 8(r6)
 57 
	stwu r8, 8(r6)
57 
	bdnz 1b
 58 
	bdnz 1b
58
59
59 
	andi. r5, r5, 7
 60 
	andi. r5, r5, 7
60
61
61 
	2:
 62 
	2:
62
63
63 
	cmplwi 0, r5, 4
 64 
	cmplwi 0, r5, 4
64 
	blt 3f
 65 
	blt 3f
65
66
66 
	lwzu r0, 4(r4)
 67 
	lwzu r0, 4(r4)
67 
	addi r5, r5, -4
 68 
	addi r5, r5, -4
68 
	stwu r0, 4(r6)
 69 
	stwu r0, 4(r6)
69
70
70 
	3:
 71 
	3:
71
72
72 
	cmpwi 0, r5, 0
 73 
	cmpwi 0, r5, 0
73 
	beqlr
 74 
	beqlr
74 
	mtctr r5
 75 
	mtctr r5
75 
	addi r4, r4, 3
 76 
	addi r4, r4, 3
76 
	addi r6, r6, 3
 77 
	addi r6, r6, 3
77
78
78 
	4:
 79 
	4:
79
80
80 
	lbzu r0, 1(r4)
 81 
	lbzu r0, 1(r4)
81 
	stbu r0, 1(r6)
 82 
	stbu r0, 1(r6)
82 
	bdnz 4b
 83 
	bdnz 4b
83 
	blr
 84 
	blr
84
85
85 
	5:
 86 
	5:
86
87
87 
	subfic r0, r0, 4
 88 
	subfic r0, r0, 4
88 
	mtctr r0
 89 
	mtctr r0
89
90
90 
	6:
 91 
	6:
91
92
92 
	lbz r7, 4(r4)
 93 
	lbz r7, 4(r4)
93 
	addi r4, r4, 1
 94 
	addi r4, r4, 1
94 
	stb r7, 4(r6)
 95 
	stb r7, 4(r6)
95 
	addi r6, r6, 1
 96 
	addi r6, r6, 1
96 
	bdnz 6b
 97 
	bdnz 6b
97 
	subf r5, r0, r5
 98 
	subf r5, r0, r5
98 
	rlwinm. r7, r5, 32-3, 3, 31
 99 
	rlwinm. r7, r5, 32-3, 3, 31
99 
	beq 2b
 100 
	beq 2b
100 
	mtctr r7
 101 
	mtctr r7
101 
	b 1b
 102 
	b 1b
102 
 
 103 
 
103 
 
 104 
 
104 
jump_to_kernel:
 105 
jump_to_kernel:
105
106
106 
	# r3 = bootinfo (pa)
 107 
	# r3 = bootinfo (pa)
107 
	# r4 = bootinfo_size
 108 
	# r4 = bootinfo_size
108 
	# r5 = trans (pa)
 109 
	# r5 = trans (pa)
109 
	# r6 = bytes to copy
 110 
	# r6 = bytes to copy
110 
	# r7 = real_mode (pa)
 111 
	# r7 = real_mode (pa)
- 
 
 112 
	# r8 = framebuffer (pa)
- 
 
 113 
	# r9 = scanline
111
114
112 
	# disable interrupts
 115 
	# disable interrupts
113
116
114 
	mfmsr r31
 117 
	mfmsr r31
115 
	rlwinm r31, r31, 0, 17, 15
 118 
	rlwinm r31, r31, 0, 17, 15
116 
	mtmsr r31
 119 
	mtmsr r31
117
120
118 
	# set real_mode meeting point address
 121 
	# set real_mode meeting point address
119
122
120 
	mtspr srr0, r7
 123 
	mtspr srr0, r7
121
124
122 
	# jumps to real_mode
 125 
	# jumps to real_mode
123
126
124 
	mfmsr r31
 127 
	mfmsr r31
125 
	lis r30, ~0@h
 128 
	lis r30, ~0@h
126 
	ori r30, r30, ~(msr_ir | msr_dr)@l
 129 
	ori r30, r30, ~(msr_ir | msr_dr)@l
127 
	and r31, r31, r30
 130 
	and r31, r31, r30
128 
	mtspr srr1, r31
 131 
	mtspr srr1, r31
129
132
130 
	sync
 133 
	sync
131 
	isync
 134 
	isync
132 
	rfid
 135 
	rfid
133 
 
 136 
 
134 
.section REALMODE, "ax"
 137 
.section REALMODE, "ax"
135 
.align PAGE_WIDTH
 138 
.align PAGE_WIDTH
136 
.global real_mode
 139 
.global real_mode
137 
 
 140 
 
138 
real_mode:
 141 
real_mode:
139
142
- 
 
 143 
	DEBUG_INIT
- 
 
 144 
	DEBUG_real_mode
- 
 
 145
140 
	# copy kernel to proper location
 146 
	# copy kernel to proper location
141 
	#
 147 
	#
142 
	# r5 = trans (pa)
 148 
	# r5 = trans (pa)
143 
	# r6 = bytes to copy
 149 
	# r6 = bytes to copy
- 
 
 150 
	# r8 = framebuffer (pa)
- 
 
 151 
	# r9 = scanline
144
152
145 
	li r31, PAGE_SIZE >> 2
 153 
	li r31, PAGE_SIZE >> 2
146 
	li r30, 0
 154 
	li r30, 0
147
155
148 
	page_copy:
 156 
	page_copy:
149
157
150 
		cmpwi r6, 0
 158 
		cmpwi r6, 0
151 
		beq copy_end
 159 
		beq copy_end
152
160
153 
		# copy page
 161 
		# copy page
154
162
155 
		mtctr r31
 163 
		mtctr r31
156 
		lwz r29, 0(r5)
 164 
		lwz r29, 0(r5)
157
165
- 
 
 166 
		DEBUG_INIT
- 
 
 167 
		DEBUG_copy_loop
- 
 
 168
158 
		copy_loop:
 169 
		copy_loop:
159
170
160 
			lwz r28, 0(r29)
 171 
			lwz r28, 0(r29)
161 
			stw r28, 0(r30)
 172 
			stw r28, 0(r30)
162
173
163 
			addi r29, r29, 4
 174 
			addi r29, r29, 4
164 
			addi r30, r30, 4
 175 
			addi r30, r30, 4
165 
			subi r6, r6, 4
 176 
			subi r6, r6, 4
166
177
167 
			cmpwi r6, 0
 178 
			cmpwi r6, 0
168 
			beq copy_end
 179 
			beq copy_end
169
180
170 
			bdnz copy_loop
 181 
			bdnz copy_loop
- 
 
 182
- 
 
 183 
			DEBUG_end_copy_loop
171
184
172 
		addi r5, r5, 4
 185 
		addi r5, r5, 4
173 
		b page_copy
 186 
		b page_copy
174
187
175 
	copy_end:
 188 
	copy_end:
176
189
- 
 
 190 
	DEBUG_segments
- 
 
 191
177 
	# initially fill segment registers
 192 
	# initially fill segment registers
178 
 
 193
179 
	li r31, 16
 - 
 
180 
	mtctr r31
 - 
 
181 
	li r31, 0
 194 
	li r31, 0
- 
 
 195
182 
	li r30, 0x2000
 196 
	li r29, 8
- 
 
 197 
	mtctr r29
- 
 
 198 
	li r30, 0                     # ASID 0 (VSIDs 0 .. 7)
183 
 
 199 
 
184 
	seg_fill:
 200 
	seg_fill_uspace:
- 
 
 201
- 
 
 202 
		mtsrin r30, r31
- 
 
 203 
		addi r30, r30, 1
- 
 
 204 
		addis r31, r31, 0x1000    # move to next SR
- 
 
 205
- 
 
 206 
		bdnz seg_fill_uspace
- 
 
 207
- 
 
 208 
	li r29, 8
- 
 
 209 
	mtctr r29
- 
 
 210 
	lis r30, 0x4000               # priviledged access only
- 
 
 211 
	ori r30, r30, 8               # ASID 0 (VSIDs 8 .. 15)
- 
 
 212
- 
 
 213 
	seg_fill_kernel:
185
214
186 
		mtsrin r30, r31
 215 
		mtsrin r30, r31
187 
		addi r30, r30, 0x111
 216 
		addi r30, r30, 1
188 
		addis r31, r31, 0x1000    # move to next SR
 217 
		addis r31, r31, 0x1000    # move to next SR
189
218
190 
		bdnz seg_fill
 219 
		bdnz seg_fill_kernel
- 
 
 220
- 
 
 221 
	# create empty Page Hash Table
- 
 
 222 
	# on top of memory, size 64 KB
- 
 
 223
- 
 
 224 
	DEBUG_pht
- 
 
 225
- 
 
 226 
	lwz r31, 0(r3)                # r31 = memory size
- 
 
 227
- 
 
 228 
	lis r30, 65536@h
- 
 
 229 
	ori r30, r30, 65536@l         # r30 = 65536
- 
 
 230
- 
 
 231 
	subi r29, r30, 1              # r29 = 65535
- 
 
 232
- 
 
 233 
	sub r31, r31, r30
- 
 
 234 
	andc r31, r31, r29            # pht = ALIGN_DOWN(memory_size - 65536, 65536)
- 
 
 235
- 
 
 236 
	mtsdr1 r31
- 
 
 237
- 
 
 238 
	li r29, 2
- 
 
 239 
	srw r30, r30, r29             # r30 = 16384
- 
 
 240 
	li r29, 0
- 
 
 241
- 
 
 242 
	pht_clear:
- 
 
 243
- 
 
 244 
		# write zeroes
- 
 
 245
- 
 
 246 
		stw r29, 0(r31)
- 
 
 247
- 
 
 248 
		addi r31, r31, 4
- 
 
 249 
		subi r30, r30, 4
- 
 
 250
- 
 
 251 
		cmpwi r30, 0
- 
 
 252 
		beq clear_end
- 
 
 253
- 
 
 254 
		bdnz pht_clear
- 
 
 255 
 
- 
 
 256 
		DEBUG_end_pht_clear
- 
 
 257
- 
 
 258 
	clear_end:
- 
 
 259
- 
 
 260 
	DEBUG_tlb
191
261
192 
	tlbia
 262 
	tlbia
193 
	tlbsync
 263 
	tlbsync
194
264
- 
 
 265 
	DEBUG_prepare
- 
 
 266
195 
	# start the kernel
 267 
	# start the kernel
196 
	#
 268 
	#
- 
 
 269 
	# pc = KERNEL_START_ADDR
197 
	# r3 = bootinfo (pa)
 270 
	# r3 = bootinfo (pa)
- 
 
 271 
	# sprg0 = KA2PA(KERNEL_START_ADDR)
- 
 
 272 
	# sprg3 = physical memory size
- 
 
 273 
	# sp = 0 (pa)
198
274
199 
	lis r31, KERNEL_START_ADDR@ha
 275 
	lis r31, KERNEL_START_ADDR@ha
200 
	addi r31, r31, KERNEL_START_ADDR@l
 276 
	addi r31, r31, KERNEL_START_ADDR@l
201
277
202 
	mtspr srr0, r31
 278 
	mtspr srr0, r31
203
279
- 
 
 280 
	subis r31, r31, 0x8000
- 
 
 281 
	mtsprg0 r31
- 
 
 282
- 
 
 283 
	lwz r31, 0(r3)
- 
 
 284 
	mtsprg3 r31
- 
 
 285
- 
 
 286 
	li sp, 0
- 
 
 287
204 
	mfmsr r31
 288 
	mfmsr r31
205 
	ori r31, r31, (msr_ir | msr_dr)@l
 289 
	ori r31, r31, (msr_ir | msr_dr)@l
206 
	mtspr srr1, r31
 290 
	mtspr srr1, r31
207
291
208 
	sync
 292 
	sync
209 
	isync
 293 
	isync
- 
 
 294
- 
 
 295 
	DEBUG_rfi
210 
	rfid
 296 
	rfid
211 
 
 297 
 
212 
.align PAGE_WIDTH
 298 
.align PAGE_WIDTH
213 
.global trans
 299 
.global trans
214 
trans:
 300 
trans:
215 
	.space (TRANS_SIZE * TRANS_ITEM_SIZE)
 301 
	.space (TRANS_SIZE * TRANS_ITEM_SIZE)
216 
 
 302