WebSVN – HelenOS-historic – Diff – /kernel/trunk/arch/ia32/src/asm.S


#
# Copyright (C) 2001-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.
#
 
## very low and hardware-level functions
 
# Mask for interrupts 0 - 31 (bits 0 - 31) where 0 means that int has no error word
# and 1 means interrupt with error word
#define ERROR_WORD_INTERRUPT_LIST 0x00027D00
 
.text
 
.global paging_on
.global enable_l_apic_in_msr
.global interrupt_handlers
 
## Turn paging on
#
# Enable paging and write-back caching in CR0.
#
paging_on:
	movl %cr0,%edx
	orl $(1<<31),%edx		# paging on
	andl $~((1<<30)|(1<<29)),%edx	# clear Cache Disable and not Write Though
	movl %edx,%cr0
	jmp 0f
0:
	ret
 
 
## Enable local APIC
#
# Enable local APIC in MSR.
#
enable_l_apic_in_msr:
	push %eax
 
	movl $0x1b, %ecx
	rdmsr
	orl $(1<<11),%eax
	orl $(0xfee00000),%eax
	wrmsr
 
	pop %eax
	ret
 
 
## Declare interrupt handlers
#
# Declare interrupt handlers for n interrupt
# vectors starting at vector i.
#
# The handlers setup data segment registers
# and call exc_dispatch().
#
.macro handler i n
	push %eax
 
	/*
	 * Test if this is interrupt with error word or not.
	 * Be careful about width of the shift.
	 */
	.iflt \i-32
		movl $(1<<\i), %eax
	.else
		movl $0, %eax
	.endif
	andl $ERROR_WORD_INTERRUPT_LIST, %eax
	movl (%esp), %eax
 
	/*
	 * If this interrupt/exception stores error word,
	 * we need to pop EAX.
	 * If this interrupt doesn't store error word, we emulate it
	 * for the sake of consistent istate structure. In that case
	 * we merely leave the EAX on the stack.
	 */
	jz 0f
 
	/*
	 * This exception stores error word.
	 * Remove EAX from the stack.
	 */
	addl $4, %esp
 
 
0:
 
 
 
 
 
 
 
	pusha
	movl %esp, %ebp
	push %ds
	push %es
	push %fs
	push %gs
 
	# we must fill the data segment registers
	movw $16,%ax
	movw %ax,%ds
	movw %ax,%es
 
 
	pushl %ebp
	pushl $(\i)
	call exc_dispatch
	addl $8,%esp
 
	pop %gs
	pop %fs
	pop %es
	pop %ds
 
# Clear Nested Task flag.
	pushfl
	pop %eax
	and $0xffffbfff,%eax
	push %eax
	popfl
	
	popa
	addl $4,%esp	# Skip error word, whether real or fake.
	iret
 
	.if (\n-\i)-1
	handler "(\i+1)",\n
	.endif
.endm
 
# keep in sync with pm.h !!!
IDT_ITEMS=64
interrupt_handlers:
h_start:
	handler 0 64
#	handler 64 128	
#	handler 128 192
#	handler 192 256
h_end:
 
.data
.global interrupt_handler_size
 
interrupt_handler_size: .long (h_end-h_start)/IDT_ITEMS
 

Rev 1008	Rev 1016
1	#	1	#
2	# Copyright (C) 2001-2004 Jakub Jermar	2	# Copyright (C) 2001-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	## very low and hardware-level functions	29	## very low and hardware-level functions
30		30
31	# Mask for interrupts 0 - 31 (bits 0 - 31) where 0 means that int has no error word	31	# Mask for interrupts 0 - 31 (bits 0 - 31) where 0 means that int has no error word
32	# and 1 means interrupt with error word	32	# and 1 means interrupt with error word
33	#define ERROR_WORD_INTERRUPT_LIST 0x00027D00	33	#define ERROR_WORD_INTERRUPT_LIST 0x00027D00
34		34
35	.text	35	.text
36		36
37	.global paging_on	37	.global paging_on
38	.global enable_l_apic_in_msr	38	.global enable_l_apic_in_msr
39	.global interrupt_handlers	39	.global interrupt_handlers
40		40
41	## Turn paging on	41	## Turn paging on
42	#	42	#
43	# Enable paging and write-back caching in CR0.	43	# Enable paging and write-back caching in CR0.
44	#	44	#
45	paging_on:	45	paging_on:
46	movl %cr0,%edx	46	movl %cr0,%edx
47	orl $(1<<31),%edx # paging on	47	orl $(1<<31),%edx # paging on
48	andl $~((1<<30)\|(1<<29)),%edx # clear Cache Disable and not Write Though	48	andl $~((1<<30)\|(1<<29)),%edx # clear Cache Disable and not Write Though
49	movl %edx,%cr0	49	movl %edx,%cr0
50	jmp 0f	50	jmp 0f
51	0:	51	0:
52	ret	52	ret
53		53
54		54
55	## Enable local APIC	55	## Enable local APIC
56	#	56	#
57	# Enable local APIC in MSR.	57	# Enable local APIC in MSR.
58	#	58	#
59	enable_l_apic_in_msr:	59	enable_l_apic_in_msr:
60	push %eax	60	push %eax
61		61
62	movl $0x1b, %ecx	62	movl $0x1b, %ecx
63	rdmsr	63	rdmsr
64	orl $(1<<11),%eax	64	orl $(1<<11),%eax
65	orl $(0xfee00000),%eax	65	orl $(0xfee00000),%eax
66	wrmsr	66	wrmsr
67		67
68	pop %eax	68	pop %eax
69	ret	69	ret
70		70
71		71
72	## Declare interrupt handlers	72	## Declare interrupt handlers
73	#	73	#
74	# Declare interrupt handlers for n interrupt	74	# Declare interrupt handlers for n interrupt
75	# vectors starting at vector i.	75	# vectors starting at vector i.
76	#	76	#
77	# The handlers setup data segment registers	77	# The handlers setup data segment registers
78	# and call exc_dispatch().	78	# and call exc_dispatch().
79	#	79	#
80	.macro handler i n	80	.macro handler i n
81	push %eax	81	push %eax
82		82
83	/*	83	/*
84	* Test if this is interrupt with error word or not.	84	* Test if this is interrupt with error word or not.
85	* Be careful about width of the shift.	85	* Be careful about width of the shift.
86	*/	86	*/
87	.iflt \i-32	87	.iflt \i-32
88	movl $(1<<\i), %eax	88	movl $(1<<\i), %eax
89	.else	89	.else
90	movl $0, %eax	90	movl $0, %eax
91	.endif	91	.endif
92	andl $ERROR_WORD_INTERRUPT_LIST,%eax	92	andl $ERROR_WORD_INTERRUPT_LIST, %eax
-		93	movl (%esp), %eax
93		94
94	/*	95	/*
95	* If this interrupt/exception stores error word,	96	* If this interrupt/exception stores error word,
96	* we need to pop EAX.	97	* we need to pop EAX.
97	* If this interrupt doesn't store error word, we emulate it	98	* If this interrupt doesn't store error word, we emulate it
98	* for the sake of consistent pstate structure. In that case	99	* for the sake of consistent istate structure. In that case
99	* we merely leave the EAX on the stack.	100	* we merely leave the EAX on the stack.
100	*/	101	*/
101	jz 0f	102	jz 0f
102		103
103	/*	104	/*
104	* This exception stores error word.	105	* This exception stores error word.
-		106	* Remove EAX from the stack.
105	*/	107	*/
106	pop %eax	108	addl $4, %esp
107	jmp 1f	-
108		109
109	0:	110	0:
110	/*	-
111	* This interrupt doesn't store error word.	-
112	* Just restore EAX without doing POP.	-
113	*/	-
114	movl (%esp), %eax	-
115		-
116	1:	-
117	pusha	111	pusha
118	movl %esp, %ebp	112	movl %esp, %ebp
119	push %ds	113	push %ds
120	push %es	114	push %es
-		115	push %fs
-		116	push %gs
121		117
122	# we must fill the data segment registers	118	# we must fill the data segment registers
123	movw $16,%ax	119	movw $16,%ax
124	movw %ax,%ds	120	movw %ax,%ds
125	movw %ax,%es	121	movw %ax,%es
126		122
127	movl $(\i),%edi	-
128	pushl %ebp	123	pushl %ebp
129	pushl %edi	124	pushl $(\i)
130	call exc_dispatch	125	call exc_dispatch
131	addl $8,%esp	126	addl $8,%esp
132		127
-		128	pop %gs
-		129	pop %fs
133	pop %es	130	pop %es
134	pop %ds	131	pop %ds
135		132
136	# Clear Nested Task flag.	133	# Clear Nested Task flag.
137	pushfl	134	pushfl
138	pop %eax	135	pop %eax
139	and $0xFFFFBFFF,%eax	136	and $0xffffbfff,%eax
140	push %eax	137	push %eax
141	popfl	138	popfl
142		139
143	popa	140	popa
144	add $4,%esp # Skip error word, whether real or fake.	141	addl $4,%esp # Skip error word, whether real or fake.
145	iret	142	iret
146		143
147	.if (\n-\i)-1	144	.if (\n-\i)-1
148	handler "(\i+1)",\n	145	handler "(\i+1)",\n
149	.endif	146	.endif
150	.endm	147	.endm
151		148
152	# keep in sync with pm.h !!!	149	# keep in sync with pm.h !!!
153	IDT_ITEMS=64	150	IDT_ITEMS=64
154	interrupt_handlers:	151	interrupt_handlers:
155	h_start:	152	h_start:
156	handler 0 64	153	handler 0 64
157	# handler 64 128	154	# handler 64 128
158	# handler 128 192	155	# handler 128 192
159	# handler 192 256	156	# handler 192 256
160	h_end:	157	h_end:
161		158
162	.data	159	.data
163	.global interrupt_handler_size	160	.global interrupt_handler_size
164		161
165	interrupt_handler_size: .long (h_end-h_start)/IDT_ITEMS	162	interrupt_handler_size: .long (h_end-h_start)/IDT_ITEMS
166		163

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/arch/ia32/src/asm.S – Rev 1008 → 1016