Subversion Repositories HelenOS

Rev

Rev 860 | Rev 1004 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

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