WebSVN – HelenOS – Diff – /trunk/boot/arch/sparc64/loader/asm.S


#
# Copyright (C) 2006 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 <stack.h>
#include <register.h>
 
.text
 
.global halt
.global memcpy
.global jump_to_kernel
 
halt:
	b halt
	nop
	
memcpy:
	.register       %g2, #scratch
        .register       %g3, #scratch
	add	%o1, 7, %g1
	and	%g1, -8, %g1
	cmp	%o1, %g1
	be,pn	%xcc, 3f
	add	%o0, 7, %g1
	mov	0, %g3
0:
	brz,pn	%o2, 2f
	mov	0, %g2
1:
	ldub	[%g3 + %o1], %g1
	add	%g2, 1, %g2
	cmp	%o2, %g2
	stb	%g1, [%g3 + %o0]
	bne,pt	%xcc, 1b
	mov	%g2, %g3
2:
	jmp	%o7 + 8			! exit point
	mov	%o1, %o0
3:
	and	%g1, -8, %g1
	cmp	%o0, %g1
	bne,pt	%xcc, 0b
	mov	0, %g3
	srlx	%o2, 3, %g4
	brz,pn	%g4, 5f
	mov	0, %g5
4:
	sllx	%g3, 3, %g2
	add	%g5, 1, %g3
	ldx	[%o1 + %g2], %g1
	mov	%g3, %g5
	cmp	%g4, %g3
	bne,pt	%xcc, 4b
	stx	%g1, [%o0 + %g2]
5:
	and	%o2, 7, %o2
	brz,pn	%o2, 2b
	sllx	%g4, 3, %g1
	mov	0, %g2
	add	%g1, %o0, %o0
	add	%g1, %o1, %g4
	mov	0, %g3
6:
	ldub	[%g2 + %g4], %g1
	stb	%g1, [%g2 + %o0]
	add	%g3, 1, %g2
	cmp	%o2, %g2
	bne,pt	%xcc, 6b
	mov	%g2, %g3
 
	jmp	%o7 + 8			! exit point
	mov	%o1, %o0
 
jump_to_kernel:
	mov %o0, %l1
	mov %o1, %o0
	mov %o2, %o1
	mov %o3, %o2
	jmp %l1				! jump to kernel
	nop
 
.global ofw
ofw:
	save %sp, -STACK_WINDOW_SAVE_AREA_SIZE, %sp
	set ofw_cif, %l0
	ldx [%l0], %l0
 
	rdpr  %pstate, %l1
	and  %l1, ~PSTATE_AM_BIT, %l2
	wrpr  %l2, 0, %pstate
    
	jmpl %l0, %o7
	mov %i0, %o0
 
	wrpr %l1, 0, %pstate
 
	ret
	restore %o0, 0, %o0
 

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

Subversion Repositories HelenOS

(root)/trunk/boot/arch/sparc64/loader/asm.S – Rev 1791 → 1899