root / hw / acpi.c @ bc927e48
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 | /* XXX fixme: this function uses obsolete argument parsing interface */
|
65 | 8a92ea2f | aliguori | int acpi_table_add(const char *t) |
66 | 8a92ea2f | aliguori | { |
67 | 8a92ea2f | aliguori | char buf[1024], *p, *f; |
68 | 8a92ea2f | aliguori | unsigned long val; |
69 | 104bf02e | Michael Tokarev | size_t len, start, allen; |
70 | 104bf02e | Michael Tokarev | bool has_header;
|
71 | 104bf02e | Michael Tokarev | int changed;
|
72 | 104bf02e | Michael Tokarev | int r;
|
73 | 104bf02e | Michael Tokarev | struct acpi_table_header hdr;
|
74 | 8a92ea2f | aliguori | |
75 | 104bf02e | Michael Tokarev | r = 0;
|
76 | 104bf02e | Michael Tokarev | r |= get_param_value(buf, sizeof(buf), "data", t) ? 1 : 0; |
77 | 104bf02e | Michael Tokarev | r |= get_param_value(buf, sizeof(buf), "file", t) ? 2 : 0; |
78 | 104bf02e | Michael Tokarev | switch (r) {
|
79 | 104bf02e | Michael Tokarev | case 0: |
80 | 104bf02e | Michael Tokarev | buf[0] = '\0'; |
81 | 104bf02e | Michael Tokarev | /* fallthrough for default behavior */
|
82 | 104bf02e | Michael Tokarev | case 1: |
83 | 104bf02e | Michael Tokarev | has_header = false;
|
84 | 104bf02e | Michael Tokarev | break;
|
85 | 104bf02e | Michael Tokarev | case 2: |
86 | 104bf02e | Michael Tokarev | has_header = true;
|
87 | 104bf02e | Michael Tokarev | break;
|
88 | 104bf02e | Michael Tokarev | default:
|
89 | 104bf02e | Michael Tokarev | fprintf(stderr, "acpitable: both data and file are specified\n");
|
90 | 104bf02e | Michael Tokarev | return -1; |
91 | 104bf02e | Michael Tokarev | } |
92 | 104bf02e | Michael Tokarev | |
93 | 104bf02e | Michael Tokarev | if (!acpi_tables) {
|
94 | 104bf02e | Michael Tokarev | allen = sizeof(uint16_t);
|
95 | 7267c094 | Anthony Liguori | acpi_tables = g_malloc0(allen); |
96 | 8a92ea2f | aliguori | } else {
|
97 | 104bf02e | Michael Tokarev | allen = acpi_tables_len; |
98 | 104bf02e | Michael Tokarev | } |
99 | 104bf02e | Michael Tokarev | |
100 | 104bf02e | Michael Tokarev | start = allen; |
101 | 7267c094 | Anthony Liguori | acpi_tables = g_realloc(acpi_tables, start + ACPI_TABLE_HDR_SIZE); |
102 | 104bf02e | Michael Tokarev | allen += has_header ? ACPI_TABLE_PFX_SIZE : ACPI_TABLE_HDR_SIZE; |
103 | 104bf02e | Michael Tokarev | |
104 | 104bf02e | Michael Tokarev | /* now read in the data files, reallocating buffer as needed */
|
105 | 104bf02e | Michael Tokarev | |
106 | 104bf02e | Michael Tokarev | for (f = strtok(buf, ":"); f; f = strtok(NULL, ":")) { |
107 | 104bf02e | Michael Tokarev | int fd = open(f, O_RDONLY);
|
108 | 104bf02e | Michael Tokarev | |
109 | 104bf02e | Michael Tokarev | if (fd < 0) { |
110 | 104bf02e | Michael Tokarev | fprintf(stderr, "can't open file %s: %s\n", f, strerror(errno));
|
111 | 104bf02e | Michael Tokarev | return -1; |
112 | 104bf02e | Michael Tokarev | } |
113 | 104bf02e | Michael Tokarev | |
114 | 104bf02e | Michael Tokarev | for (;;) {
|
115 | 104bf02e | Michael Tokarev | char data[8192]; |
116 | 104bf02e | Michael Tokarev | r = read(fd, data, sizeof(data));
|
117 | 104bf02e | Michael Tokarev | if (r == 0) { |
118 | 104bf02e | Michael Tokarev | break;
|
119 | 104bf02e | Michael Tokarev | } else if (r > 0) { |
120 | 7267c094 | Anthony Liguori | acpi_tables = g_realloc(acpi_tables, allen + r); |
121 | 104bf02e | Michael Tokarev | memcpy(acpi_tables + allen, data, r); |
122 | 104bf02e | Michael Tokarev | allen += r; |
123 | 104bf02e | Michael Tokarev | } else if (errno != EINTR) { |
124 | 104bf02e | Michael Tokarev | fprintf(stderr, "can't read file %s: %s\n",
|
125 | 104bf02e | Michael Tokarev | f, strerror(errno)); |
126 | 104bf02e | Michael Tokarev | close(fd); |
127 | 104bf02e | Michael Tokarev | return -1; |
128 | 104bf02e | Michael Tokarev | } |
129 | 104bf02e | Michael Tokarev | } |
130 | 104bf02e | Michael Tokarev | |
131 | 104bf02e | Michael Tokarev | close(fd); |
132 | 104bf02e | Michael Tokarev | } |
133 | 104bf02e | Michael Tokarev | |
134 | 104bf02e | Michael Tokarev | /* now fill in the header fields */
|
135 | 104bf02e | Michael Tokarev | |
136 | 104bf02e | Michael Tokarev | f = acpi_tables + start; /* start of the table */
|
137 | 104bf02e | Michael Tokarev | changed = 0;
|
138 | 104bf02e | Michael Tokarev | |
139 | 104bf02e | Michael Tokarev | /* copy the header to temp place to align the fields */
|
140 | 104bf02e | Michael Tokarev | memcpy(&hdr, has_header ? f : dfl_hdr, ACPI_TABLE_HDR_SIZE); |
141 | 104bf02e | Michael Tokarev | |
142 | 104bf02e | Michael Tokarev | /* length of the table minus our prefix */
|
143 | 104bf02e | Michael Tokarev | len = allen - start - ACPI_TABLE_PFX_SIZE; |
144 | 104bf02e | Michael Tokarev | |
145 | 104bf02e | Michael Tokarev | hdr._length = cpu_to_le16(len); |
146 | 104bf02e | Michael Tokarev | |
147 | 104bf02e | Michael Tokarev | if (get_param_value(buf, sizeof(buf), "sig", t)) { |
148 | 3cda3462 | Jim Meyering | /* strncpy is justified: the field need not be NUL-terminated. */
|
149 | 3cda3462 | Jim Meyering | strncpy(hdr.sig, buf, sizeof(hdr.sig));
|
150 | 104bf02e | Michael Tokarev | ++changed; |
151 | 104bf02e | Michael Tokarev | } |
152 | 104bf02e | Michael Tokarev | |
153 | 104bf02e | Michael Tokarev | /* length of the table including header, in bytes */
|
154 | 104bf02e | Michael Tokarev | if (has_header) {
|
155 | 104bf02e | Michael Tokarev | /* check if actual length is correct */
|
156 | 104bf02e | Michael Tokarev | val = le32_to_cpu(hdr.length); |
157 | 104bf02e | Michael Tokarev | if (val != len) {
|
158 | 104bf02e | Michael Tokarev | fprintf(stderr, |
159 | 104bf02e | Michael Tokarev | "warning: acpitable has wrong length,"
|
160 | 104bf02e | Michael Tokarev | " header says %lu, actual size %zu bytes\n",
|
161 | 104bf02e | Michael Tokarev | val, len); |
162 | 104bf02e | Michael Tokarev | ++changed; |
163 | 104bf02e | Michael Tokarev | } |
164 | 8a92ea2f | aliguori | } |
165 | 104bf02e | Michael Tokarev | /* we may avoid putting length here if has_header is true */
|
166 | 104bf02e | Michael Tokarev | hdr.length = cpu_to_le32(len); |
167 | 104bf02e | Michael Tokarev | |
168 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "rev", t)) { |
169 | 104bf02e | Michael Tokarev | val = strtoul(buf, &p, 0);
|
170 | 104bf02e | Michael Tokarev | if (val > 255 || *p) { |
171 | 104bf02e | Michael Tokarev | fprintf(stderr, "acpitable: \"rev=%s\" is invalid\n", buf);
|
172 | 104bf02e | Michael Tokarev | return -1; |
173 | 104bf02e | Michael Tokarev | } |
174 | 104bf02e | Michael Tokarev | hdr.revision = (uint8_t)val; |
175 | 104bf02e | Michael Tokarev | ++changed; |
176 | 8a92ea2f | aliguori | } |
177 | 8a92ea2f | aliguori | |
178 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "oem_id", t)) { |
179 | 3cda3462 | Jim Meyering | /* strncpy is justified: the field need not be NUL-terminated. */
|
180 | 3cda3462 | Jim Meyering | strncpy(hdr.oem_id, buf, sizeof(hdr.oem_id));
|
181 | 104bf02e | Michael Tokarev | ++changed; |
182 | 8a92ea2f | aliguori | } |
183 | 8a92ea2f | aliguori | |
184 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "oem_table_id", t)) { |
185 | 3cda3462 | Jim Meyering | /* strncpy is justified: the field need not be NUL-terminated. */
|
186 | 3cda3462 | Jim Meyering | strncpy(hdr.oem_table_id, buf, sizeof(hdr.oem_table_id));
|
187 | 104bf02e | Michael Tokarev | ++changed; |
188 | 8a92ea2f | aliguori | } |
189 | 8a92ea2f | aliguori | |
190 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "oem_rev", t)) { |
191 | 104bf02e | Michael Tokarev | val = strtol(buf, &p, 0);
|
192 | 104bf02e | Michael Tokarev | if (*p) {
|
193 | 104bf02e | Michael Tokarev | fprintf(stderr, "acpitable: \"oem_rev=%s\" is invalid\n", buf);
|
194 | 104bf02e | Michael Tokarev | return -1; |
195 | 104bf02e | Michael Tokarev | } |
196 | 104bf02e | Michael Tokarev | hdr.oem_revision = cpu_to_le32(val); |
197 | 104bf02e | Michael Tokarev | ++changed; |
198 | 8a92ea2f | aliguori | } |
199 | 8a92ea2f | aliguori | |
200 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "asl_compiler_id", t)) { |
201 | 3cda3462 | Jim Meyering | /* strncpy is justified: the field need not be NUL-terminated. */
|
202 | 3cda3462 | Jim Meyering | strncpy(hdr.asl_compiler_id, buf, sizeof(hdr.asl_compiler_id));
|
203 | 104bf02e | Michael Tokarev | ++changed; |
204 | 8a92ea2f | aliguori | } |
205 | 8a92ea2f | aliguori | |
206 | 8a92ea2f | aliguori | if (get_param_value(buf, sizeof(buf), "asl_compiler_rev", t)) { |
207 | 104bf02e | Michael Tokarev | val = strtol(buf, &p, 0);
|
208 | 104bf02e | Michael Tokarev | if (*p) {
|
209 | 104bf02e | Michael Tokarev | fprintf(stderr, "acpitable: \"%s=%s\" is invalid\n",
|
210 | 104bf02e | Michael Tokarev | "asl_compiler_rev", buf);
|
211 | 104bf02e | Michael Tokarev | return -1; |
212 | 104bf02e | Michael Tokarev | } |
213 | 104bf02e | Michael Tokarev | hdr.asl_compiler_revision = cpu_to_le32(val); |
214 | 104bf02e | Michael Tokarev | ++changed; |
215 | 8a92ea2f | aliguori | } |
216 | 8a92ea2f | aliguori | |
217 | 104bf02e | Michael Tokarev | if (!has_header && !changed) {
|
218 | 104bf02e | Michael Tokarev | fprintf(stderr, "warning: acpitable: no table headers are specified\n");
|
219 | 8a92ea2f | aliguori | } |
220 | 8a92ea2f | aliguori | |
221 | 8a92ea2f | aliguori | |
222 | 104bf02e | Michael Tokarev | /* now calculate checksum of the table, complete with the header */
|
223 | 104bf02e | Michael Tokarev | /* we may as well leave checksum intact if has_header is true */
|
224 | 104bf02e | Michael Tokarev | /* alternatively there may be a way to set cksum to a given value */
|
225 | 104bf02e | Michael Tokarev | hdr.checksum = 0; /* for checksum calculation */ |
226 | 8a92ea2f | aliguori | |
227 | 104bf02e | Michael Tokarev | /* put header back */
|
228 | 104bf02e | Michael Tokarev | memcpy(f, &hdr, sizeof(hdr));
|
229 | 104bf02e | Michael Tokarev | |
230 | 104bf02e | Michael Tokarev | if (changed || !has_header || 1) { |
231 | 104bf02e | Michael Tokarev | ((struct acpi_table_header *)f)->checksum =
|
232 | 104bf02e | Michael Tokarev | acpi_checksum((uint8_t *)f + ACPI_TABLE_PFX_SIZE, len); |
233 | d729bb9a | Isaku Yamahata | } |
234 | 8a92ea2f | aliguori | |
235 | 8a92ea2f | aliguori | /* increase number of tables */
|
236 | 104bf02e | Michael Tokarev | (*(uint16_t *)acpi_tables) = |
237 | 104bf02e | Michael Tokarev | cpu_to_le32(le32_to_cpu(*(uint16_t *)acpi_tables) + 1);
|
238 | 104bf02e | Michael Tokarev | |
239 | 104bf02e | Michael Tokarev | acpi_tables_len = allen; |
240 | 8a92ea2f | aliguori | return 0; |
241 | 104bf02e | Michael Tokarev | |
242 | 8a92ea2f | aliguori | } |
243 | a54d41a8 | Isaku Yamahata | |
244 | da98c8eb | Gerd Hoffmann | static void acpi_notify_wakeup(Notifier *notifier, void *data) |
245 | da98c8eb | Gerd Hoffmann | { |
246 | da98c8eb | Gerd Hoffmann | ACPIREGS *ar = container_of(notifier, ACPIREGS, wakeup); |
247 | da98c8eb | Gerd Hoffmann | WakeupReason *reason = data; |
248 | da98c8eb | Gerd Hoffmann | |
249 | da98c8eb | Gerd Hoffmann | switch (*reason) {
|
250 | 62aeb0f7 | Gerd Hoffmann | case QEMU_WAKEUP_REASON_RTC:
|
251 | 62aeb0f7 | Gerd Hoffmann | ar->pm1.evt.sts |= |
252 | 62aeb0f7 | Gerd Hoffmann | (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_RT_CLOCK_STATUS); |
253 | 62aeb0f7 | Gerd Hoffmann | break;
|
254 | 6595abc0 | Gerd Hoffmann | case QEMU_WAKEUP_REASON_PMTIMER:
|
255 | 6595abc0 | Gerd Hoffmann | ar->pm1.evt.sts |= |
256 | 6595abc0 | Gerd Hoffmann | (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_TIMER_STATUS); |
257 | 6595abc0 | Gerd Hoffmann | break;
|
258 | da98c8eb | Gerd Hoffmann | case QEMU_WAKEUP_REASON_OTHER:
|
259 | da98c8eb | Gerd Hoffmann | default:
|
260 | da98c8eb | Gerd Hoffmann | /* ACPI_BITMASK_WAKE_STATUS should be set on resume.
|
261 | da98c8eb | Gerd Hoffmann | Pretend that resume was caused by power button */
|
262 | da98c8eb | Gerd Hoffmann | ar->pm1.evt.sts |= |
263 | da98c8eb | Gerd Hoffmann | (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_POWER_BUTTON_STATUS); |
264 | da98c8eb | Gerd Hoffmann | break;
|
265 | da98c8eb | Gerd Hoffmann | } |
266 | da98c8eb | Gerd Hoffmann | } |
267 | da98c8eb | Gerd Hoffmann | |
268 | 04dc308f | Isaku Yamahata | /* ACPI PM1a EVT */
|
269 | 2886be1b | Gerd Hoffmann | uint16_t acpi_pm1_evt_get_sts(ACPIREGS *ar) |
270 | 04dc308f | Isaku Yamahata | { |
271 | 04dc308f | Isaku Yamahata | int64_t d = acpi_pm_tmr_get_clock(); |
272 | 2886be1b | Gerd Hoffmann | if (d >= ar->tmr.overflow_time) {
|
273 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.sts |= ACPI_BITMASK_TIMER_STATUS; |
274 | 04dc308f | Isaku Yamahata | } |
275 | 355bf2e5 | Gerd Hoffmann | return ar->pm1.evt.sts;
|
276 | 04dc308f | Isaku Yamahata | } |
277 | 04dc308f | Isaku Yamahata | |
278 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_evt_write_sts(ACPIREGS *ar, uint16_t val)
|
279 | 04dc308f | Isaku Yamahata | { |
280 | 2886be1b | Gerd Hoffmann | uint16_t pm1_sts = acpi_pm1_evt_get_sts(ar); |
281 | 04dc308f | Isaku Yamahata | if (pm1_sts & val & ACPI_BITMASK_TIMER_STATUS) {
|
282 | 04dc308f | Isaku Yamahata | /* if TMRSTS is reset, then compute the new overflow time */
|
283 | 355bf2e5 | Gerd Hoffmann | acpi_pm_tmr_calc_overflow_time(ar); |
284 | 04dc308f | Isaku Yamahata | } |
285 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.sts &= ~val; |
286 | 04dc308f | Isaku Yamahata | } |
287 | 04dc308f | Isaku Yamahata | |
288 | 8283c4f5 | Gerd Hoffmann | void acpi_pm1_evt_write_en(ACPIREGS *ar, uint16_t val)
|
289 | 8283c4f5 | Gerd Hoffmann | { |
290 | 8283c4f5 | Gerd Hoffmann | ar->pm1.evt.en = val; |
291 | 62aeb0f7 | Gerd Hoffmann | qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC, |
292 | 62aeb0f7 | Gerd Hoffmann | val & ACPI_BITMASK_RT_CLOCK_ENABLE); |
293 | 6595abc0 | Gerd Hoffmann | qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER, |
294 | 6595abc0 | Gerd Hoffmann | val & ACPI_BITMASK_TIMER_ENABLE); |
295 | 8283c4f5 | Gerd Hoffmann | } |
296 | 8283c4f5 | Gerd Hoffmann | |
297 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_evt_power_down(ACPIREGS *ar)
|
298 | 04dc308f | Isaku Yamahata | { |
299 | 355bf2e5 | Gerd Hoffmann | if (ar->pm1.evt.en & ACPI_BITMASK_POWER_BUTTON_ENABLE) {
|
300 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.sts |= ACPI_BITMASK_POWER_BUTTON_STATUS; |
301 | 355bf2e5 | Gerd Hoffmann | ar->tmr.update_sci(ar); |
302 | 04dc308f | Isaku Yamahata | } |
303 | 04dc308f | Isaku Yamahata | } |
304 | 04dc308f | Isaku Yamahata | |
305 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_evt_reset(ACPIREGS *ar)
|
306 | 04dc308f | Isaku Yamahata | { |
307 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.sts = 0;
|
308 | 355bf2e5 | Gerd Hoffmann | ar->pm1.evt.en = 0;
|
309 | 62aeb0f7 | Gerd Hoffmann | qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_RTC, 0);
|
310 | 6595abc0 | Gerd Hoffmann | qemu_system_wakeup_enable(QEMU_WAKEUP_REASON_PMTIMER, 0);
|
311 | 04dc308f | Isaku Yamahata | } |
312 | 04dc308f | Isaku Yamahata | |
313 | a54d41a8 | Isaku Yamahata | /* ACPI PM_TMR */
|
314 | 355bf2e5 | Gerd Hoffmann | void acpi_pm_tmr_update(ACPIREGS *ar, bool enable) |
315 | a54d41a8 | Isaku Yamahata | { |
316 | a54d41a8 | Isaku Yamahata | int64_t expire_time; |
317 | a54d41a8 | Isaku Yamahata | |
318 | a54d41a8 | Isaku Yamahata | /* schedule a timer interruption if needed */
|
319 | a54d41a8 | Isaku Yamahata | if (enable) {
|
320 | 355bf2e5 | Gerd Hoffmann | expire_time = muldiv64(ar->tmr.overflow_time, get_ticks_per_sec(), |
321 | a54d41a8 | Isaku Yamahata | PM_TIMER_FREQUENCY); |
322 | 355bf2e5 | Gerd Hoffmann | qemu_mod_timer(ar->tmr.timer, expire_time); |
323 | a54d41a8 | Isaku Yamahata | } else {
|
324 | 355bf2e5 | Gerd Hoffmann | qemu_del_timer(ar->tmr.timer); |
325 | a54d41a8 | Isaku Yamahata | } |
326 | a54d41a8 | Isaku Yamahata | } |
327 | a54d41a8 | Isaku Yamahata | |
328 | 355bf2e5 | Gerd Hoffmann | void acpi_pm_tmr_calc_overflow_time(ACPIREGS *ar)
|
329 | a54d41a8 | Isaku Yamahata | { |
330 | a54d41a8 | Isaku Yamahata | int64_t d = acpi_pm_tmr_get_clock(); |
331 | 355bf2e5 | Gerd Hoffmann | ar->tmr.overflow_time = (d + 0x800000LL) & ~0x7fffffLL; |
332 | a54d41a8 | Isaku Yamahata | } |
333 | a54d41a8 | Isaku Yamahata | |
334 | 355bf2e5 | Gerd Hoffmann | uint32_t acpi_pm_tmr_get(ACPIREGS *ar) |
335 | a54d41a8 | Isaku Yamahata | { |
336 | 3a93113a | Dong Xu Wang | uint32_t d = acpi_pm_tmr_get_clock(); |
337 | a54d41a8 | Isaku Yamahata | return d & 0xffffff; |
338 | a54d41a8 | Isaku Yamahata | } |
339 | a54d41a8 | Isaku Yamahata | |
340 | a54d41a8 | Isaku Yamahata | static void acpi_pm_tmr_timer(void *opaque) |
341 | a54d41a8 | Isaku Yamahata | { |
342 | 355bf2e5 | Gerd Hoffmann | ACPIREGS *ar = opaque; |
343 | 6595abc0 | Gerd Hoffmann | qemu_system_wakeup_request(QEMU_WAKEUP_REASON_PMTIMER); |
344 | 355bf2e5 | Gerd Hoffmann | ar->tmr.update_sci(ar); |
345 | a54d41a8 | Isaku Yamahata | } |
346 | a54d41a8 | Isaku Yamahata | |
347 | 355bf2e5 | Gerd Hoffmann | void acpi_pm_tmr_init(ACPIREGS *ar, acpi_update_sci_fn update_sci)
|
348 | a54d41a8 | Isaku Yamahata | { |
349 | 355bf2e5 | Gerd Hoffmann | ar->tmr.update_sci = update_sci; |
350 | 355bf2e5 | Gerd Hoffmann | ar->tmr.timer = qemu_new_timer_ns(vm_clock, acpi_pm_tmr_timer, ar); |
351 | a54d41a8 | Isaku Yamahata | } |
352 | a54d41a8 | Isaku Yamahata | |
353 | 355bf2e5 | Gerd Hoffmann | void acpi_pm_tmr_reset(ACPIREGS *ar)
|
354 | a54d41a8 | Isaku Yamahata | { |
355 | 355bf2e5 | Gerd Hoffmann | ar->tmr.overflow_time = 0;
|
356 | 355bf2e5 | Gerd Hoffmann | qemu_del_timer(ar->tmr.timer); |
357 | a54d41a8 | Isaku Yamahata | } |
358 | eaba51c5 | Isaku Yamahata | |
359 | eaba51c5 | Isaku Yamahata | /* ACPI PM1aCNT */
|
360 | da98c8eb | Gerd Hoffmann | void acpi_pm1_cnt_init(ACPIREGS *ar)
|
361 | eaba51c5 | Isaku Yamahata | { |
362 | da98c8eb | Gerd Hoffmann | ar->wakeup.notify = acpi_notify_wakeup; |
363 | da98c8eb | Gerd Hoffmann | qemu_register_wakeup_notifier(&ar->wakeup); |
364 | eaba51c5 | Isaku Yamahata | } |
365 | eaba51c5 | Isaku Yamahata | |
366 | 459ae5ea | Gleb Natapov | void acpi_pm1_cnt_write(ACPIREGS *ar, uint16_t val, char s4) |
367 | eaba51c5 | Isaku Yamahata | { |
368 | 355bf2e5 | Gerd Hoffmann | ar->pm1.cnt.cnt = val & ~(ACPI_BITMASK_SLEEP_ENABLE); |
369 | eaba51c5 | Isaku Yamahata | |
370 | eaba51c5 | Isaku Yamahata | if (val & ACPI_BITMASK_SLEEP_ENABLE) {
|
371 | eaba51c5 | Isaku Yamahata | /* change suspend type */
|
372 | eaba51c5 | Isaku Yamahata | uint16_t sus_typ = (val >> 10) & 7; |
373 | eaba51c5 | Isaku Yamahata | switch(sus_typ) {
|
374 | eaba51c5 | Isaku Yamahata | case 0: /* soft power off */ |
375 | eaba51c5 | Isaku Yamahata | qemu_system_shutdown_request(); |
376 | eaba51c5 | Isaku Yamahata | break;
|
377 | eaba51c5 | Isaku Yamahata | case 1: |
378 | da98c8eb | Gerd Hoffmann | qemu_system_suspend_request(); |
379 | da98c8eb | Gerd Hoffmann | break;
|
380 | eaba51c5 | Isaku Yamahata | default:
|
381 | 459ae5ea | Gleb Natapov | if (sus_typ == s4) { /* S4 request */ |
382 | 25df49f6 | Luiz Capitulino | monitor_protocol_event(QEVENT_SUSPEND_DISK, NULL);
|
383 | 459ae5ea | Gleb Natapov | qemu_system_shutdown_request(); |
384 | 459ae5ea | Gleb Natapov | } |
385 | eaba51c5 | Isaku Yamahata | break;
|
386 | eaba51c5 | Isaku Yamahata | } |
387 | eaba51c5 | Isaku Yamahata | } |
388 | eaba51c5 | Isaku Yamahata | } |
389 | eaba51c5 | Isaku Yamahata | |
390 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_cnt_update(ACPIREGS *ar,
|
391 | eaba51c5 | Isaku Yamahata | bool sci_enable, bool sci_disable) |
392 | eaba51c5 | Isaku Yamahata | { |
393 | eaba51c5 | Isaku Yamahata | /* ACPI specs 3.0, 4.7.2.5 */
|
394 | eaba51c5 | Isaku Yamahata | if (sci_enable) {
|
395 | 355bf2e5 | Gerd Hoffmann | ar->pm1.cnt.cnt |= ACPI_BITMASK_SCI_ENABLE; |
396 | eaba51c5 | Isaku Yamahata | } else if (sci_disable) { |
397 | 355bf2e5 | Gerd Hoffmann | ar->pm1.cnt.cnt &= ~ACPI_BITMASK_SCI_ENABLE; |
398 | eaba51c5 | Isaku Yamahata | } |
399 | eaba51c5 | Isaku Yamahata | } |
400 | eaba51c5 | Isaku Yamahata | |
401 | 355bf2e5 | Gerd Hoffmann | void acpi_pm1_cnt_reset(ACPIREGS *ar)
|
402 | eaba51c5 | Isaku Yamahata | { |
403 | 355bf2e5 | Gerd Hoffmann | ar->pm1.cnt.cnt = 0;
|
404 | eaba51c5 | Isaku Yamahata | } |
405 | 23910d3f | Isaku Yamahata | |
406 | 23910d3f | Isaku Yamahata | /* ACPI GPE */
|
407 | 355bf2e5 | Gerd Hoffmann | void acpi_gpe_init(ACPIREGS *ar, uint8_t len)
|
408 | 23910d3f | Isaku Yamahata | { |
409 | 355bf2e5 | Gerd Hoffmann | ar->gpe.len = len; |
410 | 355bf2e5 | Gerd Hoffmann | ar->gpe.sts = g_malloc0(len / 2);
|
411 | 355bf2e5 | Gerd Hoffmann | ar->gpe.en = g_malloc0(len / 2);
|
412 | 23910d3f | Isaku Yamahata | } |
413 | 23910d3f | Isaku Yamahata | |
414 | 355bf2e5 | Gerd Hoffmann | void acpi_gpe_blk(ACPIREGS *ar, uint32_t blk)
|
415 | 23910d3f | Isaku Yamahata | { |
416 | 355bf2e5 | Gerd Hoffmann | ar->gpe.blk = blk; |
417 | 23910d3f | Isaku Yamahata | } |
418 | 23910d3f | Isaku Yamahata | |
419 | 355bf2e5 | Gerd Hoffmann | void acpi_gpe_reset(ACPIREGS *ar)
|
420 | 23910d3f | Isaku Yamahata | { |
421 | 355bf2e5 | Gerd Hoffmann | memset(ar->gpe.sts, 0, ar->gpe.len / 2); |
422 | 355bf2e5 | Gerd Hoffmann | memset(ar->gpe.en, 0, ar->gpe.len / 2); |
423 | 23910d3f | Isaku Yamahata | } |
424 | 23910d3f | Isaku Yamahata | |
425 | 355bf2e5 | Gerd Hoffmann | static uint8_t *acpi_gpe_ioport_get_ptr(ACPIREGS *ar, uint32_t addr)
|
426 | 23910d3f | Isaku Yamahata | { |
427 | 23910d3f | Isaku Yamahata | uint8_t *cur = NULL;
|
428 | 23910d3f | Isaku Yamahata | |
429 | 355bf2e5 | Gerd Hoffmann | if (addr < ar->gpe.len / 2) { |
430 | 355bf2e5 | Gerd Hoffmann | cur = ar->gpe.sts + addr; |
431 | 355bf2e5 | Gerd Hoffmann | } else if (addr < ar->gpe.len) { |
432 | 355bf2e5 | Gerd Hoffmann | cur = ar->gpe.en + addr - ar->gpe.len / 2;
|
433 | 23910d3f | Isaku Yamahata | } else {
|
434 | 23910d3f | Isaku Yamahata | abort(); |
435 | 23910d3f | Isaku Yamahata | } |
436 | 23910d3f | Isaku Yamahata | |
437 | 23910d3f | Isaku Yamahata | return cur;
|
438 | 23910d3f | Isaku Yamahata | } |
439 | 23910d3f | Isaku Yamahata | |
440 | 355bf2e5 | Gerd Hoffmann | void acpi_gpe_ioport_writeb(ACPIREGS *ar, uint32_t addr, uint32_t val)
|
441 | 23910d3f | Isaku Yamahata | { |
442 | 23910d3f | Isaku Yamahata | uint8_t *cur; |
443 | 23910d3f | Isaku Yamahata | |
444 | 355bf2e5 | Gerd Hoffmann | addr -= ar->gpe.blk; |
445 | 355bf2e5 | Gerd Hoffmann | cur = acpi_gpe_ioport_get_ptr(ar, addr); |
446 | 355bf2e5 | Gerd Hoffmann | if (addr < ar->gpe.len / 2) { |
447 | 23910d3f | Isaku Yamahata | /* GPE_STS */
|
448 | 23910d3f | Isaku Yamahata | *cur = (*cur) & ~val; |
449 | 355bf2e5 | Gerd Hoffmann | } else if (addr < ar->gpe.len) { |
450 | 23910d3f | Isaku Yamahata | /* GPE_EN */
|
451 | 23910d3f | Isaku Yamahata | *cur = val; |
452 | 23910d3f | Isaku Yamahata | } else {
|
453 | 23910d3f | Isaku Yamahata | abort(); |
454 | 23910d3f | Isaku Yamahata | } |
455 | 23910d3f | Isaku Yamahata | } |
456 | 23910d3f | Isaku Yamahata | |
457 | 355bf2e5 | Gerd Hoffmann | uint32_t acpi_gpe_ioport_readb(ACPIREGS *ar, uint32_t addr) |
458 | 23910d3f | Isaku Yamahata | { |
459 | 23910d3f | Isaku Yamahata | uint8_t *cur; |
460 | 23910d3f | Isaku Yamahata | uint32_t val; |
461 | 23910d3f | Isaku Yamahata | |
462 | 355bf2e5 | Gerd Hoffmann | addr -= ar->gpe.blk; |
463 | 355bf2e5 | Gerd Hoffmann | cur = acpi_gpe_ioport_get_ptr(ar, addr); |
464 | 23910d3f | Isaku Yamahata | val = 0;
|
465 | 23910d3f | Isaku Yamahata | if (cur != NULL) { |
466 | 23910d3f | Isaku Yamahata | val = *cur; |
467 | 23910d3f | Isaku Yamahata | } |
468 | 23910d3f | Isaku Yamahata | |
469 | 23910d3f | Isaku Yamahata | return val;
|
470 | 23910d3f | Isaku Yamahata | } |