Subversion Repositories HelenOS

Rev

Rev 1965 | Details | Compare with Previous | Last modification | View Log | RSS feed

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