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
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
|
// Code for handling calls to "post" that are resume related.
//
// Copyright (C) 2008,2009 Kevin O'Connor <kevin@koconnor.net>
//
// This file may be distributed under the terms of the GNU LGPLv3 license.
#include "util.h" // dprintf
#include "ioport.h" // outb
#include "pic.h" // eoi_pic2
#include "biosvar.h" // struct bios_data_area_s
#include "bregs.h" // struct bregs
#include "acpi.h" // find_resume_vector
#include "ps2port.h" // i8042_reboot
#include "pci.h" // pci_reboot
#include "cmos.h" // inb_cmos
// Indicator if POST phase has been run.
int HaveRunPost VARFSEG;
// Reset DMA controller
void
dma_setup(void)
{
// first reset the DMA controllers
outb(0, PORT_DMA1_MASTER_CLEAR);
outb(0, PORT_DMA2_MASTER_CLEAR);
// then initialize the DMA controllers
outb(0xc0, PORT_DMA2_MODE_REG);
outb(0x00, PORT_DMA2_MASK_REG);
}
// Handler for post calls that look like a resume.
void VISIBLE16
handle_resume(void)
{
ASSERT16();
debug_serial_preinit();
int status = inb_cmos(CMOS_RESET_CODE);
outb_cmos(0, CMOS_RESET_CODE);
dprintf(1, "In resume (status=%d)\n", status);
dma_setup();
switch (status) {
case 0x01 ... 0x04:
case 0x06 ... 0x09:
panic("Unimplemented shutdown status: %02x\n", status);
case 0x05:
// flush keyboard (issue EOI) and jump via 40h:0067h
eoi_pic2();
// NO BREAK
case 0x0a:
#define BDA_JUMP (((struct bios_data_area_s *)0)->jump)
// resume execution by jump via 40h:0067h
asm volatile(
"movw %w1, %%ds\n"
"ljmpw *%0\n"
: : "m"(BDA_JUMP), "r"(SEG_BDA)
);
break;
case 0x0b:
// resume execution via IRET via 40h:0067h
asm volatile(
"movw %w1, %%ds\n"
"lssw %0, %%sp\n"
"iretw\n"
: : "m"(BDA_JUMP), "r"(SEG_BDA)
);
break;
case 0x0c:
// resume execution via RETF via 40h:0067h
asm volatile(
"movw %w1, %%ds\n"
"lssw %0, %%sp\n"
"lretw\n"
: : "m"(BDA_JUMP), "r"(SEG_BDA)
);
break;
default:
break;
}
// Not a 16bit resume - do remaining checks in 32bit mode
asm volatile(
"movw %w1, %%ss\n"
"movl %0, %%esp\n"
"movl $_cfunc32flat_handle_resume32, %%edx\n"
"jmp transition32\n"
: : "i"(BUILD_S3RESUME_STACK_ADDR), "r"(0), "a"(status)
);
}
// Handle an S3 resume event
static void
s3_resume(void)
{
if (!CONFIG_S3_RESUME)
return;
u32 s3_resume_vector = find_resume_vector();
if (!s3_resume_vector) {
dprintf(1, "No resume vector set!\n");
return;
}
pic_setup();
smm_setup();
s3_resume_vga();
make_bios_readonly();
// Invoke the resume vector.
struct bregs br;
memset(&br, 0, sizeof(br));
dprintf(1, "Jump to resume vector (%x)\n", s3_resume_vector);
br.code = FLATPTR_TO_SEGOFF((void*)s3_resume_vector);
farcall16big(&br);
}
u8 HaveAttemptedReboot VARLOW;
// Attempt to invoke a hard-reboot.
static void
tryReboot(void)
{
if (HaveAttemptedReboot) {
// Hard reboot has failed - try to shutdown machine.
dprintf(1, "Unable to hard-reboot machine - attempting shutdown.\n");
apm_shutdown();
}
HaveAttemptedReboot = 1;
dprintf(1, "Attempting a hard reboot\n");
// Setup for reset on qemu.
qemu_prep_reset();
// Reboot using ACPI RESET_REG
acpi_reboot();
// Try keyboard controller reboot.
i8042_reboot();
// Try PCI 0xcf9 reboot
pci_reboot();
// Try triple fault
asm volatile("int3");
panic("Could not reboot");
}
void VISIBLE32FLAT
handle_resume32(int status)
{
ASSERT32FLAT();
dprintf(1, "In 32bit resume\n");
if (status == 0xfe)
s3_resume();
// Must be a soft reboot - invoke a hard reboot.
tryReboot();
}
|
