[net-next-2.6.git] / arch / x86 / kernel / acpi / wakeup_32.S

	.section .text..page_aligned
#include <linux/linkage.h>
#include <asm/segment.h>
#include <asm/page_types.h>

# Copyright 2003, 2008 Pavel Machek <pavel@suse.cz>, distribute under GPLv2

	.code32
	ALIGN

ENTRY(wakeup_pmode_return)
wakeup_pmode_return:
	movw	$__KERNEL_DS, %ax
	movw	%ax, %ss
	movw	%ax, %ds
	movw	%ax, %es
	movw	%ax, %fs
	movw	%ax, %gs

	# reload the gdt, as we need the full 32 bit address
	lgdt	saved_gdt
	lidt	saved_idt
	lldt	saved_ldt
	ljmp	$(__KERNEL_CS), $1f
1:
	movl	%cr3, %eax
	movl	%eax, %cr3
	wbinvd

	# and restore the stack ... but you need gdt for this to work
	movl	saved_context_esp, %esp

	movl	%cs:saved_magic, %eax
	cmpl	$0x12345678, %eax
	jne	bogus_magic

	# jump to place where we left off
	movl	saved_eip, %eax
	jmp	*%eax

bogus_magic:
	jmp	bogus_magic


save_registers:
	sgdt	saved_gdt
	sidt	saved_idt
	sldt	saved_ldt
	str	saved_tss

	leal	4(%esp), %eax
	movl	%eax, saved_context_esp
	movl	%ebx, saved_context_ebx
	movl	%ebp, saved_context_ebp
	movl	%esi, saved_context_esi
	movl	%edi, saved_context_edi
	pushfl
	popl	saved_context_eflags

	movl	$ret_point, saved_eip
	ret


restore_registers:
	movl	saved_context_ebp, %ebp
	movl	saved_context_ebx, %ebx
	movl	saved_context_esi, %esi
	movl	saved_context_edi, %edi
	pushl	saved_context_eflags
	popfl
	ret

ENTRY(do_suspend_lowlevel)
	call	save_processor_state
	call	save_registers
	pushl	$3
	call	acpi_enter_sleep_state
	addl	$4, %esp

#	In case of S3 failure, we'll emerge here.  Jump
# 	to ret_point to recover
	jmp	ret_point
	.p2align 4,,7
ret_point:
	call	restore_registers
	call	restore_processor_state
	ret

.data
ALIGN
ENTRY(saved_magic)	.long	0
ENTRY(saved_eip)	.long	0

# saved registers
saved_gdt:	.long	0,0
saved_idt:	.long	0,0
saved_ldt:	.long	0
saved_tss:	.long	0
Commit	Line	Data
819d6762	1	.section .text..page_aligned
1da177e4 LT	2	#include <linux/linkage.h>
1da177e4 LT	3	#include <asm/segment.h>
0341c14d	4	#include <asm/page_types.h>
1da177e4	5
e44b7b75	6	# Copyright 2003, 2008 Pavel Machek <pavel@suse.cz>, distribute under GPLv2
1da177e4	7
1da177e4 LT	8	.code32
	9	ALIGN
	10
e44b7b75	11	ENTRY(wakeup_pmode_return)
1da177e4 LT	12	wakeup_pmode_return:
	13	movw $__KERNEL_DS, %ax
	14	movw %ax, %ss
	15	movw %ax, %ds
	16	movw %ax, %es
	17	movw %ax, %fs
	18	movw %ax, %gs
1da177e4 LT	19
	20	# reload the gdt, as we need the full 32 bit address
	21	lgdt saved_gdt
	22	lidt saved_idt
	23	lldt saved_ldt
e44b7b75	24	ljmp $(__KERNEL_CS), $1f
1da177e4 LT	25	1:
	26	movl %cr3, %eax
	27	movl %eax, %cr3
	28	wbinvd
	29
	30	# and restore the stack ... but you need gdt for this to work
	31	movl saved_context_esp, %esp
	32
	33	movl %cs:saved_magic, %eax
	34	cmpl $0x12345678, %eax
	35	jne bogus_magic
	36
	37	# jump to place where we left off
e44b7b75	38	movl saved_eip, %eax
1da177e4 LT	39	jmp *%eax
	40
	41	bogus_magic:
1da177e4 LT	42	jmp bogus_magic
	43
	44
1da177e4	45
e44b7b75	46	save_registers:
1da177e4 LT	47	sgdt saved_gdt
	48	sidt saved_idt
	49	sldt saved_ldt
	50	str saved_tss
	51
1da177e4 LT	52	leal 4(%esp), %eax
1da177e4 LT	53	movl %eax, saved_context_esp
e44b7b75 PM	54	movl %ebx, saved_context_ebx
	55	movl %ebp, saved_context_ebp
	56	movl %esi, saved_context_esi
	57	movl %edi, saved_context_edi
	58	pushfl
	59	popl saved_context_eflags
	60
	61	movl $ret_point, saved_eip
1da177e4 LT	62	ret
	63
	64
	65	restore_registers:
e44b7b75 PM	66	movl saved_context_ebp, %ebp
	67	movl saved_context_ebx, %ebx
	68	movl saved_context_esi, %esi
	69	movl saved_context_edi, %edi
	70	pushl saved_context_eflags
	71	popfl
	72	ret
1da177e4 LT	73
	74	ENTRY(do_suspend_lowlevel)
	75	call save_processor_state
	76	call save_registers
	77	pushl $3
	78	call acpi_enter_sleep_state
	79	addl $4, %esp
4e6e6504 WM	80
	81	# In case of S3 failure, we'll emerge here. Jump
	82	# to ret_point to recover
	83	jmp ret_point
1da177e4 LT	84	.p2align 4,,7
	85	ret_point:
	86	call restore_registers
	87	call restore_processor_state
	88	ret
	89
daacf8bc	90	.data
1da177e4	91	ALIGN
daacf8bc SL	92	ENTRY(saved_magic) .long 0
	93	ENTRY(saved_eip) .long 0
	94
1da177e4 LT	95	# saved registers
	96	saved_gdt: .long 0,0
	97	saved_idt: .long 0,0
	98	saved_ldt: .long 0
	99	saved_tss: .long 0
	100