WebSVN – HelenOS – Blame – /trunk/kernel/arch/ppc32/src/asm.S

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
		69	# %r3 is defined to hold pcb_ptr - set it to 0
		70
		71	xor r3, r3, r3
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
1355	decky	134	lwz r12, 152(sp)
		135	lwz sp, 156(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
1355	decky	200	lwz r12, 152(sp)
		201	lwz sp, 156(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

Subversion Repositories HelenOS

(root)/trunk/kernel/arch/ppc32/src/asm.S – Rev 3222