Subversion Repositories HelenOS

Rev

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