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

Subversion Repositories HelenOS

(root)/tags/0.1.0/SPARTAN/arch/amd64/src/asm_utils.S – Rev 1962 → 1968