Subversion Repositories HelenOS-historic

Rev

Rev 1157 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1157 decky 1
#
2
# Copyright (C) 2006 Martin Decky
3
# All rights reserved.
4
#
5
# Redistribution and use in source and binary forms, with or without
6
# modification, are permitted provided that the following conditions
7
# are met:
8
#
9
# - Redistributions of source code must retain the above copyright
10
#   notice, this list of conditions and the following disclaimer.
11
# - Redistributions in binary form must reproduce the above copyright
12
#   notice, this list of conditions and the following disclaimer in the
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
15
#   derived from this software without specific prior written permission.
16
#
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
19
# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
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
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
26
# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
#
28
 
29
#include "asm.h"
30
#include "regname.h"
31
 
32
.text
33
 
34
.global halt
35
.global memcpy
36
.global jump_to_kernel
37
 
38
halt:
39
	b halt
40
 
41
memcpy:
42
	srwi. r7, r5, 3
43
	addi r6, r3, -4
44
	addi r4, r4, -4
45
	beq	2f
46
 
47
	andi. r0, r6, 3
48
	mtctr r7
49
	bne 5f
50
 
51
	1:
52
 
53
	lwz r7, 4(r4)
54
	lwzu r8, 8(r4)
55
	stw r7, 4(r6)
56
	stwu r8, 8(r6)
57
	bdnz 1b
58
 
59
	andi. r5, r5, 7
60
 
61
	2:
62
 
63
	cmplwi 0, r5, 4
64
	blt 3f
65
 
66
	lwzu r0, 4(r4)
67
	addi r5, r5, -4
68
	stwu r0, 4(r6)
69
 
70
	3:
71
 
72
	cmpwi 0, r5, 0
73
	beqlr
74
	mtctr r5
75
	addi r4, r4, 3
76
	addi r6, r6, 3
77
 
78
	4:
79
 
80
	lbzu r0, 1(r4)
81
	stbu r0, 1(r6)
82
	bdnz 4b
83
	blr
84
 
85
	5:
86
 
87
	subfic r0, r0, 4
88
	mtctr r0
89
 
90
	6:
91
 
92
	lbz r7, 4(r4)
93
	addi r4, r4, 1
94
	stb r7, 4(r6)
95
	addi r6, r6, 1
96
	bdnz 6b
97
	subf r5, r0, r5
98
	rlwinm. r7, r5, 32-3, 3, 31
99
	beq 2b
100
	mtctr r7
101
	b 1b
102
 
103
 
104
jump_to_kernel:
105
 
106
	# r3 = bootinfo (pa)
107
	# r4 = bootinfo_size
108
	# r5 = trans (pa)
109
	# r6 = kernel size
110
	# r7 = framebuffer (pa)
111
	# r8 = real_mode (pa)
112
 
113
	mtspr srr0, r8
114
 
115
	# jumps to real_mode
116
 
1166 decky 117
	mfmsr r31
1157 decky 118
	lis r30, ~0@h
119
	ori r30, r30, ~(msr_ir | msr_dr)@l
120
	and r31, r31, r30
121
	mtspr srr1, r31
122
 
123
	sync
124
	isync
125
	rfid
126
 
127
.section REALMODE
128
.align PAGE_WIDTH
129
.global real_mode
130
 
131
real_mode:
132
 
133
	# copy kernel to proper location
134
	#
135
	# r5 = trans (pa)
136
	# r6 = kernel size
137
	# r7 = framebuffer (pa)
138
 
139
	li r31, PAGE_SIZE >> 2
140
	li r30, 0
141
 
142
	page_copy:
143
 
144
		cmpwi r6, 0
145
		beq copy_end
146
 
147
		# copy page
148
 
149
		mtctr r31
150
		lwz r29, 0(r5)
151
 
152
		copy_loop:
153
 
154
			lwz r28, 0(r29)
155
			stw r28, 0(r30)
156
 
157
			addi r29, r29, 4
158
			addi r30, r30, 4
159
			subi r6, r6, 4
160
 
161
			cmpwi r6, 0
162
			beq copy_end
163
 
164
			bdnz copy_loop
165
 
166
		addi r5, r5, 4
167
		b page_copy
168
 
169
	copy_end:
170
 
171
	# invalidate segment registers
172
 
173
	li r31, 16
174
	mtctr r31
175
	li r31, 0
176
	li r30, 0
177
 
178
	seg_fill:
179
 
180
		mtsrin r30, r31
181
		addis r31, r31, 0x1000    # move to next SR
182
 
183
		bdnz seg_fill
184
 
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
239
 
240
	# start the kernel
241
	#
242
	# r3 = bootinfo (pa)
243
 
244
	lis r31, KERNEL_START_ADDR@ha
245
	addi r31, r31, KERNEL_START_ADDR@l
246
 
247
	mtspr srr0, r31
248
 
1166 decky 249
	mfmsr r31
1157 decky 250
	ori r31, r31, (msr_ir | msr_dr)@l
251
	mtspr srr1, r31
252
 
253
	sync
254
	isync
255
	rfid
256
 
257
.align PAGE_WIDTH
258
.global trans
259
trans:
260
	.space (TRANS_SIZE * TRANS_ITEM_SIZE)