WebSVN – HelenOS-historic – Diff – /kernel/trunk/arch/ppc32/src/asm.S


#
# Copyright (C) 2005 Martin Decky
# All rights reserved.
#
# Redistribution and use in source and binary forms, with or without
# modification, are permitted provided that the following conditions
# are met:
#
# - Redistributions of source code must retain the above copyright
#   notice, this list of conditions and the following disclaimer.
# - Redistributions in binary form must reproduce the above copyright
#   notice, this list of conditions and the following disclaimer in the
#   documentation and/or other materials provided with the distribution.
# - The name of the author may not be used to endorse or promote products
#   derived from this software without specific prior written permission.
#
# THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
# IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
# OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
# IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
# NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
# DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
# THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
# (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
# THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
#
 
#include <arch/asm/regname.h>
 
.text
 
.global cpu_halt
.global cpu_sleep
.global memsetb
.global memcpy
 
cpu_halt:
	b cpu_halt
 
cpu_sleep:
	b cpu_sleep
 
memsetb:
	rlwimi r5, r5, 8, 16, 23
	rlwimi r5, r5, 16, 0, 15
	
	addi r14, r3, -4
	
	cmplwi 0, r4, 4
	blt 7f
	
	stwu r5, 4(r14)
	beqlr
	
	andi. r15, r14, 3
	add r4, r15, r4
	subf r14, r15, r14
	srwi r15, r4, 2
	mtctr r15
	
	bdz 6f
	
	1:
		stwu r5, 4(r14)
		bdnz 1b
	
	6:
	
	andi. r4, r4, 3
	
	7:
	
	cmpwi 0, r4, 0
	beqlr
	
	mtctr r4
	addi r6, r6, 3
	
	8:
	
	stbu r5, 1(r14)
	bdnz 8b
	
	blr
 
memcpy:
	# TODO
	blr
 

Rev 534	Rev 845
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/macro.h>	29	#include <arch/asm/regname.h>
30		30
31	.text	31	.text
32		32
33	.global cpu_halt	33	.global cpu_halt
34	.global cpu_sleep	34	.global cpu_sleep
35	.global memsetb	35	.global memsetb
36	.global memcpy	36	.global memcpy
37		37
38	cpu_halt:	38	cpu_halt:
39	b cpu_halt	39	b cpu_halt
40		40
41	cpu_sleep:	41	cpu_sleep:
42	b cpu_sleep	42	b cpu_sleep
43		43
44	memsetb:	44	memsetb:
45	rlwimi r5, r5, 8, 16, 23	45	rlwimi r5, r5, 8, 16, 23
46	rlwimi r5, r5, 16, 0, 15	46	rlwimi r5, r5, 16, 0, 15
47		47
48	addi r14, r3, -4	48	addi r14, r3, -4
49		49
50	cmplwi 0, r4, 4	50	cmplwi 0, r4, 4
51	blt 7f	51	blt 7f
52		52
53	stwu r5, 4(r14)	53	stwu r5, 4(r14)
54	beqlr	54	beqlr
55		55
56	andi. r15, r14, 3	56	andi. r15, r14, 3
57	add r4, r15, r4	57	add r4, r15, r4
58	subf r14, r15, r14	58	subf r14, r15, r14
59	srwi r15, r4, 2	59	srwi r15, r4, 2
60	mtctr r15	60	mtctr r15
61		61
62	bdz 6f	62	bdz 6f
63		63
64	1:	64	1:
65	stwu r5, 4(r14)	65	stwu r5, 4(r14)
66	bdnz 1b	66	bdnz 1b
67		67
68	6:	68	6:
69		69
70	andi. r4, r4, 3	70	andi. r4, r4, 3
71		71
72	7:	72	7:
73		73
74	cmpwi 0, r4, 0	74	cmpwi 0, r4, 0
75	beqlr	75	beqlr
76		76
77	mtctr r4	77	mtctr r4
78	addi r6, r6, 3	78	addi r6, r6, 3
79		79
80	8:	80	8:
81		81
82	stbu r5, 1(r14)	82	stbu r5, 1(r14)
83	bdnz 8b	83	bdnz 8b
84		84
85	blr	85	blr
86		86
87	memcpy:	87	memcpy:
88	# TODO	88	# TODO
89	blr	89	blr
90		90

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/arch/ppc32/src/asm.S – Rev 534 → 845