Subversion Repositories HelenOS

Rev

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

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