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