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 "hw.h"
  19 #include "pc.h"
  20 #include "acpi.h"
  21
  22 struct acpi_table_header
  23 {
  24     char signature [4];    /* ACPI signature (4 ASCII characters) */
  25     uint32_t length;          /* Length of table, in bytes, including header */
  26     uint8_t revision;         /* ACPI Specification minor version # */
  27     uint8_t checksum;         /* To make sum of entire table == 0 */
  28     char oem_id [6];       /* OEM identification */
  29     char oem_table_id [8]; /* OEM table identification */
  30     uint32_t oem_revision;    /* OEM revision number */
  31     char asl_compiler_id [4]; /* ASL compiler vendor ID */
  32     uint32_t asl_compiler_revision; /* ASL compiler revision number */
  33 } __attribute__((packed));
  34
  35 char *acpi_tables;
  36 size_t acpi_tables_len;
  37
  38 static int acpi_checksum(const uint8_t *data, int len)
  39 {
  40     int sum, i;
  41     sum = 0;
  42     for(i = 0; i < len; i++)
  43         sum += data[i];
  44     return (-sum) & 0xff;
  45 }
  46
  47 int acpi_table_add(const char *t)
  48 {
  49     static const char *dfl_id = "QEMUQEMU";
  50     char buf[1024], *p, *f;
  51     struct acpi_table_header acpi_hdr;
  52     unsigned long val;
  53     uint32_t length;
  54     struct acpi_table_header *acpi_hdr_p;
  55     size_t off;
  56
  57     memset(&acpi_hdr, 0, sizeof(acpi_hdr));
  58
  59     if (get_param_value(buf, sizeof(buf), "sig", t)) {
  60         strncpy(acpi_hdr.signature, buf, 4);
  61     } else {
  62         strncpy(acpi_hdr.signature, dfl_id, 4);
  63     }
  64     if (get_param_value(buf, sizeof(buf), "rev", t)) {
  65         val = strtoul(buf, &p, 10);
  66         if (val > 255 || *p != '\0')
  67             goto out;
  68     } else {
  69         val = 1;
  70     }
  71     acpi_hdr.revision = (int8_t)val;
  72
  73     if (get_param_value(buf, sizeof(buf), "oem_id", t)) {
  74         strncpy(acpi_hdr.oem_id, buf, 6);
  75     } else {
  76         strncpy(acpi_hdr.oem_id, dfl_id, 6);
  77     }
  78
  79     if (get_param_value(buf, sizeof(buf), "oem_table_id", t)) {
  80         strncpy(acpi_hdr.oem_table_id, buf, 8);
  81     } else {
  82         strncpy(acpi_hdr.oem_table_id, dfl_id, 8);
  83     }
  84
  85     if (get_param_value(buf, sizeof(buf), "oem_rev", t)) {
  86         val = strtol(buf, &p, 10);
  87         if(*p != '\0')
  88             goto out;
  89     } else {
  90         val = 1;
  91     }
  92     acpi_hdr.oem_revision = cpu_to_le32(val);
  93
  94     if (get_param_value(buf, sizeof(buf), "asl_compiler_id", t)) {
  95         strncpy(acpi_hdr.asl_compiler_id, buf, 4);
  96     } else {
  97         strncpy(acpi_hdr.asl_compiler_id, dfl_id, 4);
  98     }
  99
 100     if (get_param_value(buf, sizeof(buf), "asl_compiler_rev", t)) {
 101         val = strtol(buf, &p, 10);
 102         if(*p != '\0')
 103             goto out;
 104     } else {
 105         val = 1;
 106     }
 107     acpi_hdr.asl_compiler_revision = cpu_to_le32(val);
 108
 109     if (!get_param_value(buf, sizeof(buf), "data", t)) {
 110          buf[0] = '\0';
 111     }
 112
 113     length = sizeof(acpi_hdr);
 114
 115     f = buf;
 116     while (buf[0]) {
 117         struct stat s;
 118         char *n = strchr(f, ':');
 119         if (n)
 120             *n = '\0';
 121         if(stat(f, &s) < 0) {
 122             fprintf(stderr, "Can't stat file '%s': %s\n", f, strerror(errno));
 123             goto out;
 124         }
 125         length += s.st_size;
 126         if (!n)
 127             break;
 128         *n = ':';
 129         f = n + 1;
 130     }
 131
 132     if (!acpi_tables) {
 133         acpi_tables_len = sizeof(uint16_t);
 134         acpi_tables = qemu_mallocz(acpi_tables_len);
 135     }
 136     acpi_tables = qemu_realloc(acpi_tables,
 137                                acpi_tables_len + sizeof(uint16_t) + length);
 138     p = acpi_tables + acpi_tables_len;
 139     acpi_tables_len += sizeof(uint16_t) + length;
 140
 141     *(uint16_t*)p = cpu_to_le32(length);
 142     p += sizeof(uint16_t);
 143     memcpy(p, &acpi_hdr, sizeof(acpi_hdr));
 144     off = sizeof(acpi_hdr);
 145
 146     f = buf;
 147     while (buf[0]) {
 148         struct stat s;
 149         int fd;
 150         char *n = strchr(f, ':');
 151         if (n)
 152             *n = '\0';
 153         fd = open(f, O_RDONLY);
 154
 155         if(fd < 0)
 156             goto out;
 157         if(fstat(fd, &s) < 0) {
 158             close(fd);
 159             goto out;
 160         }
 161
 162         /* off < length is necessary because file size can be changed
 163            under our foot */
 164         while(s.st_size && off < length); {
 165             int r;
 166             r = read(fd, p + off, s.st_size);
 167             if (r > 0) {
 168                 off += r;
 169                 s.st_size -= r;
 170             } else if ((r < 0 && errno != EINTR) || r == 0) {
 171                 close(fd);
 172                 goto out;
 173             }
 174         }
 175
 176         close(fd);
 177         if (!n)
 178             break;
 179         f = n + 1;
 180     }
 181     if (off < length) {
 182         /* don't pass random value in process to guest */
 183         memset(p + off, 0, length - off);
 184     }
 185
 186     acpi_hdr_p = (struct acpi_table_header*)p;
 187     acpi_hdr_p->length = cpu_to_le32(length);
 188     acpi_hdr_p->checksum = acpi_checksum((uint8_t*)p, length);
 189     /* increase number of tables */
 190     (*(uint16_t*)acpi_tables) =
 191             cpu_to_le32(le32_to_cpu(*(uint16_t*)acpi_tables) + 1);
 192     return 0;
 193 out:
 194     if (acpi_tables) {
 195         qemu_free(acpi_tables);
 196         acpi_tables = NULL;
 197     }
 198     return -1;
 199 }