WebSVN – HelenOS-historic – Diff – /kernel/trunk/arch/mips32/src/start.S


#
# Copyright (C) 2003-2004 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/asm/regname.h>
#include <arch/mm/page.h>
#include <arch/asm/boot.h>
#include <arch/context_offset.h>
	
.text
 
.set noat
.set noreorder
.set nomacro
 
.global kernel_image_start
.global tlb_refill_entry
.global cache_error_entry
.global exception_entry
.global userspace_asm
 
# Which status bits should are thread-local
#define REG_SAVE_MASK 0x1f # KSU(UM), EXL, ERL, IE
	
# Save registers to space defined by \r
# We will change status: Disable ERL,EXL,UM,IE
# These changes will be automatically reversed in REGISTER_LOAD
# SP is NOT saved as part of these registers
.macro REGISTERS_STORE_AND_EXC_RESET r
	sw $at,EOFFSET_AT(\r)
	sw $v0,EOFFSET_V0(\r)
	sw $v1,EOFFSET_V1(\r)
	sw $a0,EOFFSET_A0(\r)
	sw $a1,EOFFSET_A1(\r)
	sw $a2,EOFFSET_A2(\r)
	sw $a3,EOFFSET_A3(\r)
	sw $t0,EOFFSET_T0(\r)
	sw $t1,EOFFSET_T1(\r)
	sw $t2,EOFFSET_T2(\r)
	sw $t3,EOFFSET_T3(\r)
	sw $t4,EOFFSET_T4(\r)
	sw $t5,EOFFSET_T5(\r)
	sw $t6,EOFFSET_T6(\r)
	sw $t7,EOFFSET_T7(\r)
	sw $t8,EOFFSET_T8(\r)
	sw $t9,EOFFSET_T9(\r)
 
	mflo $at
	sw $at, EOFFSET_LO(\r)
	mfhi $at
	sw $at, EOFFSET_HI(\r)
	
#ifdef CONFIG_DEBUG_ALLREGS	
	sw $s0,EOFFSET_S0(\r)
	sw $s1,EOFFSET_S1(\r)
	sw $s2,EOFFSET_S2(\r)
	sw $s3,EOFFSET_S3(\r)
	sw $s4,EOFFSET_S4(\r)
	sw $s5,EOFFSET_S5(\r)
	sw $s6,EOFFSET_S6(\r)
	sw $s7,EOFFSET_S7(\r)
	sw $s8,EOFFSET_S8(\r)
#endif
	
	sw $gp,EOFFSET_GP(\r)
	sw $ra,EOFFSET_RA(\r)
	sw $k1,EOFFSET_K1(\r)
 
	mfc0 $t0, $status
	mfc0 $t1, $epc
	
	and $t2, $t0, REG_SAVE_MASK  # Save only KSU,EXL,ERL,IE
	li $t3, ~(0x1f)
	and $t0, $t0, $t3           # Clear KSU,EXL,ERL,IE
	
	sw $t2,EOFFSET_STATUS(\r)
	sw $t1,EOFFSET_EPC(\r)
	mtc0 $t0, $status
.endm
 
.macro REGISTERS_LOAD r
	# Update only UM,EXR,IE from status, the rest
	# is controlled by OS and not bound to task
	mfc0 $t0, $status
	lw $t1,EOFFSET_STATUS(\r)
 
	li $t2, ~REG_SAVE_MASK    # Mask UM,EXL,ERL,IE
	and $t0, $t0, $t2
	
	or $t0, $t0, $t1   # Copy UM,EXL,ERL,IE from saved status
	mtc0 $t0, $status
	
	lw $v0,EOFFSET_V0(\r)
	lw $v1,EOFFSET_V1(\r)
	lw $a0,EOFFSET_A0(\r)
	lw $a1,EOFFSET_A1(\r)
	lw $a2,EOFFSET_A2(\r)
	lw $a3,EOFFSET_A3(\r)
	lw $t0,EOFFSET_T0(\r)
	lw $t1,EOFFSET_T1(\r)
	lw $t2,EOFFSET_T2(\r)
	lw $t3,EOFFSET_T3(\r)
	lw $t4,EOFFSET_T4(\r)
	lw $t5,EOFFSET_T5(\r)
	lw $t6,EOFFSET_T6(\r)
	lw $t7,EOFFSET_T7(\r)
	lw $t8,EOFFSET_T8(\r)
	lw $t9,EOFFSET_T9(\r)
	
#ifdef CONFIG_DEBUG_ALLREGS	
	lw $s0,EOFFSET_S0(\r)
	lw $s1,EOFFSET_S1(\r)
	lw $s2,EOFFSET_S2(\r)
	lw $s3,EOFFSET_S3(\r)
	lw $s4,EOFFSET_S4(\r)
	lw $s5,EOFFSET_S5(\r)
	lw $s6,EOFFSET_S6(\r)
	lw $s7,EOFFSET_S7(\r)
	lw $s8,EOFFSET_S8(\r)
#endif
	lw $gp,EOFFSET_GP(\r)
	lw $ra,EOFFSET_RA(\r)
	lw $k1,EOFFSET_K1(\r)
	
	lw $at,EOFFSET_LO(\r)
	mtlo $at
	lw $at,EOFFSET_HI(\r)
	mthi $at
 
	lw $at,EOFFSET_EPC(\r)
	mtc0 $at, $epc
	
	lw $at,EOFFSET_AT(\r)
	lw $sp,EOFFSET_SP(\r)
.endm
 
# Move kernel stack pointer address to register K0
# - if we are in user mode, load the appropriate stack
# address
.macro KERNEL_STACK_TO_K0
	# If we are in user mode
	mfc0 $k0, $status
	andi $k0, 0x10
	
	beq $k0, $0, 1f
	add $k0, $sp, 0
	
	# Move $k0 pointer to kernel stack
	lui $k0, %hi(supervisor_sp)
	ori $k0, $k0, %lo(supervisor_sp)
	# Move $k0 (superveisor_sp)
	lw $k0, 0($k0)
1:		
.endm
		
.org 0x0
kernel_image_start:
	/* Load temporary stack */
	lui $sp, %hi(end_stack)
	ori $sp, $sp, %lo(end_stack)
	
	/* $a1 contains physical address of bootinfo_t */
	/* $a2 contains size of bootinfo_t */
	
	beq $a2, $0, bootinfo_end
	
	/* Not sure about this, but might be needed for PIC code???? */
	lui $gp, 0x8000
	
 
 
 
	lui $a3, %hi(bootinfo)
	ori $a3, $a3, %lo(bootinfo)
	
	bootinfo_loop:
		
		lw $v0, 0($a1)
		sw $v0, 0($a3)
		
		addi $a1, $a1, 4
		addi $a3, $a3, 4
		addi $a2, $a2, -4
		
		bgtz $a2, bootinfo_loop
		nop
		
	bootinfo_end:
	
	jal arch_pre_main
	nop
	
	j main_bsp
	nop
 
	.space TEMP_STACK_SIZE
end_stack:
 
tlb_refill_entry:
	j tlb_refill_handler
	nop
 
cache_error_entry:
	j cache_error_handler
	nop
 
exception_entry:
	j exception_handler
	nop	
 
	
	
exception_handler:
	KERNEL_STACK_TO_K0
	sub $k0, REGISTER_SPACE
	sw $sp,EOFFSET_SP($k0)
	move $sp, $k0
	
	mfc0 $k0, $cause
	
	sra $k0, $k0, 0x2     # cp0_exc_cause() part 1
	andi $k0, $k0, 0x1f   # cp0_exc_cause() part 2
	sub $k0, 8            # 8=SYSCALL
	
	beqz $k0, syscall_shortcut
	add $k0, 8            # Revert $k0 back to correct exc number
	
	REGISTERS_STORE_AND_EXC_RESET $sp
	
	move $a1, $sp
	jal exc_dispatch      # exc_dispatch(excno, register_space)
	move $a0, $k0
 
	REGISTERS_LOAD $sp
	# The $sp is automatically restored to former value
	eret
 
# it seems that mips reserves some space on stack for varfuncs???
#define SS_ARG4   16
#define SS_SP     EOFFSET_SP
#define SS_STATUS EOFFSET_STATUS
#define SS_EPC    EOFFSET_EPC
#define SS_K1     EOFFSET_K1
syscall_shortcut:
	# We have a lot of space on the stack, with free use
	mfc0 $t1, $epc
	mfc0 $t0, $status
	sw $t1,SS_EPC($sp)  # Save EPC
	sw $k1,SS_K1($sp)   # Save k1, which is not saved during context switch
	
	and $t2, $t0, REG_SAVE_MASK # Save only KSU,EXL,ERL,IE
	li $t3, ~(0x1f)
	and $t0, $t0, $t3           # Clear KSU,EXL,ERL
	ori $t0, $t0, 0x1           # Set IE
 
	sw $t2,SS_STATUS($sp)
	mtc0 $t0, $status
 
	# CALL Syscall handler
	jal syscall_handler
	sw $v0, SS_ARG4($sp)        # save v0 - arg4 to stack
 
	# restore status
	mfc0 $t0, $status
	lw $t1,SS_STATUS($sp)
 
	# Change back to EXL=1(from last exception), otherwise
	# an interrupt could rewrite the CP0-EPC
	li $t2, ~REG_SAVE_MASK      # Mask UM,EXL,ERL,IE
	and $t0, $t0, $t2
	or $t0, $t0, $t1            # Copy UM,EXL,ERL,IE from saved status
	mtc0 $t0, $status
			
	# restore epc+4
	lw $t0,SS_EPC($sp)
	lw $k1,SS_K1($sp)
	addi $t0, $t0, 4
	mtc0 $t0, $epc
	
	lw $sp,SS_SP($sp) # restore sp
	
	eret
		
tlb_refill_handler:
	KERNEL_STACK_TO_K0
	sub $k0, REGISTER_SPACE
	REGISTERS_STORE_AND_EXC_RESET $k0
	sw $sp,EOFFSET_SP($k0)
	add $sp, $k0, 0
 
	jal tlb_refill /* tlb_refill(register_space) */
	add $a0, $sp, 0 
 
	REGISTERS_LOAD $sp
 
	eret
 
cache_error_handler:
	KERNEL_STACK_TO_K0
	sub $k0, REGISTER_SPACE
	REGISTERS_STORE_AND_EXC_RESET $k0
	sw $sp,EOFFSET_SP($k0)
	add $sp, $k0, 0
 
	jal cache_error
	nop
 
	REGISTERS_LOAD $sp
 
	eret
 
userspace_asm:
	add $sp, $a0, 0
	add $v0, $a1, 0 
	add $t9, $a2, 0   # Set up correct entry into PIC code 
	eret
 
 
Generated by GNU Enscript 1.6.6.
 
 
 

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

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/arch/mips32/src/start.S @ 1686 – Rev 1686 → 1749