Subversion Repositories HelenOS-historic

Rev

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

Rev 845 Rev 860
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
 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 
	srwi. r7, r5, 3
- 
 
 89 
	addi r6, r3, -4
- 
 
 90 
	addi r4, r4, -4
88 
	# TODO
 91 
	beq	2f
- 
 
 92
- 
 
 93 
	andi. r0, r6, 3
- 
 
 94 
	mtctr r7
- 
 
 95 
	bne 5f
- 
 
 96
- 
 
 97 
	1:
- 
 
 98
- 
 
 99 
	lwz r7, 4(r4)
- 
 
 100 
	lwzu r8, 8(r4)
- 
 
 101 
	stw r7, 4(r6)
- 
 
 102 
	stwu r8, 8(r6)
- 
 
 103 
	bdnz 1b
- 
 
 104
- 
 
 105 
	andi. r5, r5, 7
- 
 
 106
- 
 
 107 
	2:
- 
 
 108
- 
 
 109 
	cmplwi 0, r5, 4
- 
 
 110 
	blt 3f
- 
 
 111
- 
 
 112 
	lwzu r0, 4(r4)
- 
 
 113 
	addi r5, r5, -4
- 
 
 114 
	stwu r0, 4(r6)
- 
 
 115
- 
 
 116 
	3:
- 
 
 117
- 
 
 118 
	cmpwi 0, r5, 0
- 
 
 119 
	beqlr
- 
 
 120 
	mtctr r5
- 
 
 121 
	addi r4, r4, 3
- 
 
 122 
	addi r6, r6, 3
- 
 
 123
- 
 
 124 
	4:
- 
 
 125
- 
 
 126 
	lbzu r0, 1(r4)
- 
 
 127 
	stbu r0, 1(r6)
- 
 
 128 
	bdnz 4b
89 
	blr
 129 
	blr
- 
 
 130
- 
 
 131 
	5:
- 
 
 132
- 
 
 133 
	subfic r0, r0, 4
- 
 
 134 
	mtctr r0
- 
 
 135
- 
 
 136 
	6:
- 
 
 137
- 
 
 138 
	lbz r7, 4(r4)
- 
 
 139 
	addi r4, r4, 1
- 
 
 140 
	stb r7, 4(r6)
- 
 
 141 
	addi r6, r6, 1
- 
 
 142 
	bdnz 6b
- 
 
 143 
	subf r5, r0, r5
- 
 
 144 
	rlwinm. r7, r5, 32-3, 3, 31
- 
 
 145 
	beq 2b
- 
 
 146 
	mtctr r7
- 
 
 147 
	b 1b
90 
 
 148