WebSVN – HelenOS – Blame – //branches/dynload/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
3168	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:
		206	rlwimi r5, r5, 8, 16, 23
		207	rlwimi r5, r5, 16, 0, 15
		208
		209	addi r14, r3, -4
		210
		211	cmplwi 0, r4, 4
		212	blt 7f
		213
		214	stwu r5, 4(r14)
		215	beqlr
		216
		217	andi. r15, r14, 3
		218	add r4, r15, r4
		219	subf r14, r15, r14
		220	srwi r15, r4, 2
		221	mtctr r15
		222
		223	bdz 6f
		224
		225	1:
		226	stwu r5, 4(r14)
		227	bdnz 1b
		228
		229	6:
		230
		231	andi. r4, r4, 3
		232
		233	7:
		234
		235	cmpwi 0, r4, 0
		236	beqlr
		237
		238	mtctr r4
		239	addi r6, r6, 3
		240
		241	8:
		242
		243	stbu r5, 1(r14)
		244	bdnz 8b
		245
		246	blr
		247
		248	memcpy:
1288	jermar	249	memcpy_from_uspace:
		250	memcpy_to_uspace:
		251
860	decky	252	srwi. r7, r5, 3
		253	addi r6, r3, -4
		254	addi r4, r4, -4
		255	beq 2f
		256
		257	andi. r0, r6, 3
		258	mtctr r7
		259	bne 5f
		260
		261	1:
		262
		263	lwz r7, 4(r4)
		264	lwzu r8, 8(r4)
		265	stw r7, 4(r6)
		266	stwu r8, 8(r6)
		267	bdnz 1b
		268
		269	andi. r5, r5, 7
		270
		271	2:
		272
		273	cmplwi 0, r5, 4
		274	blt 3f
		275
		276	lwzu r0, 4(r4)
		277	addi r5, r5, -4
		278	stwu r0, 4(r6)
		279
		280	3:
		281
		282	cmpwi 0, r5, 0
		283	beqlr
		284	mtctr r5
		285	addi r4, r4, 3
		286	addi r6, r6, 3
		287
		288	4:
		289
		290	lbzu r0, 1(r4)
		291	stbu r0, 1(r6)
		292	bdnz 4b
210	decky	293	blr
860	decky	294
		295	5:
		296
		297	subfic r0, r0, 4
		298	mtctr r0
		299
		300	6:
		301
		302	lbz r7, 4(r4)
		303	addi r4, r4, 1
		304	stb r7, 4(r6)
		305	addi r6, r6, 1
		306	bdnz 6b
		307	subf r5, r0, r5
		308	rlwinm. r7, r5, 32-3, 3, 31
		309	beq 2b
		310	mtctr r7
		311	b 1b
1288	jermar	312
		313	memcpy_from_uspace_failover_address:
		314	memcpy_to_uspace_failover_address:
		315	b memcpy_from_uspace_failover_address

Subversion Repositories HelenOS

(root)//branches/dynload/kernel/arch/ppc32/src/asm.S – Rev 3168