WebSVN – HelenOS – Diff – /trunk/kernel/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_sleep
.global memsetb
.global memcpy
 
 
 
 
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:
	srwi. r7, r5, 3
	addi r6, r3, -4
	addi r4, r4, -4
	beq	2f
	
	andi. r0, r6, 3
	mtctr r7
	bne 5f
	
	1:
	
	lwz r7, 4(r4)
	lwzu r8, 8(r4)
	stw r7, 4(r6)
	stwu r8, 8(r6)
	bdnz 1b
	
	andi. r5, r5, 7
	
	2:
	
	cmplwi 0, r5, 4
	blt 3f
	
	lwzu r0, 4(r4)
	addi r5, r5, -4
	stwu r0, 4(r6)
	
	3:
	
	cmpwi 0, r5, 0
	beqlr
	mtctr r5
	addi r4, r4, 3
	addi r6, r6, 3
	
	4:
	
	lbzu r0, 1(r4)
	stbu r0, 1(r6)
	bdnz 4b
	blr
	
	5:
	
	subfic r0, r0, 4
	mtctr r0
	
	6:
	
	lbz r7, 4(r4)
	addi r4, r4, 1
	stb r7, 4(r6)
	addi r6, r6, 1
	bdnz 6b
	subf r5, r0, r5
	rlwinm. r7, r5, 32-3, 3, 31
	beq 2b
	mtctr r7
	b 1b
 

Rev 860	Rev 982
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 cpu_halt	-
34	.global cpu_sleep	33	.global cpu_sleep
35	.global memsetb	34	.global memsetb
36	.global memcpy	35	.global memcpy
37		36
38	cpu_halt:	-
39	b cpu_halt	-
40		-
41	cpu_sleep:	37	cpu_sleep:
42	b cpu_sleep	38	b cpu_sleep
43		39
44	memsetb:	40	memsetb:
45	rlwimi r5, r5, 8, 16, 23	41	rlwimi r5, r5, 8, 16, 23
46	rlwimi r5, r5, 16, 0, 15	42	rlwimi r5, r5, 16, 0, 15
47		43
48	addi r14, r3, -4	44	addi r14, r3, -4
49		45
50	cmplwi 0, r4, 4	46	cmplwi 0, r4, 4
51	blt 7f	47	blt 7f
52		48
53	stwu r5, 4(r14)	49	stwu r5, 4(r14)
54	beqlr	50	beqlr
55		51
56	andi. r15, r14, 3	52	andi. r15, r14, 3
57	add r4, r15, r4	53	add r4, r15, r4
58	subf r14, r15, r14	54	subf r14, r15, r14
59	srwi r15, r4, 2	55	srwi r15, r4, 2
60	mtctr r15	56	mtctr r15
61		57
62	bdz 6f	58	bdz 6f
63		59
64	1:	60	1:
65	stwu r5, 4(r14)	61	stwu r5, 4(r14)
66	bdnz 1b	62	bdnz 1b
67		63
68	6:	64	6:
69		65
70	andi. r4, r4, 3	66	andi. r4, r4, 3
71		67
72	7:	68	7:
73		69
74	cmpwi 0, r4, 0	70	cmpwi 0, r4, 0
75	beqlr	71	beqlr
76		72
77	mtctr r4	73	mtctr r4
78	addi r6, r6, 3	74	addi r6, r6, 3
79		75
80	8:	76	8:
81		77
82	stbu r5, 1(r14)	78	stbu r5, 1(r14)
83	bdnz 8b	79	bdnz 8b
84		80
85	blr	81	blr
86		82
87	memcpy:	83	memcpy:
88	srwi. r7, r5, 3	84	srwi. r7, r5, 3
89	addi r6, r3, -4	85	addi r6, r3, -4
90	addi r4, r4, -4	86	addi r4, r4, -4
91	beq 2f	87	beq 2f
92		88
93	andi. r0, r6, 3	89	andi. r0, r6, 3
94	mtctr r7	90	mtctr r7
95	bne 5f	91	bne 5f
96		92
97	1:	93	1:
98		94
99	lwz r7, 4(r4)	95	lwz r7, 4(r4)
100	lwzu r8, 8(r4)	96	lwzu r8, 8(r4)
101	stw r7, 4(r6)	97	stw r7, 4(r6)
102	stwu r8, 8(r6)	98	stwu r8, 8(r6)
103	bdnz 1b	99	bdnz 1b
104		100
105	andi. r5, r5, 7	101	andi. r5, r5, 7
106		102
107	2:	103	2:
108		104
109	cmplwi 0, r5, 4	105	cmplwi 0, r5, 4
110	blt 3f	106	blt 3f
111		107
112	lwzu r0, 4(r4)	108	lwzu r0, 4(r4)
113	addi r5, r5, -4	109	addi r5, r5, -4
114	stwu r0, 4(r6)	110	stwu r0, 4(r6)
115		111
116	3:	112	3:
117		113
118	cmpwi 0, r5, 0	114	cmpwi 0, r5, 0
119	beqlr	115	beqlr
120	mtctr r5	116	mtctr r5
121	addi r4, r4, 3	117	addi r4, r4, 3
122	addi r6, r6, 3	118	addi r6, r6, 3
123		119
124	4:	120	4:
125		121
126	lbzu r0, 1(r4)	122	lbzu r0, 1(r4)
127	stbu r0, 1(r6)	123	stbu r0, 1(r6)
128	bdnz 4b	124	bdnz 4b
129	blr	125	blr
130		126
131	5:	127	5:
132		128
133	subfic r0, r0, 4	129	subfic r0, r0, 4
134	mtctr r0	130	mtctr r0
135		131
136	6:	132	6:
137		133
138	lbz r7, 4(r4)	134	lbz r7, 4(r4)
139	addi r4, r4, 1	135	addi r4, r4, 1
140	stb r7, 4(r6)	136	stb r7, 4(r6)
141	addi r6, r6, 1	137	addi r6, r6, 1
142	bdnz 6b	138	bdnz 6b
143	subf r5, r0, r5	139	subf r5, r0, r5
144	rlwinm. r7, r5, 32-3, 3, 31	140	rlwinm. r7, r5, 32-3, 3, 31
145	beq 2b	141	beq 2b
146	mtctr r7	142	mtctr r7
147	b 1b	143	b 1b
148		144

Subversion Repositories HelenOS

(root)/trunk/kernel/arch/ppc32/src/asm.S @ 2316 – Rev 860 → 982