root / hw / acpi.c @ 0834c9ea
History | View | Annotate | Download (13.1 kB)
1 | 6515b203 | bellard | /*
|
---|---|---|---|
2 | 6515b203 | bellard | * ACPI implementation
|
3 | 5fafdf24 | ths | *
|
4 | 6515b203 | bellard | * Copyright (c) 2006 Fabrice Bellard
|
5 | 5fafdf24 | ths | *
|
6 | 6515b203 | bellard | * This library is free software; you can redistribute it and/or
|
7 | 6515b203 | bellard | * modify it under the terms of the GNU Lesser General Public
|
8 | 6515b203 | bellard | * License version 2 as published by the Free Software Foundation.
|
9 | 6515b203 | bellard | *
|
10 | 6515b203 | bellard | * This library is distributed in the hope that it will be useful,
|
11 | 6515b203 | bellard | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
12 | 6515b203 | bellard | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
13 | 6515b203 | bellard | * Lesser General Public License for more details.
|
14 | 6515b203 | bellard | *
|
15 | 6515b203 | bellard | * You should have received a copy of the GNU Lesser General Public
|
16 | 8167ee88 | Blue Swirl | * License along with this library; if not, see <http://www.gnu.org/licenses/>
|
17 | 6b620ca3 | Paolo Bonzini | *
|
18 | 6b620ca3 | Paolo Bonzini | * Contributions after 2012-01-13 are licensed under the terms of the
|
19 | 6b620ca3 | Paolo Bonzini | * GNU GPL, version 2 or (at your option) any later version.
|
20 | 6515b203 | bellard | */
|
21 | 04dc308f | Isaku Yamahata | #include "sysemu.h" |
22 | 87ecb68b | pbrook | #include "hw.h" |
23 | 87ecb68b | pbrook | #include "pc.h" |
24 | 990b150e | Isaku Yamahata | #include "acpi.h" |
25 | 25df49f6 | Luiz Capitulino | #include "monitor.h" |
26 | 6515b203 | bellard | |
27 | 104bf02e | Michael Tokarev | struct acpi_table_header {
|
28 | 104bf02e | Michael Tokarev | uint16_t _length; /* our length, not actual part of the hdr */
|
29 | 104bf02e | Michael Tokarev | /* XXX why we have 2 length fields here? */
|
30 | 104bf02e | Michael Tokarev | char sig[4]; /* ACPI signature (4 ASCII characters) */ |
31 | 8a92ea2f | aliguori | uint32_t length; /* Length of table, in bytes, including header */
|
32 | 8a92ea2f | aliguori | uint8_t revision; /* ACPI Specification minor version # */
|
33 | 8a92ea2f | aliguori | uint8_t checksum; /* To make sum of entire table == 0 */
|
34 | 104bf02e | Michael Tokarev | char oem_id[6]; /* OEM identification */ |
35 | 104bf02e | Michael Tokarev | char oem_table_id[8]; /* OEM table identification */ |
36 | 8a92ea2f | aliguori | uint32_t oem_revision; /* OEM revision number */
|
37 | 104bf02e | Michael Tokarev | char asl_compiler_id[4]; /* ASL compiler vendor ID */ |
38 | 8a92ea2f | aliguori | uint32_t asl_compiler_revision; /* ASL compiler revision number */
|
39 | 541dc0d4 | Stefan Weil | } QEMU_PACKED; |
40 | 8a92ea2f | aliguori | |
41 | 104bf02e | Michael Tokarev | #define ACPI_TABLE_HDR_SIZE sizeof(struct acpi_table_header) |
42 | 104bf02e | Michael Tokarev | #define ACPI_TABLE_PFX_SIZE sizeof(uint16_t) /* size of the extra prefix */ |
43 | 104bf02e | Michael Tokarev | |
44 | 104bf02e | Michael Tokarev | static const char dfl_hdr[ACPI_TABLE_HDR_SIZE] = |
45 | 104bf02e | Michael Tokarev | "\0\0" /* fake _length (2) */ |
46 | 104bf02e | Michael Tokarev | "QEMU\0\0\0\0\1\0" /* sig (4), len(4), revno (1), csum (1) */ |
47 | 104bf02e | Michael Tokarev | "QEMUQEQEMUQEMU\1\0\0\0" /* OEM id (6), table (8), revno (4) */ |
48 | 104bf02e | Michael Tokarev | "QEMU\1\0\0\0" /* ASL compiler ID (4), version (4) */ |
49 | 104bf02e | Michael Tokarev | ; |
50 | 104bf02e | Michael Tokarev | |
51 | 8a92ea2f | aliguori | char *acpi_tables;
|
52 | 8a92ea2f | aliguori | size_t acpi_tables_len; |
53 | 8a92ea2f | aliguori | |
54 | 8a92ea2f | aliguori | static int acpi_checksum(const uint8_t *data, int len) |
55 | 8a92ea2f | aliguori | { |
56 | 8a92ea2f | aliguori | int sum, i;
|
57 | 8a92ea2f | aliguori | sum = 0;
|
58 | 104bf02e | Michael Tokarev | for (i = 0; i < len; i++) { |
59 | 8a92ea2f | aliguori | sum += data[i]; |
60 | 104bf02e | Michael Tokarev | } |
61 | 8a92ea2f | aliguori | return (-sum) & 0xff; |
62 | 8a92ea2f | aliguori | } |
63 | 8a92ea2f | aliguori | |
64 | 104bf02e | Michael Tokarev | /* like strncpy() but zero-fills the tail of destination */
|
65 | 104bf02e | Michael Tokarev | static void strzcpy(char *dst, const char *src, size_t size) |
66 | 104bf02e | Michael Tokarev | { |
67 | 104bf02e | Michael Tokarev | size_t len = strlen(src); |
68 | 104bf02e | Michael Tokarev | if (len >= size) {
|
69 | 104bf02e | Michael Tokarev | len = size; |
70 | 104bf02e | Michael Tokarev | } else {
|
71 | 104bf02e | Michael Tokarev | memset(dst + len, 0, size - len);
|
72 | 104bf02e | Michael Tokarev | } |
73 | 104bf02e | Michael Tokarev | memcpy(dst, src, len); |
74 | 104bf02e | Michael Tokarev | } |
75 | 104bf02e | Michael Tokarev | |
76 | 104bf02e | Michael Tokarev | /* XXX fixme: this function uses obsolete argument parsing interface */
|
77 | 8a92ea2f | aliguori | int acpi_table_add(const char *t) |
78 | 8a92ea2f | aliguori | { |
79 | 8a92ea2f | aliguori | char buf[1024], *p, *f; |
80 | 8a92ea2f | aliguori | unsigned long val; |
81 | 104bf02e | Michael Tokarev | size_t len, start, allen; |
82 | 104bf02e | Michael Tokarev | bool has_header;
|
83 | 104bf02e | Michael Tokarev | int changed;
|
84 | 104bf02e | Michael Tokarev | int r;
|
85 | 104bf02e | Michael Tokarev | struct acpi_table_header hdr;
|
86 | 8a92ea2f | aliguori | |
87 | 104bf02e | Michael Tokarev | r = 0;
|
88 | 104bf02e | Michael Tokarev | r |= get_param_value(buf, sizeof(buf), "data", t) ? 1 : 0; |
89 | 104bf02e | Michael Tokarev | r |= get_param_value(buf, sizeof(buf), "file", t) ? 2 : 0; |
90 | 104bf02e | Michael Tokarev | switch (r) {
|
91 | 104bf02e | Michael Tokarev | case 0: |
92 | 104bf02e | Michael Tokarev | buf[0] = '\0'; |
93 | 104bf02e | Michael Tokarev | /* fallthrough for default behavior */
|
94 | 104bf02e | Michael Tokarev | case 1: |
95 | 104bf02e | Michael Tokarev | has_header = false;
|
96 | 104bf02e | Michael Tokarev | break;
|
97 | 104bf02e | Michael Tokarev | case 2: |
98 | 104bf02e | Michael Tokarev | has_header = true;
|
99 | 104bf02e | Michael Tokarev | break;
|
100 | 104bf02e | Michael Tokarev | default:
|
101 | 104bf02e | Michael Tokarev | fprintf(stderr, "acpitable: both data and file are specified\n");
|
102 | 104bf02e | Michael Tokarev | return -1; |
103 | 104bf02e | Michael Tokarev | } |
104 | 104bf02e | Michael Tokarev | |
105 | 104bf02e | Michael Tokarev | if (!acpi_tables) {
|
106 | 104bf02e | Michael Tokarev | allen = sizeof(uint16_t);
|
107 | 7267c094 | Anthony Liguori | acpi_tables = g_malloc0(allen); |
108 | 8a92ea2f | aliguori | } else {
|
109 | 104bf02e | Michael Tokarev | allen = acpi_tables_len; |
110 | 104bf02e | Michael Tokarev | } |
111 | 104bf02e | Michael Tokarev | |
112 | 104bf02e | Michael Tokarev | start = allen; |
113 | 7267c094 | Anthony Liguori | acpi_tables = g_realloc(acpi_tables, start + ACPI_TABLE_HDR_SIZE); |
114 | 104bf02e | Michael Tokarev | allen += has_header ? ACPI_TABLE_PFX_SIZE : ACPI_TABLE_HDR_SIZE; |
115 | 104bf02e | Michael Tokarev | |
116 | 104bf02e | Michael Tokarev | /* now read in the data files, reallocating buffer as needed */
|
117 | 104bf02e | Michael Tokarev | |
118 | 104bf02e | Michael Tokarev | for (f = strtok(buf, ":"); f; f = strtok(NULL, ":")) { |
119 | 104bf02e | Michael Tokarev | int fd = open(f, O_RDONLY);
|
120 | 104bf02e | Michael Tokarev | |
121 | 104bf02e | Michael Tokarev | if (fd < 0) { |
122 | 104bf02e | Michael Tokarev | fprintf(stderr, "can't open file %s: %s\n", f, strerror(errno));
|
123 | 104bf02e | Michael Tokarev | return -1; |
124 | 104bf02e | Michael Tokarev | } |
125 | 104bf02e | Michael Tokarev | |
126 | 104bf02e | Michael Tokarev | for (;;) {
|
127 | 104bf02e | Michael Tokarev | char data[8192]; |
128 | 104bf02e | Michael Tokarev | r = read(fd, data, sizeof(data));
|
129 | 104bf02e | Michael Tokarev | if (r == 0) { |
130 | 104bf02e | Michael Tokarev | break;
|
131 | 104bf02e | Michael Tokarev | } else if (r > 0) { |
132 | 7267c094 | Anthony Liguori | acpi_tables = g_realloc(acpi_tables, allen + r); |
133 | 104bf02e | Michael Tokarev | memcpy(acpi_tables + allen, data, r); |
134 | 104bf02e | Michael Tokarev | allen += r; |
135 | 104bf02e | Michael Tokarev | } else if (errno != EINTR) { |
136 | 104bf02e | Michael Tokarev | fprintf(stderr, "can't read file %s: %s\n",
|
137 | 104bf02e | Michael Tokarev | f, strerror(errno)); |
138 | 104bf02e | Michael Tokarev | close(fd); |
139 | 104bf02e | Michael Tokarev | return -1; |
140 | 104bf02e | Michael Tokarev | } |
141 | 104bf02e | Michael Tokarev | } |
142 | 104bf02e | Michael Tokarev | |
143 | 104bf02e | Michael Tokarev | close(fd); |
144 | 104bf02e | Michael Tokarev | } |
145 | 104bf02e | Michael Tokarev | |
146 | 104bf02e | Michael Tokarev | /* now fill in the header fields */
|
147 | 104bf02e | Michael Tokarev | |
148 | 104bf02e | Michael Tokarev | f = acpi_tables + start; /* start of the table */
|
149 | 104bf02e | Michael Tokarev | changed = 0;
|
150 | 104bf02e | Michael Tokarev | |
151 | 104bf02e | Michael Tokarev | /* copy the header to temp place to align the fields */
|
152 | 104bf02e | Michael Tokarev | memcpy(&hdr, has_header ? f : dfl_hdr, ACPI_TABLE_HDR_SIZE); |
153 | 104bf02e | Michael Tokarev | |
154 | 104bf02e | Michael Tokarev | /* length of the table minus our prefix */
|
155 | 104bf02e | Michael Tokarev | len = allen - start - ACPI_TABLE_PFX_SIZE; |
156 | 104bf02e | Michael Tokarev | |
157 | 104bf02e | Michael Tokarev | hdr._length = cpu_to_le16(len); |
158 | 104bf02e | Michael Tokarev | |
159 | 104bf02e | Michael Tokarev | if (get_param_value(buf, sizeof(buf), "sig", t)) { |
160 | 104bf02e | Michael Tokarev | strzcpy(hdr.sig, buf, sizeof(hdr.sig));
|
161 | 104bf02e | Michael Tokarev | ++changed; |
162 | 104bf02e | Michael Tokarev | } |
163 | 104bf02e | Michael Tokarev | |
164 | 104bf02e | Michael Tokarev | /* length of the table including header, in bytes */
|
165 | 104bf02e | Michael Tokarev | if (has_header) {
|
166 | 104bf02e | Michael Tokarev | /* check if actual length is correct */
|
167 | 104bf02e | Michael Tokarev | val = le32_to_cpu(hdr.length); |
168 | 104bf02e | Michael Tokarev | if (val != len) {
|
169 | 104bf02e | Michael Tokarev | fprintf(stderr, |
170 | 104bf02e | Michael Tokarev | "warning: acpitable has wrong length,"
|
171 | 104bf02e | Michael Tokarev | " header says %lu, actual size %zu bytes\n",
|
172 | 104bf02e | Michael Tokarev | val, len); |
173 | 104bf02e | Michael Tokarev | ++changed; |
174 | 104bf02e | Michael Tokarev | } |
175 | 8a92ea2f | aliguori | } |
176 | 104bf02e | Michael Tokarev | /* we may avoid putting length here if has_header is true */
|
177 | 104bf02e | Michael Tokarev | hdr.length = cpu_to_le32(len); |
178 | 104bf02e | Michael Tokarev | |
179 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "rev", t)) { |
180 | 104bf02e | Michael Tokarev | val = strtoul(buf, &p, 0);
|
181 | 104bf02e | Michael Tokarev | if (val > 255 || *p) { |
182 | 104bf02e | Michael Tokarev | fprintf(stderr, "acpitable: \"rev=%s\" is invalid\n", buf);
|
183 | 104bf02e | Michael Tokarev | return -1; |
184 | 104bf02e | Michael Tokarev | } |
185 | 104bf02e | Michael Tokarev | hdr.revision = (uint8_t)val; |
186 | 104bf02e | Michael Tokarev | ++changed; |
187 | 8a92ea2f | aliguori | } |
188 | 8a92ea2f | aliguori | |
189 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "oem_id", t)) { |
190 | 104bf02e | Michael Tokarev | strzcpy(hdr.oem_id, buf, sizeof(hdr.oem_id));
|
191 | 104bf02e | Michael Tokarev | ++changed; |
192 | 8a92ea2f | aliguori | } |
193 | 8a92ea2f | aliguori | |
194 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "oem_table_id", t)) { |
195 | 104bf02e | Michael Tokarev | strzcpy(hdr.oem_table_id, buf, sizeof(hdr.oem_table_id));
|
196 | 104bf02e | Michael Tokarev | ++changed; |
197 | 8a92ea2f | aliguori | } |
198 | 8a92ea2f | aliguori | |
199 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "oem_rev", t)) { |
200 | 104bf02e | Michael Tokarev | val = strtol(buf, &p, 0);
|
201 | 104bf02e | Michael Tokarev | if (*p) {
|
202 | 104bf02e | Michael Tokarev | fprintf(stderr, "acpitable: \"oem_rev=%s\" is invalid\n", buf);
|
203 | 104bf02e | Michael Tokarev | return -1; |
204 | 104bf02e | Michael Tokarev | } |
205 | 104bf02e | Michael Tokarev | hdr.oem_revision = cpu_to_le32(val); |
206 | 104bf02e | Michael Tokarev | ++changed; |
207 | 8a92ea2f | aliguori | } |
208 | 8a92ea2f | aliguori | |
209 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "asl_compiler_id", t)) { |
210 | 104bf02e | Michael Tokarev | strzcpy(hdr.asl_compiler_id, buf, sizeof(hdr.asl_compiler_id));
|
211 | 104bf02e | Michael Tokarev | ++changed; |
212 | 8a92ea2f | aliguori | } |
213 | 8a92ea2f | aliguori | |
214 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "asl_compiler_rev", t)) { |
215 | 104bf02e | Michael Tokarev | val = strtol(buf, &p, 0);
|
216 | 104bf02e | Michael Tokarev | if (*p) {
|
217 | 104bf02e | Michael Tokarev | fprintf(stderr, "acpitable: \"%s=%s\" is invalid\n",
|
218 | 104bf02e | Michael Tokarev | "asl_compiler_rev", buf);
|
219 | 104bf02e | Michael Tokarev | return -1; |
220 | 104bf02e | Michael Tokarev | } |
221 | 104bf02e | Michael Tokarev | hdr.asl_compiler_revision = cpu_to_le32(val); |
222 | 104bf02e | Michael Tokarev | ++changed; |
223 | 8a92ea2f | aliguori | } |
224 | 8a92ea2f | aliguori | |
225 | 104bf02e | Michael Tokarev | if (!has_header && !changed) {
|
226 | 104bf02e | Michael Tokarev | fprintf(stderr, "warning: acpitable: no table headers are specified\n");
|
227 | 8a92ea2f | aliguori | } |
228 | 8a92ea2f | aliguori | |
229 | 8a92ea2f | aliguori | |
230 | 104bf02e | Michael Tokarev | /* now calculate checksum of the table, complete with the header */
|
231 | 104bf02e | Michael Tokarev | /* we may as well leave checksum intact if has_header is true */
|
232 | 104bf02e | Michael Tokarev | /* alternatively there may be a way to set cksum to a given value */
|
233 | 104bf02e | Michael Tokarev | hdr.checksum = 0; /* for checksum calculation */ |
234 | 8a92ea2f | aliguori | |
235 | 104bf02e | Michael Tokarev | /* put header back */
|
236 | 104bf02e | Michael Tokarev | memcpy(f, &hdr, sizeof(hdr));
|
237 | 104bf02e | Michael Tokarev | |
238 | 104bf02e | Michael Tokarev | if (changed || !has_header || 1) { |
239 | 104bf02e | Michael Tokarev | ((struct acpi_table_header *)f)->checksum =
|
240 | 104bf02e | Michael Tokarev | acpi_checksum((uint8_t *)f + ACPI_TABLE_PFX_SIZE, len); |
241 | d729bb9a | Isaku Yamahata | } |
242 | 8a92ea2f | aliguori | |
243 | 8a92ea2f | aliguori | /* increase number of tables */
|
244 | 104bf02e | Michael Tokarev | (*(uint16_t *)acpi_tables) = |
245 | 104bf02e | Michael Tokarev | cpu_to_le32(le32_to_cpu(*(uint16_t *)acpi_tables) + 1);
|
246 | 104bf02e | Michael Tokarev | |
247 | 104bf02e | Michael Tokarev | acpi_tables_len = allen; |
248 | 8a92ea2f | aliguori | return 0; |
249 | 104bf02e | Michael Tokarev | |
250 | 8a92ea2f | aliguori | } |
251 | a54d41a8 | Isaku Yamahata | |
252 | da98c8eb | Gerd Hoffmann | static void acpi_notify_wakeup(Notifier *notifier, void *data) |
253 | da98c8eb | Gerd Hoffmann | { |
254 | da98c8eb | Gerd Hoffmann | ACPIREGS *ar = container_of(notifier, ACPIREGS, wakeup); |
255 | da98c8eb | Gerd Hoffmann | WakeupReason *reason = data; |
256 | da98c8eb | Gerd Hoffmann | |
257 | da98c8eb | Gerd Hoffmann | switch (*reason) {
|
258 | 62aeb0f7 | Gerd Hoffmann | case QEMU_WAKEUP_REASON_RTC:
|
259 | 62aeb0f7 | Gerd Hoffmann | ar->pm1.evt.sts |= |
260 | 62aeb0f7 | Gerd Hoffmann | (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_RT_CLOCK_STATUS); |
261 | 62aeb0f7 | Gerd Hoffmann | break;
|
262 | 6595abc0 | Gerd Hoffmann | case QEMU_WAKEUP_REASON_PMTIMER:
|
263 | 6595abc0 | Gerd Hoffmann | ar->pm1.evt.sts |= |
264 | 6595abc0 | Gerd Hoffmann | (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_TIMER_STATUS); |
265 | 6595abc0 | Gerd Hoffmann | break;
|
266 | da98c8eb | Gerd Hoffmann | case QEMU_WAKEUP_REASON_OTHER:
|
267 | da98c8eb | Gerd Hoffmann | default:
|
268 | da98c8eb | Gerd Hoffmann | /* ACPI_BITMASK_WAKE_STATUS should be set on resume.
|
269 | da98c8eb | Gerd Hoffmann | Pretend that resume was caused by power button */
|
270 | da98c8eb | Gerd Hoffmann | ar->pm1.evt.sts |= |
271 | da98c8eb | Gerd Hoffmann | (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_POWER_BUTTON_STATUS); |
272 | da98c8eb | Gerd Hoffmann | break;
|
273 | da98c8eb | Gerd Hoffmann | } |
274 | da98c8eb | Gerd Hoffmann | } |
275 | da98c8eb | Gerd Hoffmann | |
276 | 04dc308f | Isaku Yamahata | /* ACPI PM1a EVT */
|
277 | 2886be1b | Gerd Hoffmann | uint16_t acpi_pm1_evt_get_sts(ACPIREGS *ar) |
278 | 04dc308f | Isaku Yamahata | { |
279 | 04dc308f | Isaku Yamahata | int64_t d = acpi_pm_tmr_get_clock(); |
280 | 2886be1b | Gerd Hoffmann | if (d >= ar->tmr.overflow_time) {
|
281 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.sts |= ACPI_BITMASK_TIMER_STATUS; |
282 | 04dc308f | Isaku Yamahata | } |
283 | 355bf2e5 | Gerd Hoffmann | return ar->pm1.evt.sts;
|
284 | 04dc308f | Isaku Yamahata | } |
285 | 04dc308f | Isaku Yamahata | |
286 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_evt_write_sts(ACPIREGS *ar, uint16_t val)
|
287 | 04dc308f | Isaku Yamahata | { |
288 | 2886be1b | Gerd Hoffmann | uint16_t pm1_sts = acpi_pm1_evt_get_sts(ar); |
289 | 04dc308f | Isaku Yamahata | if (pm1_sts & val & ACPI_BITMASK_TIMER_STATUS) {
|
290 | 04dc308f | Isaku Yamahata | /* if TMRSTS is reset, then compute the new overflow time */
|
291 | 355bf2e5 | Gerd Hoffmann | acpi_pm_tmr_calc_overflow_time(ar); |
292 | 04dc308f | Isaku Yamahata | } |
293 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.sts &= ~val; |
294 | 04dc308f | Isaku Yamahata | } |
295 | 04dc308f | Isaku Yamahata | |
296 | 8283c4f5 | Gerd Hoffmann | void acpi_pm1_evt_write_en(ACPIREGS *ar, uint16_t val)
|
297 | 8283c4f5 | Gerd Hoffmann | { |
298 | 8283c4f5 | Gerd Hoffmann | ar->pm1.evt.en = val; |
299 | 62aeb0f7 | Gerd Hoffmann | qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC, |
300 | 62aeb0f7 | Gerd Hoffmann | val & ACPI_BITMASK_RT_CLOCK_ENABLE); |
301 | 6595abc0 | Gerd Hoffmann | qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER, |
302 | 6595abc0 | Gerd Hoffmann | val & ACPI_BITMASK_TIMER_ENABLE); |
303 | 8283c4f5 | Gerd Hoffmann | } |
304 | 8283c4f5 | Gerd Hoffmann | |
305 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_evt_power_down(ACPIREGS *ar)
|
306 | 04dc308f | Isaku Yamahata | { |
307 | 355bf2e5 | Gerd Hoffmann | if (ar->pm1.evt.en & ACPI_BITMASK_POWER_BUTTON_ENABLE) {
|
308 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.sts |= ACPI_BITMASK_POWER_BUTTON_STATUS; |
309 | 355bf2e5 | Gerd Hoffmann | ar->tmr.update_sci(ar); |
310 | 04dc308f | Isaku Yamahata | } |
311 | 04dc308f | Isaku Yamahata | } |
312 | 04dc308f | Isaku Yamahata | |
313 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_evt_reset(ACPIREGS *ar)
|
314 | 04dc308f | Isaku Yamahata | { |
315 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.sts = 0;
|
316 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.en = 0;
|
317 | 62aeb0f7 | Gerd Hoffmann | qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC, 0);
|
318 | 6595abc0 | Gerd Hoffmann | qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER, 0);
|
319 | 04dc308f | Isaku Yamahata | } |
320 | 04dc308f | Isaku Yamahata | |
321 | a54d41a8 | Isaku Yamahata | /* ACPI PM_TMR */
|
322 | 355bf2e5 | Gerd Hoffmann | void acpi_pm_tmr_update(ACPIREGS *ar, bool enable) |
323 | a54d41a8 | Isaku Yamahata | { |
324 | a54d41a8 | Isaku Yamahata | int64_t expire_time; |
325 | a54d41a8 | Isaku Yamahata | |
326 | a54d41a8 | Isaku Yamahata | /* schedule a timer interruption if needed */
|
327 | a54d41a8 | Isaku Yamahata | if (enable) {
|
328 | 355bf2e5 | Gerd Hoffmann | expire_time = muldiv64(ar->tmr.overflow_time, get_ticks_per_sec(), |
329 | a54d41a8 | Isaku Yamahata | PM_TIMER_FREQUENCY); |
330 | 355bf2e5 | Gerd Hoffmann | qemu_mod_timer(ar->tmr.timer, expire_time); |
331 | a54d41a8 | Isaku Yamahata | } else {
|
332 | 355bf2e5 | Gerd Hoffmann | qemu_del_timer(ar->tmr.timer); |
333 | a54d41a8 | Isaku Yamahata | } |
334 | a54d41a8 | Isaku Yamahata | } |
335 | a54d41a8 | Isaku Yamahata | |
336 | 355bf2e5 | Gerd Hoffmann | void acpi_pm_tmr_calc_overflow_time(ACPIREGS *ar)
|
337 | a54d41a8 | Isaku Yamahata | { |
338 | a54d41a8 | Isaku Yamahata | int64_t d = acpi_pm_tmr_get_clock(); |
339 | 355bf2e5 | Gerd Hoffmann | ar->tmr.overflow_time = (d + 0x800000LL) & ~0x7fffffLL; |
340 | a54d41a8 | Isaku Yamahata | } |
341 | a54d41a8 | Isaku Yamahata | |
342 | 355bf2e5 | Gerd Hoffmann | uint32_t acpi_pm_tmr_get(ACPIREGS *ar) |
343 | a54d41a8 | Isaku Yamahata | { |
344 | 3a93113a | Dong Xu Wang | uint32_t d = acpi_pm_tmr_get_clock(); |
345 | a54d41a8 | Isaku Yamahata | return d & 0xffffff; |
346 | a54d41a8 | Isaku Yamahata | } |
347 | a54d41a8 | Isaku Yamahata | |
348 | a54d41a8 | Isaku Yamahata | static void acpi_pm_tmr_timer(void *opaque) |
349 | a54d41a8 | Isaku Yamahata | { |
350 | 355bf2e5 | Gerd Hoffmann | ACPIREGS *ar = opaque; |
351 | 6595abc0 | Gerd Hoffmann | qemu_system_wakeup_request(QEMU_WAKEUP_REASON_PMTIMER); |
352 | 355bf2e5 | Gerd Hoffmann | ar->tmr.update_sci(ar); |
353 | a54d41a8 | Isaku Yamahata | } |
354 | a54d41a8 | Isaku Yamahata | |
355 | 355bf2e5 | Gerd Hoffmann | void acpi_pm_tmr_init(ACPIREGS *ar, acpi_update_sci_fn update_sci)
|
356 | a54d41a8 | Isaku Yamahata | { |
357 | 355bf2e5 | Gerd Hoffmann | ar->tmr.update_sci = update_sci; |
358 | 355bf2e5 | Gerd Hoffmann | ar->tmr.timer = qemu_new_timer_ns(vm_clock, acpi_pm_tmr_timer, ar); |
359 | a54d41a8 | Isaku Yamahata | } |
360 | a54d41a8 | Isaku Yamahata | |
361 | 355bf2e5 | Gerd Hoffmann | void acpi_pm_tmr_reset(ACPIREGS *ar)
|
362 | a54d41a8 | Isaku Yamahata | { |
363 | 355bf2e5 | Gerd Hoffmann | ar->tmr.overflow_time = 0;
|
364 | 355bf2e5 | Gerd Hoffmann | qemu_del_timer(ar->tmr.timer); |
365 | a54d41a8 | Isaku Yamahata | } |
366 | eaba51c5 | Isaku Yamahata | |
367 | eaba51c5 | Isaku Yamahata | /* ACPI PM1aCNT */
|
368 | da98c8eb | Gerd Hoffmann | void acpi_pm1_cnt_init(ACPIREGS *ar)
|
369 | eaba51c5 | Isaku Yamahata | { |
370 | da98c8eb | Gerd Hoffmann | ar->wakeup.notify = acpi_notify_wakeup; |
371 | da98c8eb | Gerd Hoffmann | qemu_register_wakeup_notifier(&ar->wakeup); |
372 | eaba51c5 | Isaku Yamahata | } |
373 | eaba51c5 | Isaku Yamahata | |
374 | 459ae5ea | Gleb Natapov | void acpi_pm1_cnt_write(ACPIREGS *ar, uint16_t val, char s4) |
375 | eaba51c5 | Isaku Yamahata | { |
376 | 355bf2e5 | Gerd Hoffmann | ar->pm1.cnt.cnt = val & ~(ACPI_BITMASK_SLEEP_ENABLE); |
377 | eaba51c5 | Isaku Yamahata | |
378 | eaba51c5 | Isaku Yamahata | if (val & ACPI_BITMASK_SLEEP_ENABLE) {
|
379 | eaba51c5 | Isaku Yamahata | /* change suspend type */
|
380 | eaba51c5 | Isaku Yamahata | uint16_t sus_typ = (val >> 10) & 7; |
381 | eaba51c5 | Isaku Yamahata | switch(sus_typ) {
|
382 | eaba51c5 | Isaku Yamahata | case 0: /* soft power off */ |
383 | eaba51c5 | Isaku Yamahata | qemu_system_shutdown_request(); |
384 | eaba51c5 | Isaku Yamahata | break;
|
385 | eaba51c5 | Isaku Yamahata | case 1: |
386 | da98c8eb | Gerd Hoffmann | qemu_system_suspend_request(); |
387 | da98c8eb | Gerd Hoffmann | break;
|
388 | eaba51c5 | Isaku Yamahata | default:
|
389 | 459ae5ea | Gleb Natapov | if (sus_typ == s4) { /* S4 request */ |
390 | 25df49f6 | Luiz Capitulino | monitor_protocol_event(QEVENT_SUSPEND_DISK, NULL);
|
391 | 459ae5ea | Gleb Natapov | qemu_system_shutdown_request(); |
392 | 459ae5ea | Gleb Natapov | } |
393 | eaba51c5 | Isaku Yamahata | break;
|
394 | eaba51c5 | Isaku Yamahata | } |
395 | eaba51c5 | Isaku Yamahata | } |
396 | eaba51c5 | Isaku Yamahata | } |
397 | eaba51c5 | Isaku Yamahata | |
398 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_cnt_update(ACPIREGS *ar,
|
399 | eaba51c5 | Isaku Yamahata | bool sci_enable, bool sci_disable) |
400 | eaba51c5 | Isaku Yamahata | { |
401 | eaba51c5 | Isaku Yamahata | /* ACPI specs 3.0, 4.7.2.5 */
|
402 | eaba51c5 | Isaku Yamahata | if (sci_enable) {
|
403 | 355bf2e5 | Gerd Hoffmann | ar->pm1.cnt.cnt |= ACPI_BITMASK_SCI_ENABLE; |
404 | eaba51c5 | Isaku Yamahata | } else if (sci_disable) { |
405 | 355bf2e5 | Gerd Hoffmann | ar->pm1.cnt.cnt &= ~ACPI_BITMASK_SCI_ENABLE; |
406 | eaba51c5 | Isaku Yamahata | } |
407 | eaba51c5 | Isaku Yamahata | } |
408 | eaba51c5 | Isaku Yamahata | |
409 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_cnt_reset(ACPIREGS *ar)
|
410 | eaba51c5 | Isaku Yamahata | { |
411 | 355bf2e5 | Gerd Hoffmann | ar->pm1.cnt.cnt = 0;
|
412 | eaba51c5 | Isaku Yamahata | } |
413 | 23910d3f | Isaku Yamahata | |
414 | 23910d3f | Isaku Yamahata | /* ACPI GPE */
|
415 | 355bf2e5 | Gerd Hoffmann | void acpi_gpe_init(ACPIREGS *ar, uint8_t len)
|
416 | 23910d3f | Isaku Yamahata | { |
417 | 355bf2e5 | Gerd Hoffmann | ar->gpe.len = len; |
418 | 355bf2e5 | Gerd Hoffmann | ar->gpe.sts = g_malloc0(len / 2);
|
419 | 355bf2e5 | Gerd Hoffmann | ar->gpe.en = g_malloc0(len / 2);
|
420 | 23910d3f | Isaku Yamahata | } |
421 | 23910d3f | Isaku Yamahata | |
422 | 355bf2e5 | Gerd Hoffmann | void acpi_gpe_blk(ACPIREGS *ar, uint32_t blk)
|
423 | 23910d3f | Isaku Yamahata | { |
424 | 355bf2e5 | Gerd Hoffmann | ar->gpe.blk = blk; |
425 | 23910d3f | Isaku Yamahata | } |
426 | 23910d3f | Isaku Yamahata | |
427 | 355bf2e5 | Gerd Hoffmann | void acpi_gpe_reset(ACPIREGS *ar)
|
428 | 23910d3f | Isaku Yamahata | { |
429 | 355bf2e5 | Gerd Hoffmann | memset(ar->gpe.sts, 0, ar->gpe.len / 2); |
430 | 355bf2e5 | Gerd Hoffmann | memset(ar->gpe.en, 0, ar->gpe.len / 2); |
431 | 23910d3f | Isaku Yamahata | } |
432 | 23910d3f | Isaku Yamahata | |
433 | 355bf2e5 | Gerd Hoffmann | static uint8_t *acpi_gpe_ioport_get_ptr(ACPIREGS *ar, uint32_t addr)
|
434 | 23910d3f | Isaku Yamahata | { |
435 | 23910d3f | Isaku Yamahata | uint8_t *cur = NULL;
|
436 | 23910d3f | Isaku Yamahata | |
437 | 355bf2e5 | Gerd Hoffmann | if (addr < ar->gpe.len / 2) { |
438 | 355bf2e5 | Gerd Hoffmann | cur = ar->gpe.sts + addr; |
439 | 355bf2e5 | Gerd Hoffmann | } else if (addr < ar->gpe.len) { |
440 | 355bf2e5 | Gerd Hoffmann | cur = ar->gpe.en + addr - ar->gpe.len / 2;
|
441 | 23910d3f | Isaku Yamahata | } else {
|
442 | 23910d3f | Isaku Yamahata | abort(); |
443 | 23910d3f | Isaku Yamahata | } |
444 | 23910d3f | Isaku Yamahata | |
445 | 23910d3f | Isaku Yamahata | return cur;
|
446 | 23910d3f | Isaku Yamahata | } |
447 | 23910d3f | Isaku Yamahata | |
448 | 355bf2e5 | Gerd Hoffmann | void acpi_gpe_ioport_writeb(ACPIREGS *ar, uint32_t addr, uint32_t val)
|
449 | 23910d3f | Isaku Yamahata | { |
450 | 23910d3f | Isaku Yamahata | uint8_t *cur; |
451 | 23910d3f | Isaku Yamahata | |
452 | 355bf2e5 | Gerd Hoffmann | addr -= ar->gpe.blk; |
453 | 355bf2e5 | Gerd Hoffmann | cur = acpi_gpe_ioport_get_ptr(ar, addr); |
454 | 355bf2e5 | Gerd Hoffmann | if (addr < ar->gpe.len / 2) { |
455 | 23910d3f | Isaku Yamahata | /* GPE_STS */
|
456 | 23910d3f | Isaku Yamahata | *cur = (*cur) & ~val; |
457 | 355bf2e5 | Gerd Hoffmann | } else if (addr < ar->gpe.len) { |
458 | 23910d3f | Isaku Yamahata | /* GPE_EN */
|
459 | 23910d3f | Isaku Yamahata | *cur = val; |
460 | 23910d3f | Isaku Yamahata | } else {
|
461 | 23910d3f | Isaku Yamahata | abort(); |
462 | 23910d3f | Isaku Yamahata | } |
463 | 23910d3f | Isaku Yamahata | } |
464 | 23910d3f | Isaku Yamahata | |
465 | 355bf2e5 | Gerd Hoffmann | uint32_t acpi_gpe_ioport_readb(ACPIREGS *ar, uint32_t addr) |
466 | 23910d3f | Isaku Yamahata | { |
467 | 23910d3f | Isaku Yamahata | uint8_t *cur; |
468 | 23910d3f | Isaku Yamahata | uint32_t val; |
469 | 23910d3f | Isaku Yamahata | |
470 | 355bf2e5 | Gerd Hoffmann | addr -= ar->gpe.blk; |
471 | 355bf2e5 | Gerd Hoffmann | cur = acpi_gpe_ioport_get_ptr(ar, addr); |
472 | 23910d3f | Isaku Yamahata | val = 0;
|
473 | 23910d3f | Isaku Yamahata | if (cur != NULL) { |
474 | 23910d3f | Isaku Yamahata | val = *cur; |
475 | 23910d3f | Isaku Yamahata | } |
476 | 23910d3f | Isaku Yamahata | |
477 | 23910d3f | Isaku Yamahata | return val;
|
478 | 23910d3f | Isaku Yamahata | } |