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