WebSVN – HelenOS-historic – Diff – /boot/trunk/arch/ppc64/loader/asm.S


#
# Copyright (C) 2006 Martin Decky
# All rights reserved.
#
# Redistribution and use in source and binary forms, with or without
# modification, are permitted provided that the following conditions
# are met:
#
# - Redistributions of source code must retain the above copyright
#   notice, this list of conditions and the following disclaimer.
# - Redistributions in binary form must reproduce the above copyright
#   notice, this list of conditions and the following disclaimer in the
#   documentation and/or other materials provided with the distribution.
# - The name of the author may not be used to endorse or promote products
#   derived from this software without specific prior written permission.
#
# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
#
 
#include "asm.h"
#include "regname.h"
 
.text
 
.global halt
.global memcpy
.global jump_to_kernel
 
halt:
	b halt
 
memcpy:
	srwi. r7, r5, 3
	addi r6, r3, -4
	addi r4, r4, -4
	beq	2f
	
	andi. r0, r6, 3
	mtctr r7
	bne 5f
	
	1:
	
	lwz r7, 4(r4)
	lwzu r8, 8(r4)
	stw r7, 4(r6)
	stwu r8, 8(r6)
	bdnz 1b
	
	andi. r5, r5, 7
	
	2:
	
	cmplwi 0, r5, 4
	blt 3f
	
	lwzu r0, 4(r4)
	addi r5, r5, -4
	stwu r0, 4(r6)
	
	3:
	
	cmpwi 0, r5, 0
	beqlr
	mtctr r5
	addi r4, r4, 3
	addi r6, r6, 3
	
	4:
	
	lbzu r0, 1(r4)
	stbu r0, 1(r6)
	bdnz 4b
	blr
	
	5:
	
	subfic r0, r0, 4
	mtctr r0
	
	6:
	
	lbz r7, 4(r4)
	addi r4, r4, 1
	stb r7, 4(r6)
	addi r6, r6, 1
	bdnz 6b
	subf r5, r0, r5
	rlwinm. r7, r5, 32-3, 3, 31
	beq 2b
	mtctr r7
	b 1b
 
 
jump_to_kernel:
	
	# r3 = bootinfo (pa)
	# r4 = bootinfo_size
	# r5 = trans (pa)
	# r6 = kernel size
	# r7 = framebuffer (pa)
	# r8 = real_mode (pa)
	
	mtspr srr0, r8
	
	# jumps to real_mode
	
	mfmsr r31
	lis r30, ~0@h
	ori r30, r30, ~(msr_ir | msr_dr)@l
	and r31, r31, r30
	mtspr srr1, r31
	
	sync
	isync
	rfid
 
.section REALMODE
.align PAGE_WIDTH
.global real_mode
 
real_mode:
	
	# copy kernel to proper location
	#
	# r5 = trans (pa)
	# r6 = kernel size
	# r7 = framebuffer (pa)
	
	li r31, PAGE_SIZE >> 2
	li r30, 0
	
	page_copy:
		
		cmpwi r6, 0
		beq copy_end
		
		# copy page
		
		mtctr r31
		lwz r29, 0(r5)
		
		copy_loop:
			
			lwz r28, 0(r29)
			stw r28, 0(r30)
			
			addi r29, r29, 4
			addi r30, r30, 4
			subi r6, r6, 4
			
			cmpwi r6, 0
			beq copy_end
			
			bdnz copy_loop
		
		addi r5, r5, 4
		b page_copy
	
	copy_end:
	
	# invalidate segment registers
 
	li r31, 16
	mtctr r31
	li r31, 0
	li r30, 0
 
	seg_fill:
	
		mtsrin r30, r31
		addis r31, r31, 0x1000    # move to next SR
		
		bdnz seg_fill
	
	# invalidate block address translation registers
	
	mtspr ibat0u, r30
	mtspr ibat0l, r30
	
	mtspr ibat1u, r30
	mtspr ibat1l, r30
	
	mtspr ibat2u, r30
	mtspr ibat2l, r30
	
	mtspr ibat3u, r30
	mtspr ibat3l, r30
	
	mtspr dbat0u, r30
	mtspr dbat0l, r30
	
	mtspr dbat1u, r30
	mtspr dbat1l, r30
	
	mtspr dbat2u, r30
	mtspr dbat2l, r30
	
	mtspr dbat3u, r30
	mtspr dbat3l, r30
	
	# create identity mapping
	
	# FIXME: map exactly the size of RAM
	
	lis r31, 0x8000
	ori r31, r31, 0x0ffe
	
	lis r30, 0x0000
	ori r30, r30, 0x0002
	
	mtspr ibat0u, r31
	mtspr ibat0l, r30
	
	mtspr dbat0u, r31
	mtspr dbat0l, r30
	
	# FIXME: temporal framebuffer mapping
	
	lis r31, 0xf000
	ori r31, r31, 0x0ffe
	
	mr r30, r7
	ori r30, r30, 0x0002
	
	mtspr dbat1u, r31
	mtspr dbat1l, r30
	
	tlbia
	
	# start the kernel
	#
	# r3 = bootinfo (pa)
	
	lis r31, KERNEL_START_ADDR@ha
	addi r31, r31, KERNEL_START_ADDR@l
	
	mtspr srr0, r31
	
	mfmsr r31
	ori r31, r31, (msr_ir | msr_dr)@l
	mtspr srr1, r31
	
	sync
	isync
	rfid
 
.align PAGE_WIDTH
.global trans
trans:
	.space (TRANS_SIZE * TRANS_ITEM_SIZE)
 

Rev 1157	Rev 1166
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 = kernel size
110	# r7 = framebuffer (pa)	110	# r7 = framebuffer (pa)
111	# r8 = real_mode (pa)	111	# r8 = real_mode (pa)
112		112
113	mtspr srr0, r8	113	mtspr srr0, r8
114		114
115	# jumps to real_mode	115	# jumps to real_mode
116		116
117	mfmsrd r31	117	mfmsr r31
118	lis r30, ~0@h	118	lis r30, ~0@h
119	ori r30, r30, ~(msr_ir \| msr_dr)@l	119	ori r30, r30, ~(msr_ir \| msr_dr)@l
120	and r31, r31, r30	120	and r31, r31, r30
121	mtspr srr1, r31	121	mtspr srr1, r31
122		122
123	sync	123	sync
124	isync	124	isync
125	rfid	125	rfid
126		126
127	.section REALMODE	127	.section REALMODE
128	.align PAGE_WIDTH	128	.align PAGE_WIDTH
129	.global real_mode	129	.global real_mode
130		130
131	real_mode:	131	real_mode:
132		132
133	# copy kernel to proper location	133	# copy kernel to proper location
134	#	134	#
135	# r5 = trans (pa)	135	# r5 = trans (pa)
136	# r6 = kernel size	136	# r6 = kernel size
137	# r7 = framebuffer (pa)	137	# r7 = framebuffer (pa)
138		138
139	li r31, PAGE_SIZE >> 2	139	li r31, PAGE_SIZE >> 2
140	li r30, 0	140	li r30, 0
141		141
142	page_copy:	142	page_copy:
143		143
144	cmpwi r6, 0	144	cmpwi r6, 0
145	beq copy_end	145	beq copy_end
146		146
147	# copy page	147	# copy page
148		148
149	mtctr r31	149	mtctr r31
150	lwz r29, 0(r5)	150	lwz r29, 0(r5)
151		151
152	copy_loop:	152	copy_loop:
153		153
154	lwz r28, 0(r29)	154	lwz r28, 0(r29)
155	stw r28, 0(r30)	155	stw r28, 0(r30)
156		156
157	addi r29, r29, 4	157	addi r29, r29, 4
158	addi r30, r30, 4	158	addi r30, r30, 4
159	subi r6, r6, 4	159	subi r6, r6, 4
160		160
161	cmpwi r6, 0	161	cmpwi r6, 0
162	beq copy_end	162	beq copy_end
163		163
164	bdnz copy_loop	164	bdnz copy_loop
165		165
166	addi r5, r5, 4	166	addi r5, r5, 4
167	b page_copy	167	b page_copy
168		168
169	copy_end:	169	copy_end:
170		170
171	# invalidate segment registers	171	# invalidate segment registers
172		172
173	li r31, 16	173	li r31, 16
174	mtctr r31	174	mtctr r31
175	li r31, 0	175	li r31, 0
176	li r30, 0	176	li r30, 0
177		177
178	seg_fill:	178	seg_fill:
179		179
180	mtsrin r30, r31	180	mtsrin r30, r31
181	addis r31, r31, 0x1000 # move to next SR	181	addis r31, r31, 0x1000 # move to next SR
182		182
183	bdnz seg_fill	183	bdnz seg_fill
184		184
185	# invalidate block address translation registers	185	# invalidate block address translation registers
186		186
187	mtspr ibat0u, r30	187	mtspr ibat0u, r30
188	mtspr ibat0l, r30	188	mtspr ibat0l, r30
189		189
190	mtspr ibat1u, r30	190	mtspr ibat1u, r30
191	mtspr ibat1l, r30	191	mtspr ibat1l, r30
192		192
193	mtspr ibat2u, r30	193	mtspr ibat2u, r30
194	mtspr ibat2l, r30	194	mtspr ibat2l, r30
195		195
196	mtspr ibat3u, r30	196	mtspr ibat3u, r30
197	mtspr ibat3l, r30	197	mtspr ibat3l, r30
198		198
199	mtspr dbat0u, r30	199	mtspr dbat0u, r30
200	mtspr dbat0l, r30	200	mtspr dbat0l, r30
201		201
202	mtspr dbat1u, r30	202	mtspr dbat1u, r30
203	mtspr dbat1l, r30	203	mtspr dbat1l, r30
204		204
205	mtspr dbat2u, r30	205	mtspr dbat2u, r30
206	mtspr dbat2l, r30	206	mtspr dbat2l, r30
207		207
208	mtspr dbat3u, r30	208	mtspr dbat3u, r30
209	mtspr dbat3l, r30	209	mtspr dbat3l, r30
210		210
211	# create identity mapping	211	# create identity mapping
212		212
213	# FIXME: map exactly the size of RAM	213	# FIXME: map exactly the size of RAM
214		214
215	lis r31, 0x8000	215	lis r31, 0x8000
216	ori r31, r31, 0x0ffe	216	ori r31, r31, 0x0ffe
217		217
218	lis r30, 0x0000	218	lis r30, 0x0000
219	ori r30, r30, 0x0002	219	ori r30, r30, 0x0002
220		220
221	mtspr ibat0u, r31	221	mtspr ibat0u, r31
222	mtspr ibat0l, r30	222	mtspr ibat0l, r30
223		223
224	mtspr dbat0u, r31	224	mtspr dbat0u, r31
225	mtspr dbat0l, r30	225	mtspr dbat0l, r30
226		226
227	# FIXME: temporal framebuffer mapping	227	# FIXME: temporal framebuffer mapping
228		228
229	lis r31, 0xf000	229	lis r31, 0xf000
230	ori r31, r31, 0x0ffe	230	ori r31, r31, 0x0ffe
231		231
232	mr r30, r7	232	mr r30, r7
233	ori r30, r30, 0x0002	233	ori r30, r30, 0x0002
234		234
235	mtspr dbat1u, r31	235	mtspr dbat1u, r31
236	mtspr dbat1l, r30	236	mtspr dbat1l, r30
237		237
238	tlbia	238	tlbia
239		239
240	# start the kernel	240	# start the kernel
241	#	241	#
242	# r3 = bootinfo (pa)	242	# r3 = bootinfo (pa)
243		243
244	lis r31, KERNEL_START_ADDR@ha	244	lis r31, KERNEL_START_ADDR@ha
245	addi r31, r31, KERNEL_START_ADDR@l	245	addi r31, r31, KERNEL_START_ADDR@l
246		246
247	mtspr srr0, r31	247	mtspr srr0, r31
248		248
249	mfmsrd r31	249	mfmsr r31
250	ori r31, r31, (msr_ir \| msr_dr)@l	250	ori r31, r31, (msr_ir \| msr_dr)@l
251	mtspr srr1, r31	251	mtspr srr1, r31
252		252
253	sync	253	sync
254	isync	254	isync
255	rfid	255	rfid
256		256
257	.align PAGE_WIDTH	257	.align PAGE_WIDTH
258	.global trans	258	.global trans
259	trans:	259	trans:
260	.space (TRANS_SIZE * TRANS_ITEM_SIZE)	260	.space (TRANS_SIZE * TRANS_ITEM_SIZE)
261		261

Subversion Repositories HelenOS-historic

(root)/boot/trunk/arch/ppc64/loader/asm.S – Rev 1157 → 1166