Subversion Repositories HelenOS

Rev

Rev 3222 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1160 decky 1 
#
2071 jermar 2 
# Copyright (c) 2006 Martin Decky
1160 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 <arch/asm/regname.h>
30 
 
31 
.text
32 
 
1398 decky 33 
.global userspace_asm
1160 decky 34 
.global iret
1398 decky 35 
.global iret_syscall
1160 decky 36 
.global memsetb
37 
.global memcpy
1398 decky 38 
.global memcpy_from_uspace
39 
.global memcpy_to_uspace
40 
.global memcpy_from_uspace_failover_address
41 
.global memcpy_to_uspace_failover_address
1160 decky 42 
 
1398 decky 43 
userspace_asm:
44 
 
45 
	# r3 = uspace_uarg
46 
	# r4 = stack
47 
	# r5 = entry
48 
 
49 
	# disable interrupts
50 
 
51 
	mfmsr r31
52 
	rlwinm r31, r31, 0, 17, 15
53 
	mtmsr r31
54 
 
55 
	# set entry point
56 
 
57 
	mtsrr0 r5
58 
 
59 
	# set problem state, enable interrupts
60 
 
61 
	ori r31, r31, msr_pr
62 
	ori r31, r31, msr_ee
63 
	mtsrr1 r31
64 
 
65 
	# set stack
66 
 
67 
	mr sp, r4
68 
 
3222 svoboda 69 
	# %r3 is defined to hold pcb_ptr - set it to 0
70 
 
71 
	xor r3, r3, r3
72 
 
1398 decky 73 
	# jump to userspace
74 
 
75 
	rfi
76 
 
1160 decky 77 
iret:
78 
 
1398 decky 79 
	# disable interrupts
1160 decky 80 
 
1398 decky 81 
	mfmsr r31
82 
	rlwinm r31, r31, 0, 17, 15
83 
	mtmsr r31
1160 decky 84 
 
1398 decky 85 
	lwz r0, 8(sp)
86 
	lwz r2, 12(sp)
87 
	lwz r3, 16(sp)
88 
	lwz r4, 20(sp)
89 
	lwz r5, 24(sp)
90 
	lwz r6, 28(sp)
91 
	lwz r7, 32(sp)
92 
	lwz r8, 36(sp)
93 
	lwz r9, 40(sp)
94 
	lwz r10, 44(sp)
95 
	lwz r11, 48(sp)
96 
	lwz r13, 52(sp)
97 
	lwz r14, 56(sp)
98 
	lwz r15, 60(sp)
99 
	lwz r16, 64(sp)
100 
	lwz r17, 68(sp)
101 
	lwz r18, 72(sp)
102 
	lwz r19, 76(sp)
103 
	lwz r20, 80(sp)
104 
	lwz r21, 84(sp)
105 
	lwz r22, 88(sp)
106 
	lwz r23, 92(sp)
107 
	lwz r24, 96(sp)
108 
	lwz r25, 100(sp)
109 
	lwz r26, 104(sp)
110 
	lwz r27, 108(sp)
111 
	lwz r28, 112(sp)
112 
	lwz r29, 116(sp)
113 
	lwz r30, 120(sp)
114 
	lwz r31, 124(sp)
1160 decky 115 
 
1398 decky 116 
	lwz r12, 128(sp)
117 
	mtcr r12
1160 decky 118 
 
1398 decky 119 
	lwz r12, 132(sp)
120 
	mtsrr0 r12
1160 decky 121 
 
1398 decky 122 
	lwz r12, 136(sp)
123 
	mtsrr1 r12
1160 decky 124 
 
1398 decky 125 
	lwz r12, 140(sp)
126 
	mtlr r12
1160 decky 127 
 
1398 decky 128 
	lwz r12, 144(sp)
129 
	mtctr r12
130 
 
131 
	lwz r12, 148(sp)
132 
	mtxer r12
133 
 
134 
	lwz r12, 152(sp)
135 
	lwz sp, 156(sp)
136 
 
1160 decky 137 
	rfi
1398 decky 138 
 
139 
iret_syscall:
1160 decky 140 
 
1398 decky 141 
	# reset decrementer
142 
 
143 
	li r31, 1000
144 
	mtdec r31
145 
 
146 
	# disable interrupts
147 
 
148 
	mfmsr r31
149 
	rlwinm r31, r31, 0, 17, 15
150 
	mtmsr r31
151 
 
152 
	lwz r0, 8(sp)
153 
	lwz r2, 12(sp)
154 
	lwz r4, 20(sp)
155 
	lwz r5, 24(sp)
156 
	lwz r6, 28(sp)
157 
	lwz r7, 32(sp)
158 
	lwz r8, 36(sp)
159 
	lwz r9, 40(sp)
160 
	lwz r10, 44(sp)
161 
	lwz r11, 48(sp)
162 
	lwz r13, 52(sp)
163 
	lwz r14, 56(sp)
164 
	lwz r15, 60(sp)
165 
	lwz r16, 64(sp)
166 
	lwz r17, 68(sp)
167 
	lwz r18, 72(sp)
168 
	lwz r19, 76(sp)
169 
	lwz r20, 80(sp)
170 
	lwz r21, 84(sp)
171 
	lwz r22, 88(sp)
172 
	lwz r23, 92(sp)
173 
	lwz r24, 96(sp)
174 
	lwz r25, 100(sp)
175 
	lwz r26, 104(sp)
176 
	lwz r27, 108(sp)
177 
	lwz r28, 112(sp)
178 
	lwz r29, 116(sp)
179 
	lwz r30, 120(sp)
180 
	lwz r31, 124(sp)
181 
 
182 
	lwz r12, 128(sp)
183 
	mtcr r12
184 
 
185 
	lwz r12, 132(sp)
186 
	mtsrr0 r12
187 
 
188 
	lwz r12, 136(sp)
189 
	mtsrr1 r12
190 
 
191 
	lwz r12, 140(sp)
192 
	mtlr r12
193 
 
194 
	lwz r12, 144(sp)
195 
	mtctr r12
196 
 
197 
	lwz r12, 148(sp)
198 
	mtxer r12
199 
 
200 
	lwz r12, 152(sp)
201 
	lwz sp, 156(sp)
202 
 
203 
	rfi
204 
 
1160 decky 205 
memsetb:
206 
	rlwimi r5, r5, 8, 16, 23
207 
	rlwimi r5, r5, 16, 0, 15
208 
 
209 
	addi r14, r3, -4
210 
 
211 
	cmplwi 0, r4, 4
212 
	blt 7f
213 
 
214 
	stwu r5, 4(r14)
215 
	beqlr
216 
 
217 
	andi. r15, r14, 3
218 
	add r4, r15, r4
219 
	subf r14, r15, r14
220 
	srwi r15, r4, 2
221 
	mtctr r15
222 
 
223 
	bdz 6f
224 
 
225 
	1:
226 
		stwu r5, 4(r14)
227 
		bdnz 1b
228 
 
229 
	6:
230 
 
231 
	andi. r4, r4, 3
232 
 
233 
	7:
234 
 
235 
	cmpwi 0, r4, 0
236 
	beqlr
237 
 
238 
	mtctr r4
239 
	addi r6, r6, 3
240 
 
241 
	8:
242 
 
243 
	stbu r5, 1(r14)
244 
	bdnz 8b
245 
 
246 
	blr
247 
 
248 
memcpy:
1398 decky 249 
memcpy_from_uspace:
250 
memcpy_to_uspace:
251 
 
1160 decky 252 
	srwi. r7, r5, 3
253 
	addi r6, r3, -4
254 
	addi r4, r4, -4
255 
	beq	2f
256 
 
257 
	andi. r0, r6, 3
258 
	mtctr r7
259 
	bne 5f
260 
 
261 
	1:
262 
 
263 
	lwz r7, 4(r4)
264 
	lwzu r8, 8(r4)
265 
	stw r7, 4(r6)
266 
	stwu r8, 8(r6)
267 
	bdnz 1b
268 
 
269 
	andi. r5, r5, 7
270 
 
271 
	2:
272 
 
273 
	cmplwi 0, r5, 4
274 
	blt 3f
275 
 
276 
	lwzu r0, 4(r4)
277 
	addi r5, r5, -4
278 
	stwu r0, 4(r6)
279 
 
280 
	3:
281 
 
282 
	cmpwi 0, r5, 0
283 
	beqlr
284 
	mtctr r5
285 
	addi r4, r4, 3
286 
	addi r6, r6, 3
287 
 
288 
	4:
289 
 
290 
	lbzu r0, 1(r4)
291 
	stbu r0, 1(r6)
292 
	bdnz 4b
293 
	blr
294 
 
295 
	5:
296 
 
297 
	subfic r0, r0, 4
298 
	mtctr r0
299 
 
300 
	6:
301 
 
302 
	lbz r7, 4(r4)
303 
	addi r4, r4, 1
304 
	stb r7, 4(r6)
305 
	addi r6, r6, 1
306 
	bdnz 6b
307 
	subf r5, r0, r5
308 
	rlwinm. r7, r5, 32-3, 3, 31
309 
	beq 2b
310 
	mtctr r7
311 
	b 1b
1398 decky 312 
 
313 
memcpy_from_uspace_failover_address:
314 
memcpy_to_uspace_failover_address:
315 
	b memcpy_from_uspace_failover_address