summaryrefslogtreecommitdiffstats
path: root/target/linux/olpc/files-2.6.23/arch/i386/kernel/olpc-wakeup.S
blob: a92cc61e248db490dc94b110e23253e0f03045f3 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
.text
#include <linux/linkage.h>
#include <asm/segment.h>
#include <asm/page.h>

ALIGN
	.align 4096

wakeup_start:
#	jmp wakeup_start

	cli
	cld

	# Clear any dangerous flags
	
	pushl $0
	popfl
		
	# Set up %cr3
	movl $swsusp_pg_dir - __PAGE_OFFSET, %eax
	movl %eax, %cr3

	movl saved_cr4, %eax
	movl %eax, %cr4
	
	movl saved_cr0, %eax
	movl %eax, %cr0
	
	jmp 1f
1:	
	ljmpl $__KERNEL_CS,$wakeup_return
	

.org 0x1000

wakeup_return:
	movw    $__KERNEL_DS, %ax
	movw    %ax, %ss
	movw    %ax, %ds
	movw    %ax, %es
	movw    %ax, %fs
	movw    %ax, %gs
	
	lgdt    saved_gdt
	lidt    saved_idt
	lldt    saved_ldt
	ljmp    $(__KERNEL_CS),$1f
1:
	movl    %cr3, %eax
	movl    %eax, %cr3
	wbinvd

	# Go back to the return point
	jmp ret_point
	
save_registers:
	sgdt  saved_gdt
	sidt  saved_idt
	sldt  saved_ldt

	pushl %edx
	movl %cr4, %edx
	movl %edx, saved_cr4

	movl %cr0, %edx
	movl %edx, saved_cr0

	popl %edx
		
	
        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
	
        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_olpc_suspend_lowlevel)
	call	save_processor_state
	call	save_registers

	# This is the stack context we want to remember
	movl %esp, saved_context_esp

	pushl	$3
	call	olpc_do_sleep
	
	jmp	wakeup_start
	.p2align 4,,7
ret_point:
	movl    saved_context_esp, %esp

	call	restore_registers
	call	restore_processor_state
	ret

.data
ALIGN

saved_gdt:     .long   0,0
saved_idt:     .long   0,0
saved_ldt:     .long   0
saved_cr4:     .long   0
saved_cr0:     .long   0