Subversion Repositories HelenOS

Rev

Rev 3585 | 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
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
3222 svoboda 68 
 
3585 svoboda 69 
	# %r6 is defined to hold pcb_ptr - set it to 0
3222 svoboda 70 
 
3585 svoboda 71 
	xor r6, r6, r6
1220 decky 72 
 
73 
	# jump to userspace
74 
 
75 
	rfi
76 
 
1004 decky 77 
iret:
1277 decky 78 
 
79 
	# disable interrupts
80 
 
81 
	mfmsr r31
82 
	rlwinm r31, r31, 0, 17, 15
83 
	mtmsr r31
84 
 
1355 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)
1004 decky 115 
 
1355 decky 116 
	lwz r12, 128(sp)
1277 decky 117 
	mtcr r12
118 
 
1355 decky 119 
	lwz r12, 132(sp)
1267 decky 120 
	mtsrr0 r12
1004 decky 121 
 
1355 decky 122 
	lwz r12, 136(sp)
1267 decky 123 
	mtsrr1 r12
124 
 
1355 decky 125 
	lwz r12, 140(sp)
1267 decky 126 
	mtlr r12
127 
 
1355 decky 128 
	lwz r12, 144(sp)
1277 decky 129 
	mtctr r12
130 
 
1355 decky 131 
	lwz r12, 148(sp)
1277 decky 132 
	mtxer r12
133 
 
3833 decky 134 
	lwz r12, 156(sp)
135 
	lwz sp, 160(sp)
1277 decky 136 
 
137 
	rfi
138 
 
139 
iret_syscall:
140 
 
1384 decky 141 
	# reset decrementer
142 
 
143 
	li r31, 1000
144 
	mtdec r31
145 
 
1277 decky 146 
	# disable interrupts
147 
 
148 
	mfmsr r31
149 
	rlwinm r31, r31, 0, 17, 15
150 
	mtmsr r31
151 
 
1355 decky 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)
1277 decky 181 
 
1355 decky 182 
	lwz r12, 128(sp)
1267 decky 183 
	mtcr r12
184 
 
1355 decky 185 
	lwz r12, 132(sp)
1277 decky 186 
	mtsrr0 r12
187 
 
1355 decky 188 
	lwz r12, 136(sp)
1277 decky 189 
	mtsrr1 r12
190 
 
1355 decky 191 
	lwz r12, 140(sp)
1277 decky 192 
	mtlr r12
193 
 
1355 decky 194 
	lwz r12, 144(sp)
1267 decky 195 
	mtctr r12
196 
 
1355 decky 197 
	lwz r12, 148(sp)
1267 decky 198 
	mtxer r12
1277 decky 199 
 
3833 decky 200 
	lwz r12, 156(sp)
201 
	lwz sp, 160(sp)
1267 decky 202 
 
1004 decky 203 
	rfi
204 
 
210 decky 205 
memsetb:
3200 svoboda 206 
	b _memsetb
210 decky 207 
 
208 
memcpy:
1288 jermar 209 
memcpy_from_uspace:
210 
memcpy_to_uspace:
211 
 
860 decky 212 
	srwi. r7, r5, 3
213 
	addi r6, r3, -4
214 
	addi r4, r4, -4
215 
	beq	2f
216 
 
217 
	andi. r0, r6, 3
218 
	mtctr r7
219 
	bne 5f
220 
 
221 
	1:
222 
 
223 
	lwz r7, 4(r4)
224 
	lwzu r8, 8(r4)
225 
	stw r7, 4(r6)
226 
	stwu r8, 8(r6)
227 
	bdnz 1b
228 
 
229 
	andi. r5, r5, 7
230 
 
231 
	2:
232 
 
233 
	cmplwi 0, r5, 4
234 
	blt 3f
235 
 
236 
	lwzu r0, 4(r4)
237 
	addi r5, r5, -4
238 
	stwu r0, 4(r6)
239 
 
240 
	3:
241 
 
242 
	cmpwi 0, r5, 0
243 
	beqlr
244 
	mtctr r5
245 
	addi r4, r4, 3
246 
	addi r6, r6, 3
247 
 
248 
	4:
249 
 
250 
	lbzu r0, 1(r4)
251 
	stbu r0, 1(r6)
252 
	bdnz 4b
210 decky 253 
	blr
860 decky 254 
 
255 
	5:
256 
 
257 
	subfic r0, r0, 4
258 
	mtctr r0
259 
 
260 
	6:
261 
 
262 
	lbz r7, 4(r4)
263 
	addi r4, r4, 1
264 
	stb r7, 4(r6)
265 
	addi r6, r6, 1
266 
	bdnz 6b
267 
	subf r5, r0, r5
268 
	rlwinm. r7, r5, 32-3, 3, 31
269 
	beq 2b
270 
	mtctr r7
271 
	b 1b
1288 jermar 272 
 
273 
memcpy_from_uspace_failover_address:
274 
memcpy_to_uspace_failover_address:
3189 jermar 275 
	# return zero, failure
276 
	xor r3, r3, r3
277 
	blr