Subversion Repositories HelenOS

Rev

Rev 1787 | Rev 1791 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1018 decky 1
#
2
# Copyright (C) 2006 Martin 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
 
1783 jermar 29
#define STACK_WINDOW_SAVE_AREA_SIZE     (16*8)
30
 
31
#define PSTATE_AM_BIT	8
32
 
1018 decky 33
.text
34
 
35
.global halt
1685 decky 36
.global memcpy
1018 decky 37
.global jump_to_kernel
38
 
39
halt:
40
	b halt
41
	nop
1685 decky 42
 
43
memcpy:
1773 jermar 44
	.register       %g2, #scratch
45
        .register       %g3, #scratch
46
	add	%o1, 7, %g1
47
	and	%g1, -8, %g1
48
	cmp	%o1, %g1
49
	be,pn	%xcc, 3f
50
	add	%o0, 7, %g1
51
	mov	0, %g3
52
0:
53
	brz,pn	%o2, 2f
54
	mov	0, %g2
55
1:
56
	ldub	[%g3 + %o1], %g1
57
	add	%g2, 1, %g2
58
	cmp	%o2, %g2
59
	stb	%g1, [%g3 + %o0]
60
	bne,pt	%xcc, 1b
61
	mov	%g2, %g3
62
2:
63
	jmp	%o7 + 8			! exit point
64
	mov	%o1, %o0
65
3:
66
	and	%g1, -8, %g1
67
	cmp	%o0, %g1
68
	bne,pt	%xcc, 0b
69
	mov	0, %g3
70
	srlx	%o2, 3, %g4
71
	brz,pn	%g4, 5f
72
	mov	0, %g5
73
4:
74
	sllx	%g3, 3, %g2
75
	add	%g5, 1, %g3
76
	ldx	[%o1 + %g2], %g1
77
	mov	%g3, %g5
78
	cmp	%g4, %g3
79
	bne,pt	%xcc, 4b
80
	stx	%g1, [%o0 + %g2]
81
5:
82
	and	%o2, 7, %o2
83
	brz,pn	%o2, 2b
84
	sllx	%g4, 3, %g1
85
	mov	0, %g2
86
	add	%g1, %o0, %o0
87
	add	%g1, %o1, %g4
88
	mov	0, %g3
89
6:
90
	ldub	[%g2 + %g4], %g1
91
	stb	%g1, [%g2 + %o0]
92
	add	%g3, 1, %g2
93
	cmp	%o2, %g2
94
	bne,pt	%xcc, 6b
95
	mov	%g2, %g3
1685 decky 96
 
1773 jermar 97
	jmp	%o7 + 8			! exit point
98
	mov	%o1, %o0
99
 
1018 decky 100
jump_to_kernel:
1790 jermar 101
	mov %o0, %l1
102
	mov %o1, %o0
103
	mov %o2, %o1
104
	jmp %l1				! jump to kernel
105
	nop
1783 jermar 106
 
107
.global ofw
108
ofw:
109
	save %sp, -STACK_WINDOW_SAVE_AREA_SIZE, %sp
110
	set ofw_cif, %l0
111
	ldx [%l0], %l0
112
 
113
	rdpr  %pstate, %l1
114
	and  %l1, ~PSTATE_AM_BIT, %l2
115
	wrpr  %l2, 0, %pstate
116
 
117
	jmpl %l0, %o7
118
	mov %i0, %o0
119
 
120
	wrpr %l1, 0, %pstate
121
 
122
	ret
123
	restore %o0, 0, %o0