Subversion Repositories HelenOS-historic

Rev

Rev 1378 | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

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