WebSVN – HelenOS – Diff – /trunk/kernel/arch/ppc64/src/exception.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 <arch/asm/regname.h>
#include <arch/mm/page.h>
 
.section K_UNMAPPED_TEXT_START, "ax"
 
.macro CONTEXT_STORE
	
	# save R12 in SPRG1, backup CR in R12
	# save SP in SPRG2
 
	mtsprg1 r12
	mfcr r12
	mtsprg2 sp
	
	# check whether SP is in kernel
	
	andis. sp, sp, 0x8000
	bne 1f
	
		# stack is in user-space
		
		mfsprg0 sp
	
	b 2f
	
	1:
	
		# stack is in kernel
		
		mfsprg2 sp
		subis sp, sp, 0x8000
	
	2:
	
	subi sp, sp, 160
	stw r0, 8(sp)
	stw r2, 12(sp)
	stw r3, 16(sp)
	stw r4, 20(sp)
	stw r5, 24(sp)
	stw r6, 28(sp)
	stw r7, 32(sp)
	stw r8, 36(sp)
	stw r9, 40(sp)
	stw r10, 44(sp)
	stw r11, 48(sp)
	stw r13, 52(sp)
	stw r14, 56(sp)
	stw r15, 60(sp)
	stw r16, 64(sp)
	stw r17, 68(sp)
	stw r18, 72(sp)
	stw r19, 76(sp)
	stw r20, 80(sp)
	stw r21, 84(sp)
	stw r22, 88(sp)
	stw r23, 92(sp)
	stw r24, 96(sp)
	stw r25, 100(sp)
	stw r26, 104(sp)
	stw r27, 108(sp)
	stw r28, 112(sp)
	stw r29, 116(sp)
	stw r30, 120(sp)
	stw r31, 124(sp)
	
	stw r12, 128(sp)
	
	mfsrr0 r12
	stw r12, 132(sp)
	
	mfsrr1 r12
	stw r12, 136(sp)
	
	mflr r12
	stw r12, 140(sp)
	
	mfctr r12
	stw r12, 144(sp)
	
	mfxer r12
	stw r12, 148(sp)
	
	mfsprg1 r12
	stw r12, 152(sp)
	
	mfsprg2 r12
	stw r12, 156(sp)
.endm
 
.org 0x060
jump_to_kernel:
	lis r12, iret@ha
	addi r12, r12, iret@l
	mtlr r12
 
	mfmsr r12
	ori r12, r12, (msr_ir | msr_dr)@l
	mtsrr1 r12
	
	addis sp, sp, 0x8000
	mr r4, sp
	addi r4, r4, 8
	
	rfi
 
jump_to_kernel_syscall:
	lis r12, syscall_handler@ha
	addi r12, r12, syscall_handler@l
	mtsrr0 r12
	
	lis r12, iret_syscall@ha
	addi r12, r12, iret_syscall@l
	mtlr r12
 
	mfmsr r12
	ori r12, r12, (msr_ir | msr_dr)@l
	mtsrr1 r12
	
	addis sp, sp, 0x8000
	rfi
 
.org 0x100
.global exc_system_reset
exc_system_reset:
	b exc_system_reset
 
.org 0x200
.global exc_machine_check
exc_machine_check:
	b exc_machine_check
 
.org 0x300
.global exc_data_storage
exc_data_storage:
	CONTEXT_STORE
	
	lis r12, pht_refill@ha
	addi r12, r12, pht_refill@l
	mtsrr0 r12
	
	li r3, 1
	b jump_to_kernel
 
.org 0x400
.global exc_instruction_storage
exc_instruction_storage:
	CONTEXT_STORE
	
	lis r12, pht_refill@ha
	addi r12, r12, pht_refill@l
	mtsrr0 r12
	
	li r3, 0
	b jump_to_kernel
 
.org 0x500
.global exc_external
exc_external:
	b exc_external
 
.org 0x600
.global exc_alignment
exc_alignment:
	b exc_alignment
 
.org 0x700
.global exc_program
exc_program:
	b exc_program
 
.org 0x800
.global exc_fp_unavailable
exc_fp_unavailable:
	b exc_fp_unavailable
 
.org 0x900
.global exc_decrementer
exc_decrementer:
	CONTEXT_STORE
 
	lis r12, exc_dispatch@ha
	addi r12, r12, exc_dispatch@l
	mtsrr0 r12
	
	li r3, 10
	b jump_to_kernel
 
.org 0xa00
.global exc_reserved0
exc_reserved0:
	b exc_reserved0
 
.org 0xb00
.global exc_reserved1
exc_reserved1:
	b exc_reserved1
 
.org 0xc00
.global exc_syscall
exc_syscall:
	CONTEXT_STORE	
	
	b jump_to_kernel_syscall
 
.org 0xd00
.global exc_trace
exc_trace:
	b exc_trace
 

Rev 1787	Rev 2071
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 <arch/asm/regname.h>	29	#include <arch/asm/regname.h>
30	#include <arch/mm/page.h>	30	#include <arch/mm/page.h>
31		31
32	.section K_UNMAPPED_TEXT_START, "ax"	32	.section K_UNMAPPED_TEXT_START, "ax"
33		33
34	.macro CONTEXT_STORE	34	.macro CONTEXT_STORE
35		35
36	# save R12 in SPRG1, backup CR in R12	36	# save R12 in SPRG1, backup CR in R12
37	# save SP in SPRG2	37	# save SP in SPRG2
38		38
39	mtsprg1 r12	39	mtsprg1 r12
40	mfcr r12	40	mfcr r12
41	mtsprg2 sp	41	mtsprg2 sp
42		42
43	# check whether SP is in kernel	43	# check whether SP is in kernel
44		44
45	andis. sp, sp, 0x8000	45	andis. sp, sp, 0x8000
46	bne 1f	46	bne 1f
47		47
48	# stack is in user-space	48	# stack is in user-space
49		49
50	mfsprg0 sp	50	mfsprg0 sp
51		51
52	b 2f	52	b 2f
53		53
54	1:	54	1:
55		55
56	# stack is in kernel	56	# stack is in kernel
57		57
58	mfsprg2 sp	58	mfsprg2 sp
59	subis sp, sp, 0x8000	59	subis sp, sp, 0x8000
60		60
61	2:	61	2:
62		62
63	subi sp, sp, 160	63	subi sp, sp, 160
64	stw r0, 8(sp)	64	stw r0, 8(sp)
65	stw r2, 12(sp)	65	stw r2, 12(sp)
66	stw r3, 16(sp)	66	stw r3, 16(sp)
67	stw r4, 20(sp)	67	stw r4, 20(sp)
68	stw r5, 24(sp)	68	stw r5, 24(sp)
69	stw r6, 28(sp)	69	stw r6, 28(sp)
70	stw r7, 32(sp)	70	stw r7, 32(sp)
71	stw r8, 36(sp)	71	stw r8, 36(sp)
72	stw r9, 40(sp)	72	stw r9, 40(sp)
73	stw r10, 44(sp)	73	stw r10, 44(sp)
74	stw r11, 48(sp)	74	stw r11, 48(sp)
75	stw r13, 52(sp)	75	stw r13, 52(sp)
76	stw r14, 56(sp)	76	stw r14, 56(sp)
77	stw r15, 60(sp)	77	stw r15, 60(sp)
78	stw r16, 64(sp)	78	stw r16, 64(sp)
79	stw r17, 68(sp)	79	stw r17, 68(sp)
80	stw r18, 72(sp)	80	stw r18, 72(sp)
81	stw r19, 76(sp)	81	stw r19, 76(sp)
82	stw r20, 80(sp)	82	stw r20, 80(sp)
83	stw r21, 84(sp)	83	stw r21, 84(sp)
84	stw r22, 88(sp)	84	stw r22, 88(sp)
85	stw r23, 92(sp)	85	stw r23, 92(sp)
86	stw r24, 96(sp)	86	stw r24, 96(sp)
87	stw r25, 100(sp)	87	stw r25, 100(sp)
88	stw r26, 104(sp)	88	stw r26, 104(sp)
89	stw r27, 108(sp)	89	stw r27, 108(sp)
90	stw r28, 112(sp)	90	stw r28, 112(sp)
91	stw r29, 116(sp)	91	stw r29, 116(sp)
92	stw r30, 120(sp)	92	stw r30, 120(sp)
93	stw r31, 124(sp)	93	stw r31, 124(sp)
94		94
95	stw r12, 128(sp)	95	stw r12, 128(sp)
96		96
97	mfsrr0 r12	97	mfsrr0 r12
98	stw r12, 132(sp)	98	stw r12, 132(sp)
99		99
100	mfsrr1 r12	100	mfsrr1 r12
101	stw r12, 136(sp)	101	stw r12, 136(sp)
102		102
103	mflr r12	103	mflr r12
104	stw r12, 140(sp)	104	stw r12, 140(sp)
105		105
106	mfctr r12	106	mfctr r12
107	stw r12, 144(sp)	107	stw r12, 144(sp)
108		108
109	mfxer r12	109	mfxer r12
110	stw r12, 148(sp)	110	stw r12, 148(sp)
111		111
112	mfsprg1 r12	112	mfsprg1 r12
113	stw r12, 152(sp)	113	stw r12, 152(sp)
114		114
115	mfsprg2 r12	115	mfsprg2 r12
116	stw r12, 156(sp)	116	stw r12, 156(sp)
117	.endm	117	.endm
118		118
119	.org 0x060	119	.org 0x060
120	jump_to_kernel:	120	jump_to_kernel:
121	lis r12, iret@ha	121	lis r12, iret@ha
122	addi r12, r12, iret@l	122	addi r12, r12, iret@l
123	mtlr r12	123	mtlr r12
124		124
125	mfmsr r12	125	mfmsr r12
126	ori r12, r12, (msr_ir \| msr_dr)@l	126	ori r12, r12, (msr_ir \| msr_dr)@l
127	mtsrr1 r12	127	mtsrr1 r12
128		128
129	addis sp, sp, 0x8000	129	addis sp, sp, 0x8000
130	mr r4, sp	130	mr r4, sp
131	addi r4, r4, 8	131	addi r4, r4, 8
132		132
133	rfi	133	rfi
134		134
135	jump_to_kernel_syscall:	135	jump_to_kernel_syscall:
136	lis r12, syscall_handler@ha	136	lis r12, syscall_handler@ha
137	addi r12, r12, syscall_handler@l	137	addi r12, r12, syscall_handler@l
138	mtsrr0 r12	138	mtsrr0 r12
139		139
140	lis r12, iret_syscall@ha	140	lis r12, iret_syscall@ha
141	addi r12, r12, iret_syscall@l	141	addi r12, r12, iret_syscall@l
142	mtlr r12	142	mtlr r12
143		143
144	mfmsr r12	144	mfmsr r12
145	ori r12, r12, (msr_ir \| msr_dr)@l	145	ori r12, r12, (msr_ir \| msr_dr)@l
146	mtsrr1 r12	146	mtsrr1 r12
147		147
148	addis sp, sp, 0x8000	148	addis sp, sp, 0x8000
149	rfi	149	rfi
150		150
151	.org 0x100	151	.org 0x100
152	.global exc_system_reset	152	.global exc_system_reset
153	exc_system_reset:	153	exc_system_reset:
154	b exc_system_reset	154	b exc_system_reset
155		155
156	.org 0x200	156	.org 0x200
157	.global exc_machine_check	157	.global exc_machine_check
158	exc_machine_check:	158	exc_machine_check:
159	b exc_machine_check	159	b exc_machine_check
160		160
161	.org 0x300	161	.org 0x300
162	.global exc_data_storage	162	.global exc_data_storage
163	exc_data_storage:	163	exc_data_storage:
164	CONTEXT_STORE	164	CONTEXT_STORE
165		165
166	lis r12, pht_refill@ha	166	lis r12, pht_refill@ha
167	addi r12, r12, pht_refill@l	167	addi r12, r12, pht_refill@l
168	mtsrr0 r12	168	mtsrr0 r12
169		169
170	li r3, 1	170	li r3, 1
171	b jump_to_kernel	171	b jump_to_kernel
172		172
173	.org 0x400	173	.org 0x400
174	.global exc_instruction_storage	174	.global exc_instruction_storage
175	exc_instruction_storage:	175	exc_instruction_storage:
176	CONTEXT_STORE	176	CONTEXT_STORE
177		177
178	lis r12, pht_refill@ha	178	lis r12, pht_refill@ha
179	addi r12, r12, pht_refill@l	179	addi r12, r12, pht_refill@l
180	mtsrr0 r12	180	mtsrr0 r12
181		181
182	li r3, 0	182	li r3, 0
183	b jump_to_kernel	183	b jump_to_kernel
184		184
185	.org 0x500	185	.org 0x500
186	.global exc_external	186	.global exc_external
187	exc_external:	187	exc_external:
188	b exc_external	188	b exc_external
189		189
190	.org 0x600	190	.org 0x600
191	.global exc_alignment	191	.global exc_alignment
192	exc_alignment:	192	exc_alignment:
193	b exc_alignment	193	b exc_alignment
194		194
195	.org 0x700	195	.org 0x700
196	.global exc_program	196	.global exc_program
197	exc_program:	197	exc_program:
198	b exc_program	198	b exc_program
199		199
200	.org 0x800	200	.org 0x800
201	.global exc_fp_unavailable	201	.global exc_fp_unavailable
202	exc_fp_unavailable:	202	exc_fp_unavailable:
203	b exc_fp_unavailable	203	b exc_fp_unavailable
204		204
205	.org 0x900	205	.org 0x900
206	.global exc_decrementer	206	.global exc_decrementer
207	exc_decrementer:	207	exc_decrementer:
208	CONTEXT_STORE	208	CONTEXT_STORE
209		209
210	lis r12, exc_dispatch@ha	210	lis r12, exc_dispatch@ha
211	addi r12, r12, exc_dispatch@l	211	addi r12, r12, exc_dispatch@l
212	mtsrr0 r12	212	mtsrr0 r12
213		213
214	li r3, 10	214	li r3, 10
215	b jump_to_kernel	215	b jump_to_kernel
216		216
217	.org 0xa00	217	.org 0xa00
218	.global exc_reserved0	218	.global exc_reserved0
219	exc_reserved0:	219	exc_reserved0:
220	b exc_reserved0	220	b exc_reserved0
221		221
222	.org 0xb00	222	.org 0xb00
223	.global exc_reserved1	223	.global exc_reserved1
224	exc_reserved1:	224	exc_reserved1:
225	b exc_reserved1	225	b exc_reserved1
226		226
227	.org 0xc00	227	.org 0xc00
228	.global exc_syscall	228	.global exc_syscall
229	exc_syscall:	229	exc_syscall:
230	CONTEXT_STORE	230	CONTEXT_STORE
231		231
232	b jump_to_kernel_syscall	232	b jump_to_kernel_syscall
233		233
234	.org 0xd00	234	.org 0xd00
235	.global exc_trace	235	.global exc_trace
236	exc_trace:	236	exc_trace:
237	b exc_trace	237	b exc_trace
238		238

Subversion Repositories HelenOS

(root)/trunk/kernel/arch/ppc64/src/exception.S – Rev 1787 → 2071