WebSVN – HelenOS-historic – Diff – /kernel/trunk/arch/amd64/src/asm_utils.S


#
# Copyright (C) 2005 Ondrej Palkovsky
# 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.
#
 
 
#  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
 
#include <arch/pm.h>
	
.text
.global interrupt_handlers
.global panic_printf
 
panic_printf:
	movq $halt, (%rsp)
	jmp printf
 
.global memcpy
memcpy:
	jmp _memcpy
	
.global cpuid
.global has_cpuid
.global rdtsc
.global read_efer_flag
.global set_efer_flag
	
 
# THIS IS USERSPACE CODE
.global utext
utext:
0:
	int $48
	jmp 0b
	# not reached
utext_end:
 
.data
.global utext_size
utext_size:
	.long utext_end - utext 
 
	
## Determine CPUID support
#
# Return 0 in EAX if CPUID is not support, 1 if supported.
#
has_cpuid:
	pushfq			# store flags
	popq %rax		# read flags
	movq %rax,%rdx		# copy flags
	btcl $21,%edx		# swap the ID bit
	pushq %rdx
	popfq			# propagate the change into flags
	pushfq
	popq %rdx		# read flags	
	andl $(1<<21),%eax	# interested only in ID bit
	andl $(1<<21),%edx
	xorl %edx,%eax		# 0 if not supported, 1 if supported
	ret
 
cpuid:
	movq %rbx, %r10  # we have to preserve rbx across function calls
 
	movl %edi,%eax	# load the command into %eax
 
	cpuid	
	movl %eax,0(%rsi)
	movl %ebx,4(%rsi)
	movl %ecx,8(%rsi)
	movl %edx,12(%rsi)
 
	movq %r10, %rbx
	ret
 
rdtsc:
	xorq %rax,%rax
	rdtsc
	ret
 
set_efer_flag:
	movq $0xc0000080, %rcx
	rdmsr
	btsl %edi, %eax
	wrmsr
	ret
	
read_efer_flag:	
	movq $0xc0000080, %rcx
	rdmsr
	ret 		
 
# Push all general purpose registers on stack except %rbp, %rsp
.macro push_all_gpr
	pushq %rax 
	pushq %rbx
	pushq %rcx
	pushq %rdx
	pushq %rsi
	pushq %rdi
	pushq %r8
	pushq %r9
	pushq %r10
	pushq %r11
	pushq %r12
	pushq %r13
	pushq %r14
	pushq %r15
.endm
 
.macro pop_all_gpr
	popq %r15
	popq %r14
	popq %r13
	popq %r12
	popq %r11
	popq %r10
	popq %r9
	popq %r8
	popq %rdi
	popq %rsi
	popq %rdx
	popq %rcx
	popq %rbx
	popq %rax
.endm
	
## 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
	pushq %rbp
	movq %rsp,%rbp
	
	push_all_gpr
 
	movq $(\i),%rdi   # %rdi - first parameter
	movq %rbp, %rsi
	addq $8, %rsi     # %rsi - second parameter - original stack
	call exc_dispatch 	# exc_dispatch(i, stack)
 
# Test if this is interrupt with error word or not
	mov $\i,%cl;
	movl $1,%eax;
	test $0xe0,%cl;
	jnz 0f;
	and $0x1f,%cl;
	shl %cl,%eax;
	and $ERROR_WORD_INTERRUPT_LIST,%eax;
	jz 0f;
 
 
# Return with error word
	pop_all_gpr
	
	popq %rbp;
	add $8,%esp;    # Skip error word
	iretq
 
0:
# Return with no error word
	pop_all_gpr
	
	popq %rbp
	iretq
 
	.if (\n-\i)-1
	handler "(\i+1)",\n
	.endif
.endm
	
interrupt_handlers:
h_start:
	handler 0 IDT_ITEMS
h_end:
	
	
.data
.global interrupt_handler_size
 
interrupt_handler_size: .long (h_end-h_start)/IDT_ITEMS
 

Rev 534	Rev 576
1	#	1	#
2	# Copyright (C) 2005 Ondrej Palkovsky	2	# Copyright (C) 2005 Ondrej Palkovsky
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		29
30	# Mask for interrupts 0 - 31 (bits 0 - 31) where 0 means that int has no error word	30	# Mask for interrupts 0 - 31 (bits 0 - 31) where 0 means that int has no error word
31	# and 1 means interrupt with error word	31	# and 1 means interrupt with error word
32		32
33		33
34	#define ERROR_WORD_INTERRUPT_LIST 0x00027D00	34	#define ERROR_WORD_INTERRUPT_LIST 0x00027D00
35		35
36	#include <arch/pm.h>	36	#include <arch/pm.h>
37		37
38	.text	38	.text
39	.global interrupt_handlers	39	.global interrupt_handlers
40	.global panic_printf	40	.global panic_printf
41		41
42	panic_printf:	42	panic_printf:
43	movq $halt, (%rsp)	43	movq $halt, (%rsp)
44	jmp printf	44	jmp printf
45		45
46	.global memcpy	46	.global memcpy
47	memcpy:	47	memcpy:
48	jmp _memcpy	48	jmp _memcpy
49		49
50	.global cpuid	50	.global cpuid
51	.global has_cpuid	51	.global has_cpuid
52	.global rdtsc	52	.global rdtsc
53	.global read_efer_flag	53	.global read_efer_flag
54	.global set_efer_flag	54	.global set_efer_flag
55		55
56		56
57	# THIS IS USERSPACE CODE	57	# THIS IS USERSPACE CODE
58	.global utext	58	.global utext
59	utext:	59	utext:
60	0:	60	0:
61	int $48	61	int $48
62	jmp 0b	62	jmp 0b
63	# not reached	63	# not reached
64	utext_end:	64	utext_end:
65		65
66	.data	66	.data
67	.global utext_size	67	.global utext_size
68	utext_size:	68	utext_size:
69	.long utext_end - utext	69	.long utext_end - utext
70		70
71		71
72	## Determine CPUID support	72	## Determine CPUID support
73	#	73	#
74	# Return 0 in EAX if CPUID is not support, 1 if supported.	74	# Return 0 in EAX if CPUID is not support, 1 if supported.
75	#	75	#
76	has_cpuid:	76	has_cpuid:
77	pushfq # store flags	77	pushfq # store flags
78	popq %rax # read flags	78	popq %rax # read flags
79	movq %rax,%rdx # copy flags	79	movq %rax,%rdx # copy flags
80	btcl $21,%edx # swap the ID bit	80	btcl $21,%edx # swap the ID bit
81	pushq %rdx	81	pushq %rdx
82	popfq # propagate the change into flags	82	popfq # propagate the change into flags
83	pushfq	83	pushfq
84	popq %rdx # read flags	84	popq %rdx # read flags
85	andl $(1<<21),%eax # interested only in ID bit	85	andl $(1<<21),%eax # interested only in ID bit
86	andl $(1<<21),%edx	86	andl $(1<<21),%edx
87	xorl %edx,%eax # 0 if not supported, 1 if supported	87	xorl %edx,%eax # 0 if not supported, 1 if supported
88	ret	88	ret
89		89
90	cpuid:	90	cpuid:
91	movq %rbx, %r10 # we have to preserve rbx across function calls	91	movq %rbx, %r10 # we have to preserve rbx across function calls
92		92
93	movl %edi,%eax # load the command into %eax	93	movl %edi,%eax # load the command into %eax
94		94
95	cpuid	95	cpuid
96	movl %eax,0(%rsi)	96	movl %eax,0(%rsi)
97	movl %ebx,4(%rsi)	97	movl %ebx,4(%rsi)
98	movl %ecx,8(%rsi)	98	movl %ecx,8(%rsi)
99	movl %edx,12(%rsi)	99	movl %edx,12(%rsi)
100		100
101	movq %r10, %rbx	101	movq %r10, %rbx
102	ret	102	ret
103		103
104	rdtsc:	104	rdtsc:
105	xorq %rax,%rax	105	xorq %rax,%rax
106	rdtsc	106	rdtsc
107	ret	107	ret
108		108
109	set_efer_flag:	109	set_efer_flag:
110	movq $0xc0000080, %rcx	110	movq $0xc0000080, %rcx
111	rdmsr	111	rdmsr
112	btsl %edi, %eax	112	btsl %edi, %eax
113	wrmsr	113	wrmsr
114	ret	114	ret
115		115
116	read_efer_flag:	116	read_efer_flag:
117	movq $0xc0000080, %rcx	117	movq $0xc0000080, %rcx
118	rdmsr	118	rdmsr
119	ret	119	ret
120		120
121	# Push all general purpose registers on stack except %rbp, %rsp	121	# Push all general purpose registers on stack except %rbp, %rsp
122	.macro push_all_gpr	122	.macro push_all_gpr
123	pushq %rax	123	pushq %rax
124	pushq %rbx	124	pushq %rbx
125	pushq %rcx	125	pushq %rcx
126	pushq %rdx	126	pushq %rdx
127	pushq %rsi	127	pushq %rsi
128	pushq %rdi	128	pushq %rdi
129	pushq %r8	129	pushq %r8
130	pushq %r9	130	pushq %r9
131	pushq %r10	131	pushq %r10
132	pushq %r11	132	pushq %r11
133	pushq %r12	133	pushq %r12
134	pushq %r13	134	pushq %r13
135	pushq %r14	135	pushq %r14
136	pushq %r15	136	pushq %r15
137	.endm	137	.endm
138		138
139	.macro pop_all_gpr	139	.macro pop_all_gpr
140	popq %r15	140	popq %r15
141	popq %r14	141	popq %r14
142	popq %r13	142	popq %r13
143	popq %r12	143	popq %r12
144	popq %r11	144	popq %r11
145	popq %r10	145	popq %r10
146	popq %r9	146	popq %r9
147	popq %r8	147	popq %r8
148	popq %rdi	148	popq %rdi
149	popq %rsi	149	popq %rsi
150	popq %rdx	150	popq %rdx
151	popq %rcx	151	popq %rcx
152	popq %rbx	152	popq %rbx
153	popq %rax	153	popq %rax
154	.endm	154	.endm
155		155
156	## Declare interrupt handlers	156	## Declare interrupt handlers
157	#	157	#
158	# Declare interrupt handlers for n interrupt	158	# Declare interrupt handlers for n interrupt
159	# vectors starting at vector i.	159	# vectors starting at vector i.
160	#	160	#
161	# The handlers setup data segment registers	161	# The handlers setup data segment registers
162	# and call trap_dispatcher().	162	# and call exc_dispatch().
163	#	163	#
164	.macro handler i n	164	.macro handler i n
165	pushq %rbp	165	pushq %rbp
166	movq %rsp,%rbp	166	movq %rsp,%rbp
167		167
168	push_all_gpr	168	push_all_gpr
169		169
170	movq $(\i),%rdi # %rdi - first parameter	170	movq $(\i),%rdi # %rdi - first parameter
171	movq %rbp, %rsi	171	movq %rbp, %rsi
172	addq $8, %rsi # %rsi - second parameter - original stack	172	addq $8, %rsi # %rsi - second parameter - original stack
173	call trap_dispatcher # trap_dispatcher(i, stack)	173	call exc_dispatch # exc_dispatch(i, stack)
174		174
175	# Test if this is interrupt with error word or not	175	# Test if this is interrupt with error word or not
176	mov $\i,%cl;	176	mov $\i,%cl;
177	movl $1,%eax;	177	movl $1,%eax;
178	test $0xe0,%cl;	178	test $0xe0,%cl;
179	jnz 0f;	179	jnz 0f;
180	and $0x1f,%cl;	180	and $0x1f,%cl;
181	shl %cl,%eax;	181	shl %cl,%eax;
182	and $ERROR_WORD_INTERRUPT_LIST,%eax;	182	and $ERROR_WORD_INTERRUPT_LIST,%eax;
183	jz 0f;	183	jz 0f;
184		184
185		185
186	# Return with error word	186	# Return with error word
187	pop_all_gpr	187	pop_all_gpr
188		188
189	popq %rbp;	189	popq %rbp;
190	add $8,%esp; # Skip error word	190	add $8,%esp; # Skip error word
191	iretq	191	iretq
192		192
193	0:	193	0:
194	# Return with no error word	194	# Return with no error word
195	pop_all_gpr	195	pop_all_gpr
196		196
197	popq %rbp	197	popq %rbp
198	iretq	198	iretq
199		199
200	.if (\n-\i)-1	200	.if (\n-\i)-1
201	handler "(\i+1)",\n	201	handler "(\i+1)",\n
202	.endif	202	.endif
203	.endm	203	.endm
204		204
205	interrupt_handlers:	205	interrupt_handlers:
206	h_start:	206	h_start:
207	handler 0 IDT_ITEMS	207	handler 0 IDT_ITEMS
208	h_end:	208	h_end:
209		209
210		210
211	.data	211	.data
212	.global interrupt_handler_size	212	.global interrupt_handler_size
213		213
214	interrupt_handler_size: .long (h_end-h_start)/IDT_ITEMS	214	interrupt_handler_size: .long (h_end-h_start)/IDT_ITEMS
215		215

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/arch/amd64/src/asm_utils.S – Rev 534 → 576