WebSVN – HelenOS – Diff – /branches/sparc/kernel/arch/sparc64/src/sun4u/asm.S


#
# Copyright (c) 2005 Jakub Jermar
# 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/arch.h>
#include <arch/stack.h>
#include <arch/mm/sun4u/mmu.h>
#include <arch/sun4u/regdef.h>
 
.text
 
.register       %g2, #scratch
.register       %g3, #scratch
 
.macro WRITE_ALTERNATE_REGISTER reg, bit
	rdpr %pstate, %g1				! save PSTATE.PEF
	wrpr %g0, (\bit | PSTATE_PRIV_BIT), %pstate
	mov %o0, \reg
	wrpr %g0, PSTATE_PRIV_BIT, %pstate
	retl
	wrpr %g1, 0, %pstate				! restore PSTATE.PEF
.endm
 
.macro READ_ALTERNATE_REGISTER reg, bit
	rdpr %pstate, %g1				! save PSTATE.PEF
	wrpr %g0, (\bit | PSTATE_PRIV_BIT), %pstate
	mov \reg, %o0
	wrpr %g0, PSTATE_PRIV_BIT, %pstate
	retl
	wrpr %g1, 0, %pstate				! restore PSTATE.PEF
.endm
 
.global write_to_ag_g6
write_to_ag_g6:
	WRITE_ALTERNATE_REGISTER %g6, PSTATE_AG_BIT
 
.global write_to_ag_g7
write_to_ag_g7:
	WRITE_ALTERNATE_REGISTER %g7, PSTATE_AG_BIT
 
.global write_to_ig_g6
write_to_ig_g6:
	WRITE_ALTERNATE_REGISTER %g6, PSTATE_IG_BIT
 
.global read_from_ag_g7
read_from_ag_g7:
	READ_ALTERNATE_REGISTER %g7, PSTATE_AG_BIT
 
/** Switch to userspace.
 *
 * %o0	Userspace entry address.
 * %o1	Userspace stack pointer address.
 * %o2  Userspace address of uarg structure.
 */
.global switch_to_userspace
switch_to_userspace:
	
	save %o1, -STACK_WINDOW_SAVE_AREA_SIZE, %sp
	flushw
	wrpr %g0, 0, %cleanwin		! avoid information leak
 
	mov %i2, %o0			! uarg
	xor %o1, %o1, %o1		! %o1 is defined to hold pcb_ptr
					! set it to 0
 
	clr %i2
	clr %i3
	clr %i4
	clr %i5
	clr %i6
 
	wrpr %g0, 1, %tl		! enforce mapping via nucleus
 
	rdpr %cwp, %g1
	wrpr %g1, TSTATE_IE_BIT, %tstate
	wrpr %i0, 0, %tnpc
	
	/*
	 * Set primary context according to secondary context.
	 * Secondary context has been already installed by
	 * higher-level functions.
	 */
	wr %g0, ASI_DMMU, %asi
	ldxa [VA_SECONDARY_CONTEXT_REG] %asi, %g1
	stxa %g1, [VA_PRIMARY_CONTEXT_REG] %asi
	flush %i7
 
	/*
	 * Spills and fills will be handled by the userspace handlers.
	 */
	wrpr %g0, WSTATE_OTHER(0) | WSTATE_NORMAL(1), %wstate
	
	done				! jump to userspace
 
 

Rev 3743	Rev 4638
1	#	1	#
2	# Copyright (c) 2005 Jakub Jermar	2	# Copyright (c) 2005 Jakub Jermar
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/arch.h>	29	#include <arch/arch.h>
30	#include <arch/stack.h>	30	#include <arch/stack.h>
31	#include <arch/mm/sun4u/mmu.h>	31	#include <arch/mm/sun4u/mmu.h>
32	#include <arch/sun4u/regdef.h>	32	#include <arch/sun4u/regdef.h>
33		33
34	.text	34	.text
35		35
36	.register %g2, #scratch	36	.register %g2, #scratch
37	.register %g3, #scratch	37	.register %g3, #scratch
38		38
39	.macro WRITE_ALTERNATE_REGISTER reg, bit	39	.macro WRITE_ALTERNATE_REGISTER reg, bit
40	rdpr %pstate, %g1 ! save PSTATE.PEF	40	rdpr %pstate, %g1 ! save PSTATE.PEF
41	wrpr %g0, (\bit \| PSTATE_PRIV_BIT), %pstate	41	wrpr %g0, (\bit \| PSTATE_PRIV_BIT), %pstate
42	mov %o0, \reg	42	mov %o0, \reg
43	wrpr %g0, PSTATE_PRIV_BIT, %pstate	43	wrpr %g0, PSTATE_PRIV_BIT, %pstate
44	retl	44	retl
45	wrpr %g1, 0, %pstate ! restore PSTATE.PEF	45	wrpr %g1, 0, %pstate ! restore PSTATE.PEF
46	.endm	46	.endm
47		47
48	.macro READ_ALTERNATE_REGISTER reg, bit	48	.macro READ_ALTERNATE_REGISTER reg, bit
49	rdpr %pstate, %g1 ! save PSTATE.PEF	49	rdpr %pstate, %g1 ! save PSTATE.PEF
50	wrpr %g0, (\bit \| PSTATE_PRIV_BIT), %pstate	50	wrpr %g0, (\bit \| PSTATE_PRIV_BIT), %pstate
51	mov \reg, %o0	51	mov \reg, %o0
52	wrpr %g0, PSTATE_PRIV_BIT, %pstate	52	wrpr %g0, PSTATE_PRIV_BIT, %pstate
53	retl	53	retl
54	wrpr %g1, 0, %pstate ! restore PSTATE.PEF	54	wrpr %g1, 0, %pstate ! restore PSTATE.PEF
55	.endm	55	.endm
56		56
57	.global write_to_ag_g6	57	.global write_to_ag_g6
58	write_to_ag_g6:	58	write_to_ag_g6:
59	WRITE_ALTERNATE_REGISTER %g6, PSTATE_AG_BIT	59	WRITE_ALTERNATE_REGISTER %g6, PSTATE_AG_BIT
60		60
61	.global write_to_ag_g7	61	.global write_to_ag_g7
62	write_to_ag_g7:	62	write_to_ag_g7:
63	WRITE_ALTERNATE_REGISTER %g7, PSTATE_AG_BIT	63	WRITE_ALTERNATE_REGISTER %g7, PSTATE_AG_BIT
64		64
65	.global write_to_ig_g6	65	.global write_to_ig_g6
66	write_to_ig_g6:	66	write_to_ig_g6:
67	WRITE_ALTERNATE_REGISTER %g6, PSTATE_IG_BIT	67	WRITE_ALTERNATE_REGISTER %g6, PSTATE_IG_BIT
68		68
69	.global read_from_ag_g7	69	.global read_from_ag_g7
70	read_from_ag_g7:	70	read_from_ag_g7:
71	READ_ALTERNATE_REGISTER %g7, PSTATE_AG_BIT	71	READ_ALTERNATE_REGISTER %g7, PSTATE_AG_BIT
72		72
73	/** Switch to userspace.	73	/** Switch to userspace.
74	*	74	*
75	* %o0 Userspace entry address.	75	* %o0 Userspace entry address.
76	* %o1 Userspace stack pointer address.	76	* %o1 Userspace stack pointer address.
77	* %o2 Userspace address of uarg structure.	77	* %o2 Userspace address of uarg structure.
78	*/	78	*/
79	.global switch_to_userspace	79	.global switch_to_userspace
80	switch_to_userspace:	80	switch_to_userspace:
-		81
81	save %o1, -STACK_WINDOW_SAVE_AREA_SIZE, %sp	82	save %o1, -STACK_WINDOW_SAVE_AREA_SIZE, %sp
82	flushw	83	flushw
83	wrpr %g0, 0, %cleanwin ! avoid information leak	84	wrpr %g0, 0, %cleanwin ! avoid information leak
84		85
85	mov %i2, %o0 ! uarg	86	mov %i2, %o0 ! uarg
86	xor %o1, %o1, %o1 ! %o1 is defined to hold pcb_ptr	87	xor %o1, %o1, %o1 ! %o1 is defined to hold pcb_ptr
87	! set it to 0	88	! set it to 0
88		89
89	clr %i2	90	clr %i2
90	clr %i3	91	clr %i3
91	clr %i4	92	clr %i4
92	clr %i5	93	clr %i5
93	clr %i6	94	clr %i6
94		95
95	wrpr %g0, 1, %tl ! enforce mapping via nucleus	96	wrpr %g0, 1, %tl ! enforce mapping via nucleus
96		97
97	rdpr %cwp, %g1	98	rdpr %cwp, %g1
98	wrpr %g1, TSTATE_IE_BIT, %tstate	99	wrpr %g1, TSTATE_IE_BIT, %tstate
99	wrpr %i0, 0, %tnpc	100	wrpr %i0, 0, %tnpc
100		101
101	/*	102	/*
102	* Set primary context according to secondary context.	103	* Set primary context according to secondary context.
103	* Secondary context has been already installed by	104	* Secondary context has been already installed by
104	* higher-level functions.	105	* higher-level functions.
105	*/	106	*/
106	wr %g0, ASI_DMMU, %asi	107	wr %g0, ASI_DMMU, %asi
107	ldxa [VA_SECONDARY_CONTEXT_REG] %asi, %g1	108	ldxa [VA_SECONDARY_CONTEXT_REG] %asi, %g1
108	stxa %g1, [VA_PRIMARY_CONTEXT_REG] %asi	109	stxa %g1, [VA_PRIMARY_CONTEXT_REG] %asi
109	flush %i7	110	flush %i7
110		111
111	/*	112	/*
112	* Spills and fills will be handled by the userspace handlers.	113	* Spills and fills will be handled by the userspace handlers.
113	*/	114	*/
114	wrpr %g0, WSTATE_OTHER(0) \| WSTATE_NORMAL(1), %wstate	115	wrpr %g0, WSTATE_OTHER(0) \| WSTATE_NORMAL(1), %wstate
115		116
116	done ! jump to userspace	117	done ! jump to userspace
117		118
118		119

Subversion Repositories HelenOS

(root)/branches/sparc/kernel/arch/sparc64/src/sun4u/asm.S – Rev 3743 → 4638