hw/acpi.c

   1 /*
   2  * ACPI implementation
   3  *
   4  * Copyright (c) 2006 Fabrice Bellard
   5  *
   6  * This library is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU Lesser General Public
   8  * License version 2 as published by the Free Software Foundation.
   9  *
  10  * This library is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13  * Lesser General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU Lesser General Public
  16  * License along with this library; if not, see <http://www.gnu.org/licenses/>
  17  */
  18 #include "sysemu.h"
  19 #include "hw.h"
  20 #include "pc.h"
  21 #include "acpi.h"
  22
  23 struct acpi_table_header
  24 {
  25     char signature [4];    /* ACPI signature (4 ASCII characters) */
  26     uint32_t length;          /* Length of table, in bytes, including header */
  27     uint8_t revision;         /* ACPI Specification minor version # */
  28     uint8_t checksum;         /* To make sum of entire table == 0 */
  29     char oem_id [6];       /* OEM identification */
  30     char oem_table_id [8]; /* OEM table identification */
  31     uint32_t oem_revision;    /* OEM revision number */
  32     char asl_compiler_id [4]; /* ASL compiler vendor ID */
  33     uint32_t asl_compiler_revision; /* ASL compiler revision number */
  34 } __attribute__((packed));
  35
  36 char *acpi_tables;
  37 size_t acpi_tables_len;
  38
  39 static int acpi_checksum(const uint8_t *data, int len)
  40 {
  41     int sum, i;
  42     sum = 0;
  43     for(i = 0; i < len; i++)
  44         sum += data[i];
  45     return (-sum) & 0xff;
  46 }
  47
  48 int acpi_table_add(const char *t)
  49 {
  50     static const char *dfl_id = "QEMUQEMU";
  51     char buf[1024], *p, *f;
  52     struct acpi_table_header acpi_hdr;
  53     unsigned long val;
  54     uint32_t length;
  55     struct acpi_table_header *acpi_hdr_p;
  56     size_t off;
  57
  58     memset(&acpi_hdr, 0, sizeof(acpi_hdr));
  59
  60     if (get_param_value(buf, sizeof(buf), "sig", t)) {
  61         strncpy(acpi_hdr.signature, buf, 4);
  62     } else {
  63         strncpy(acpi_hdr.signature, dfl_id, 4);
  64     }
  65     if (get_param_value(buf, sizeof(buf), "rev", t)) {
  66         val = strtoul(buf, &p, 10);
  67         if (val > 255 || *p != '\0')
  68             goto out;
  69     } else {
  70         val = 1;
  71     }
  72     acpi_hdr.revision = (int8_t)val;
  73
  74     if (get_param_value(buf, sizeof(buf), "oem_id", t)) {
  75         strncpy(acpi_hdr.oem_id, buf, 6);
  76     } else {
  77         strncpy(acpi_hdr.oem_id, dfl_id, 6);
  78     }
  79
  80     if (get_param_value(buf, sizeof(buf), "oem_table_id", t)) {
  81         strncpy(acpi_hdr.oem_table_id, buf, 8);
  82     } else {
  83         strncpy(acpi_hdr.oem_table_id, dfl_id, 8);
  84     }
  85
  86     if (get_param_value(buf, sizeof(buf), "oem_rev", t)) {
  87         val = strtol(buf, &p, 10);
  88         if(*p != '\0')
  89             goto out;
  90     } else {
  91         val = 1;
  92     }
  93     acpi_hdr.oem_revision = cpu_to_le32(val);
  94
  95     if (get_param_value(buf, sizeof(buf), "asl_compiler_id", t)) {
  96         strncpy(acpi_hdr.asl_compiler_id, buf, 4);
  97     } else {
  98         strncpy(acpi_hdr.asl_compiler_id, dfl_id, 4);
  99     }
 100
 101     if (get_param_value(buf, sizeof(buf), "asl_compiler_rev", t)) {
 102         val = strtol(buf, &p, 10);
 103         if(*p != '\0')
 104             goto out;
 105     } else {
 106         val = 1;
 107     }
 108     acpi_hdr.asl_compiler_revision = cpu_to_le32(val);
 109
 110     if (!get_param_value(buf, sizeof(buf), "data", t)) {
 111          buf[0] = '\0';
 112     }
 113
 114     length = sizeof(acpi_hdr);
 115
 116     f = buf;
 117     while (buf[0]) {
 118         struct stat s;
 119         char *n = strchr(f, ':');
 120         if (n)
 121             *n = '\0';
 122         if(stat(f, &s) < 0) {
 123             fprintf(stderr, "Can't stat file '%s': %s\n", f, strerror(errno));
 124             goto out;
 125         }
 126         length += s.st_size;
 127         if (!n)
 128             break;
 129         *n = ':';
 130         f = n + 1;
 131     }
 132
 133     if (!acpi_tables) {
 134         acpi_tables_len = sizeof(uint16_t);
 135         acpi_tables = qemu_mallocz(acpi_tables_len);
 136     }
 137     acpi_tables = qemu_realloc(acpi_tables,
 138                                acpi_tables_len + sizeof(uint16_t) + length);
 139     p = acpi_tables + acpi_tables_len;
 140     acpi_tables_len += sizeof(uint16_t) + length;
 141
 142     *(uint16_t*)p = cpu_to_le32(length);
 143     p += sizeof(uint16_t);
 144     memcpy(p, &acpi_hdr, sizeof(acpi_hdr));
 145     off = sizeof(acpi_hdr);
 146
 147     f = buf;
 148     while (buf[0]) {
 149         struct stat s;
 150         int fd;
 151         char *n = strchr(f, ':');
 152         if (n)
 153             *n = '\0';
 154         fd = open(f, O_RDONLY);
 155
 156         if(fd < 0)
 157             goto out;
 158         if(fstat(fd, &s) < 0) {
 159             close(fd);
 160             goto out;
 161         }
 162
 163         /* off < length is necessary because file size can be changed
 164            under our foot */
 165         while(s.st_size && off < length) {
 166             int r;
 167             r = read(fd, p + off, s.st_size);
 168             if (r > 0) {
 169                 off += r;
 170                 s.st_size -= r;
 171             } else if ((r < 0 && errno != EINTR) || r == 0) {
 172                 close(fd);
 173                 goto out;
 174             }
 175         }
 176
 177         close(fd);
 178         if (!n)
 179             break;
 180         f = n + 1;
 181     }
 182     if (off < length) {
 183         /* don't pass random value in process to guest */
 184         memset(p + off, 0, length - off);
 185     }
 186
 187     acpi_hdr_p = (struct acpi_table_header*)p;
 188     acpi_hdr_p->length = cpu_to_le32(length);
 189     acpi_hdr_p->checksum = acpi_checksum((uint8_t*)p, length);
 190     /* increase number of tables */
 191     (*(uint16_t*)acpi_tables) =
 192             cpu_to_le32(le32_to_cpu(*(uint16_t*)acpi_tables) + 1);
 193     return 0;
 194 out:
 195     if (acpi_tables) {
 196         qemu_free(acpi_tables);
 197         acpi_tables = NULL;
 198     }
 199     return -1;
 200 }
 201
 202 /* ACPI PM1a EVT */
 203 uint16_t acpi_pm1_evt_get_sts(ACPIPM1EVT *pm1, int64_t overflow_time)
 204 {
 205     int64_t d = acpi_pm_tmr_get_clock();
 206     if (d >= overflow_time) {
 207         pm1->sts |= ACPI_BITMASK_TIMER_STATUS;
 208     }
 209     return pm1->sts;
 210 }
 211
 212 void acpi_pm1_evt_write_sts(ACPIPM1EVT *pm1, ACPIPMTimer *tmr, uint16_t val)
 213 {
 214     uint16_t pm1_sts = acpi_pm1_evt_get_sts(pm1, tmr->overflow_time);
 215     if (pm1_sts & val & ACPI_BITMASK_TIMER_STATUS) {
 216         /* if TMRSTS is reset, then compute the new overflow time */
 217         acpi_pm_tmr_calc_overflow_time(tmr);
 218     }
 219     pm1->sts &= ~val;
 220 }
 221
 222 void acpi_pm1_evt_power_down(ACPIPM1EVT *pm1, ACPIPMTimer *tmr)
 223 {
 224     if (!pm1) {
 225         qemu_system_shutdown_request();
 226     } else if (pm1->en & ACPI_BITMASK_POWER_BUTTON_ENABLE) {
 227         pm1->sts |= ACPI_BITMASK_POWER_BUTTON_STATUS;
 228         tmr->update_sci(tmr);
 229     }
 230 }
 231
 232 void acpi_pm1_evt_reset(ACPIPM1EVT *pm1)
 233 {
 234     pm1->sts = 0;
 235     pm1->en = 0;
 236 }
 237
 238 /* ACPI PM_TMR */
 239 void acpi_pm_tmr_update(ACPIPMTimer *tmr, bool enable)
 240 {
 241     int64_t expire_time;
 242
 243     /* schedule a timer interruption if needed */
 244     if (enable) {
 245         expire_time = muldiv64(tmr->overflow_time, get_ticks_per_sec(),
 246                                PM_TIMER_FREQUENCY);
 247         qemu_mod_timer(tmr->timer, expire_time);
 248     } else {
 249         qemu_del_timer(tmr->timer);
 250     }
 251 }
 252
 253 void acpi_pm_tmr_calc_overflow_time(ACPIPMTimer *tmr)
 254 {
 255     int64_t d = acpi_pm_tmr_get_clock();
 256     tmr->overflow_time = (d + 0x800000LL) & ~0x7fffffLL;
 257 }
 258
 259 uint32_t acpi_pm_tmr_get(ACPIPMTimer *tmr)
 260 {
 261     uint32_t d = acpi_pm_tmr_get_clock();;
 262     return d & 0xffffff;
 263 }
 264
 265 static void acpi_pm_tmr_timer(void *opaque)
 266 {
 267     ACPIPMTimer *tmr = opaque;
 268     tmr->update_sci(tmr);
 269 }
 270
 271 void acpi_pm_tmr_init(ACPIPMTimer *tmr, acpi_update_sci_fn update_sci)
 272 {
 273     tmr->update_sci = update_sci;
 274     tmr->timer = qemu_new_timer_ns(vm_clock, acpi_pm_tmr_timer, tmr);
 275 }
 276
 277 void acpi_pm_tmr_reset(ACPIPMTimer *tmr)
 278 {
 279     tmr->overflow_time = 0;
 280     qemu_del_timer(tmr->timer);
 281 }
 282
 283 /* ACPI PM1aCNT */
 284 void acpi_pm1_cnt_init(ACPIPM1CNT *pm1_cnt, qemu_irq cmos_s3)
 285 {
 286     pm1_cnt->cmos_s3 = cmos_s3;
 287 }
 288
 289 void acpi_pm1_cnt_write(ACPIPM1EVT *pm1a, ACPIPM1CNT *pm1_cnt, uint16_t val)
 290 {
 291     pm1_cnt->cnt = val & ~(ACPI_BITMASK_SLEEP_ENABLE);
 292
 293     if (val & ACPI_BITMASK_SLEEP_ENABLE) {
 294         /* change suspend type */
 295         uint16_t sus_typ = (val >> 10) & 7;
 296         switch(sus_typ) {
 297         case 0: /* soft power off */
 298             qemu_system_shutdown_request();
 299             break;
 300         case 1:
 301             /* ACPI_BITMASK_WAKE_STATUS should be set on resume.
 302                Pretend that resume was caused by power button */
 303             pm1a->sts |=
 304                 (ACPI_BITMASK_WAKE_STATUS | ACPI_BITMASK_POWER_BUTTON_STATUS);
 305             qemu_system_reset_request();
 306             qemu_irq_raise(pm1_cnt->cmos_s3);
 307         default:
 308             break;
 309         }
 310     }
 311 }
 312
 313 void acpi_pm1_cnt_update(ACPIPM1CNT *pm1_cnt,
 314                          bool sci_enable, bool sci_disable)
 315 {
 316     /* ACPI specs 3.0, 4.7.2.5 */
 317     if (sci_enable) {
 318         pm1_cnt->cnt |= ACPI_BITMASK_SCI_ENABLE;
 319     } else if (sci_disable) {
 320         pm1_cnt->cnt &= ~ACPI_BITMASK_SCI_ENABLE;
 321     }
 322 }
 323
 324 void acpi_pm1_cnt_reset(ACPIPM1CNT *pm1_cnt)
 325 {
 326     pm1_cnt->cnt = 0;
 327     if (pm1_cnt->cmos_s3) {
 328         qemu_irq_lower(pm1_cnt->cmos_s3);
 329     }
 330 }
 331
 332 /* ACPI GPE */
 333 void acpi_gpe_init(ACPIGPE *gpe, uint8_t len)
 334 {
 335     gpe->len = len;
 336     gpe->sts = qemu_mallocz(len / 2);
 337     gpe->en = qemu_mallocz(len / 2);
 338 }
 339
 340 void acpi_gpe_blk(ACPIGPE *gpe, uint32_t blk)
 341 {
 342     gpe->blk = blk;
 343 }
 344
 345 void acpi_gpe_reset(ACPIGPE *gpe)
 346 {
 347     memset(gpe->sts, 0, gpe->len / 2);
 348     memset(gpe->en, 0, gpe->len / 2);
 349 }
 350
 351 static uint8_t *acpi_gpe_ioport_get_ptr(ACPIGPE *gpe, uint32_t addr)
 352 {
 353     uint8_t *cur = NULL;
 354
 355     if (addr < gpe->len / 2) {
 356         cur = gpe->sts + addr;
 357     } else if (addr < gpe->len) {
 358         cur = gpe->en + addr - gpe->len / 2;
 359     } else {
 360         abort();
 361     }
 362
 363     return cur;
 364 }
 365
 366 void acpi_gpe_ioport_writeb(ACPIGPE *gpe, uint32_t addr, uint32_t val)
 367 {
 368     uint8_t *cur;
 369
 370     addr -= gpe->blk;
 371     cur = acpi_gpe_ioport_get_ptr(gpe, addr);
 372     if (addr < gpe->len / 2) {
 373         /* GPE_STS */
 374         *cur = (*cur) & ~val;
 375     } else if (addr < gpe->len) {
 376         /* GPE_EN */
 377         *cur = val;
 378     } else {
 379         abort();
 380     }
 381 }
 382
 383 uint32_t acpi_gpe_ioport_readb(ACPIGPE *gpe, uint32_t addr)
 384 {
 385     uint8_t *cur;
 386     uint32_t val;
 387
 388     addr -= gpe->blk;
 389     cur = acpi_gpe_ioport_get_ptr(gpe, addr);
 390     val = 0;
 391     if (cur != NULL) {
 392         val = *cur;
 393     }
 394
 395     return val;
 396 }