Subversion Repositories HelenOS

Rev

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

Rev Author Line No. Line
308 jermar 1
#
2071 jermar 2
# Copyright (c) 2003-2004 Jakub Jermar
1 jermar 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
 
306 palkovsky 29
#include <arch/asm/regname.h>
30
#include <arch/mm/page.h>
31
#include <arch/asm/boot.h>
317 palkovsky 32
#include <arch/context_offset.h>
2607 jermar 33
#include <arch/stack.h>
306 palkovsky 34
 
1 jermar 35
.text
36
 
37
.set noat
38
.set noreorder
39
.set nomacro
40
 
41
.global kernel_image_start
42
.global tlb_refill_entry
43
.global cache_error_entry
44
.global exception_entry
313 palkovsky 45
.global userspace_asm
1 jermar 46
 
1096 palkovsky 47
# Which status bits should are thread-local
48
#define REG_SAVE_MASK 0x1f # KSU(UM), EXL, ERL, IE
49
 
313 palkovsky 50
# Save registers to space defined by \r
1096 palkovsky 51
# We will change status: Disable ERL,EXL,UM,IE
52
# These changes will be automatically reversed in REGISTER_LOAD
1102 palkovsky 53
# SP is NOT saved as part of these registers
1096 palkovsky 54
.macro REGISTERS_STORE_AND_EXC_RESET r
2607 jermar 55
	sw $at, EOFFSET_AT(\r)
56
	sw $v0, EOFFSET_V0(\r)
57
	sw $v1, EOFFSET_V1(\r)
58
	sw $a0, EOFFSET_A0(\r)
59
	sw $a1, EOFFSET_A1(\r)
60
	sw $a2, EOFFSET_A2(\r)
61
	sw $a3, EOFFSET_A3(\r)
62
	sw $t0, EOFFSET_T0(\r)
63
	sw $t1, EOFFSET_T1(\r)
64
	sw $t2, EOFFSET_T2(\r)
65
	sw $t3, EOFFSET_T3(\r)
66
	sw $t4, EOFFSET_T4(\r)
67
	sw $t5, EOFFSET_T5(\r)
68
	sw $t6, EOFFSET_T6(\r)
69
	sw $t7, EOFFSET_T7(\r)
70
	sw $t8, EOFFSET_T8(\r)
71
	sw $t9, EOFFSET_T9(\r)
313 palkovsky 72
 
73
	mflo $at
74
	sw $at, EOFFSET_LO(\r)
75
	mfhi $at
76
	sw $at, EOFFSET_HI(\r)
77
 
1094 palkovsky 78
#ifdef CONFIG_DEBUG_ALLREGS	
2607 jermar 79
	sw $s0, EOFFSET_S0(\r)
80
	sw $s1, EOFFSET_S1(\r)
81
	sw $s2, EOFFSET_S2(\r)
82
	sw $s3, EOFFSET_S3(\r)
83
	sw $s4, EOFFSET_S4(\r)
84
	sw $s5, EOFFSET_S5(\r)
85
	sw $s6, EOFFSET_S6(\r)
86
	sw $s7, EOFFSET_S7(\r)
87
	sw $s8, EOFFSET_S8(\r)
1094 palkovsky 88
#endif
89
 
2607 jermar 90
	sw $gp, EOFFSET_GP(\r)
91
	sw $ra, EOFFSET_RA(\r)
92
	sw $k1, EOFFSET_K1(\r)
313 palkovsky 93
 
1096 palkovsky 94
	mfc0 $t0, $status
95
	mfc0 $t1, $epc
96
 
2607 jermar 97
	and $t2, $t0, REG_SAVE_MASK	# Save only KSU,EXL,ERL,IE
1096 palkovsky 98
	li $t3, ~(0x1f)
2607 jermar 99
	and $t0, $t0, $t3		# Clear KSU,EXL,ERL,IE
1096 palkovsky 100
 
101
	sw $t2,EOFFSET_STATUS(\r)
102
	sw $t1,EOFFSET_EPC(\r)
103
	mtc0 $t0, $status
306 palkovsky 104
.endm
105
 
106
.macro REGISTERS_LOAD r
1096 palkovsky 107
	# Update only UM,EXR,IE from status, the rest
108
	# is controlled by OS and not bound to task
109
	mfc0 $t0, $status
110
	lw $t1,EOFFSET_STATUS(\r)
111
 
2607 jermar 112
	li $t2, ~REG_SAVE_MASK		# Mask UM,EXL,ERL,IE
1096 palkovsky 113
	and $t0, $t0, $t2
114
 
2607 jermar 115
	or $t0, $t0, $t1		# Copy UM,EXL, ERL, IE from saved status
1096 palkovsky 116
	mtc0 $t0, $status
117
 
2607 jermar 118
	lw $v0, EOFFSET_V0(\r)
119
	lw $v1, EOFFSET_V1(\r)
120
	lw $a0, EOFFSET_A0(\r)
121
	lw $a1, EOFFSET_A1(\r)
122
	lw $a2, EOFFSET_A2(\r)
123
	lw $a3, EOFFSET_A3(\r)
124
	lw $t0, EOFFSET_T0(\r)
125
	lw $t1, EOFFSET_T1(\r)
126
	lw $t2, EOFFSET_T2(\r)
127
	lw $t3, EOFFSET_T3(\r)
128
	lw $t4, EOFFSET_T4(\r)
129
	lw $t5, EOFFSET_T5(\r)
130
	lw $t6, EOFFSET_T6(\r)
131
	lw $t7, EOFFSET_T7(\r)
132
	lw $t8, EOFFSET_T8(\r)
133
	lw $t9, EOFFSET_T9(\r)
1094 palkovsky 134
 
135
#ifdef CONFIG_DEBUG_ALLREGS	
2607 jermar 136
	lw $s0, EOFFSET_S0(\r)
137
	lw $s1, EOFFSET_S1(\r)
138
	lw $s2, EOFFSET_S2(\r)
139
	lw $s3, EOFFSET_S3(\r)
140
	lw $s4, EOFFSET_S4(\r)
141
	lw $s5, EOFFSET_S5(\r)
142
	lw $s6, EOFFSET_S6(\r)
143
	lw $s7, EOFFSET_S7(\r)
144
	lw $s8, EOFFSET_S8(\r)
1094 palkovsky 145
#endif
2607 jermar 146
	lw $gp, EOFFSET_GP(\r)
147
	lw $ra, EOFFSET_RA(\r)
148
	lw $k1, EOFFSET_K1(\r)
306 palkovsky 149
 
2607 jermar 150
	lw $at, EOFFSET_LO(\r)
313 palkovsky 151
	mtlo $at
2607 jermar 152
	lw $at, EOFFSET_HI(\r)
313 palkovsky 153
	mthi $at
154
 
2607 jermar 155
	lw $at, EOFFSET_EPC(\r)
317 palkovsky 156
	mtc0 $at, $epc
313 palkovsky 157
 
2607 jermar 158
	lw $at, EOFFSET_AT(\r)
159
	lw $sp, EOFFSET_SP(\r)
306 palkovsky 160
.endm
161
 
313 palkovsky 162
# Move kernel stack pointer address to register K0
163
# - if we are in user mode, load the appropriate stack
164
# address
165
.macro KERNEL_STACK_TO_K0
166
	# If we are in user mode
167
	mfc0 $k0, $status
168
	andi $k0, 0x10
306 palkovsky 169
 
313 palkovsky 170
	beq $k0, $0, 1f
171
	add $k0, $sp, 0
172
 
173
	# Move $k0 pointer to kernel stack
174
	lui $k0, %hi(supervisor_sp)
320 palkovsky 175
	ori $k0, $k0, %lo(supervisor_sp)
313 palkovsky 176
	# Move $k0 (superveisor_sp)
177
	lw $k0, 0($k0)
178
1:		
179
.endm
180
 
1 jermar 181
.org 0x0
306 palkovsky 182
kernel_image_start:
183
	/* Load temporary stack */
313 palkovsky 184
	lui $sp, %hi(end_stack)
320 palkovsky 185
	ori $sp, $sp, %lo(end_stack)
1686 decky 186
 
187
	/* $a1 contains physical address of bootinfo_t */
188
	/* $a2 contains size of bootinfo_t */
189
 
190
	beq $a2, $0, bootinfo_end
191
 
306 palkovsky 192
	/* Not sure about this, but might be needed for PIC code???? */
193
	lui $gp, 0x8000
194
 
1686 decky 195
	lui $a3, %hi(bootinfo)
196
	ori $a3, $a3, %lo(bootinfo)
197
 
198
	bootinfo_loop:
199
 
200
		lw $v0, 0($a1)
201
		sw $v0, 0($a3)
202
 
203
		addi $a1, $a1, 4
204
		addi $a3, $a3, 4
205
		addi $a2, $a2, -4
206
 
207
		bgtz $a2, bootinfo_loop
208
		nop
209
 
210
	bootinfo_end:
211
 
1222 decky 212
	jal arch_pre_main
306 palkovsky 213
	nop
1222 decky 214
 
215
	j main_bsp
216
	nop
306 palkovsky 217
 
218
	.space TEMP_STACK_SIZE
326 palkovsky 219
end_stack:
220
 
221
tlb_refill_entry:
222
	j tlb_refill_handler
223
	nop
224
 
225
cache_error_entry:
226
	j cache_error_handler
227
	nop
228
 
229
exception_entry:
230
	j exception_handler
231
	nop	
306 palkovsky 232
 
313 palkovsky 233
exception_handler:
234
	KERNEL_STACK_TO_K0
235
	sub $k0, REGISTER_SPACE
2607 jermar 236
	sw $sp, EOFFSET_SP($k0)
1102 palkovsky 237
	move $sp, $k0
1096 palkovsky 238
 
1102 palkovsky 239
	mfc0 $k0, $cause
1096 palkovsky 240
 
2607 jermar 241
	sra $k0, $k0, 0x2		# cp0_exc_cause() part 1
242
	andi $k0, $k0, 0x1f		# cp0_exc_cause() part 2
243
	sub $k0, 8			# 8 = SYSCALL
1096 palkovsky 244
 
1102 palkovsky 245
	beqz $k0, syscall_shortcut
2607 jermar 246
	add $k0, 8			# Revert $k0 back to correct exc number
1096 palkovsky 247
 
1102 palkovsky 248
	REGISTERS_STORE_AND_EXC_RESET $sp
249
 
1096 palkovsky 250
	move $a1, $sp
2607 jermar 251
	jal exc_dispatch		# exc_dispatch(excno, register_space)
1102 palkovsky 252
	move $a0, $k0
313 palkovsky 253
 
254
	REGISTERS_LOAD $sp
255
	# The $sp is automatically restored to former value
256
	eret
1096 palkovsky 257
 
2607 jermar 258
## Syscall entry
259
#
260
# Registers:
261
#
262
# @param v0		Syscall number.
263
# @param a0		1st argument.
264
# @param a1		2nd argument.
265
# @param a2		3rd argument.
266
# @param a3		4th argument.
267
# @param t0		5th argument.
268
# @param t1		6th argument.
269
#
270
# @return		The return value will be stored in v0.
271
#
272
#define SS_SP		EOFFSET_SP
273
#define SS_STATUS	EOFFSET_STATUS
274
#define SS_EPC		EOFFSET_EPC
275
#define SS_K1		EOFFSET_K1
1100 palkovsky 276
syscall_shortcut:
1096 palkovsky 277
	# We have a lot of space on the stack, with free use
2607 jermar 278
	mfc0 $t3, $epc
279
	mfc0 $t2, $status
280
	sw $t3, SS_EPC($sp)		# Save EPC
281
	sw $k1, SS_K1($sp)   		# Save k1 not saved on context switch
313 palkovsky 282
 
2607 jermar 283
	and $t4, $t2, REG_SAVE_MASK	# Save only KSU, EXL, ERL, IE
284
	li $t5, ~(0x1f)
285
	and $t2, $t2, $t5		# Clear KSU, EXL, ERL
286
	ori $t2, $t2, 0x1		# Set IE
1096 palkovsky 287
 
2607 jermar 288
	sw $t4, SS_STATUS($sp)
289
	mtc0 $t2, $status
1096 palkovsky 290
 
2607 jermar 291
	#
292
	# Call the higher level system call handler
293
	# We are going to reuse part of the unused exception stack frame
294
	#
295
	sw $t0, STACK_ARG4($sp)		# save the 5th argument on the stack
296
	sw $t1, STACK_ARG5($sp)		# save the 6th argument on the stack
1096 palkovsky 297
	jal syscall_handler
2607 jermar 298
	sw $v0, STACK_ARG6($sp)		# save the syscall number on the stack
1096 palkovsky 299
 
300
	# restore status
2607 jermar 301
	mfc0 $t2, $status
302
	lw $t3, SS_STATUS($sp)
1096 palkovsky 303
 
2607 jermar 304
	# Change back to EXL = 1 (from last exception), otherwise
305
	# an interrupt could rewrite the CP0 - EPC
306
	li $t4, ~REG_SAVE_MASK		# Mask UM, EXL, ERL, IE
307
	and $t2, $t2, $t4
308
	or $t2, $t2, $t3		# Copy saved UM, EXL, ERL, IE
309
	mtc0 $t2, $status
1096 palkovsky 310
 
2607 jermar 311
	# restore epc + 4
312
	lw $t2, SS_EPC($sp)
313
	lw $k1, SS_K1($sp)
314
	addi $t2, $t2, 4
315
	mtc0 $t2, $epc
1126 palkovsky 316
 
2607 jermar 317
	lw $sp, SS_SP($sp)		# restore sp
1096 palkovsky 318
 
319
	eret
1278 palkovsky 320
 
1 jermar 321
tlb_refill_handler:
313 palkovsky 322
	KERNEL_STACK_TO_K0
323
	sub $k0, REGISTER_SPACE
1096 palkovsky 324
	REGISTERS_STORE_AND_EXC_RESET $k0
1102 palkovsky 325
	sw $sp,EOFFSET_SP($k0)
313 palkovsky 326
	add $sp, $k0, 0
125 jermar 327
 
1769 jermar 328
	jal tlb_refill
317 palkovsky 329
	add $a0, $sp, 0 
125 jermar 330
 
306 palkovsky 331
	REGISTERS_LOAD $sp
125 jermar 332
 
50 jermar 333
	eret
1 jermar 334
 
335
cache_error_handler:
313 palkovsky 336
	KERNEL_STACK_TO_K0
1102 palkovsky 337
	sub $k0, REGISTER_SPACE
338
	REGISTERS_STORE_AND_EXC_RESET $k0
339
	sw $sp,EOFFSET_SP($k0)
313 palkovsky 340
	add $sp, $k0, 0
1 jermar 341
 
50 jermar 342
	jal cache_error
1769 jermar 343
	add $a0, $sp, 0 
125 jermar 344
 
306 palkovsky 345
	REGISTERS_LOAD $sp
1 jermar 346
 
50 jermar 347
	eret
313 palkovsky 348
 
349
userspace_asm:
350
	add $sp, $a0, 0
1122 palkovsky 351
	add $v0, $a1, 0 
2607 jermar 352
	add $t9, $a2, 0			# Set up correct entry into PIC code 
313 palkovsky 353
	eret