com32/gpllib/acpi/xsdt.c

   1 /* ----------------------------------------------------------------------- *
   2  *
   3  *   Copyright 2009-2011 Erwan Velu - All Rights Reserved
   4  *
   5  *   Permission is hereby granted, free of charge, to any person
   6  *   obtaining a copy of this software and associated documentation
   7  *   files (the "Software"), to deal in the Software without
   8  *   restriction, including without limitation the rights to use,
   9  *   copy, modify, merge, publish, distribute, sublicense, and/or
  10  *   sell copies of the Software, and to permit persons to whom
  11  *   the Software is furnished to do so, subject to the following
  12  *   conditions:
  13  *
  14  *   The above copyright notice and this permission notice shall
  15  *   be included in all copies or substantial portions of the Software.
  16  *
  17  *   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  18  *   EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
  19  *   OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  20  *   NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
  21  *   HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  22  *   WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  23  *   FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  24  *   OTHER DEALINGS IN THE SOFTWARE.
  25  *
  26  * -----------------------------------------------------------------------
  27 */
  28
  29 #include <stdio.h>
  30 #include <string.h>
  31 #include <memory.h>
  32 #include <stdlib.h>
  33 #include "acpi/acpi.h"
  34
  35 int parse_xsdt(s_acpi * acpi)
  36 {
  37     /* Let's seach for XSDT table */
  38     uint8_t *q;
  39
  40     /* Let's start for the base address */
  41     q = acpi->xsdt.address;
  42
  43     /* If address is null return an error */
  44     if (q == 0 ) {
  45         DEBUG_PRINT(("XSDT is null, exiting\n"));
  46         return -XSDT_TABLE_FOUND;
  47     }
  48
  49     DEBUG_PRINT(("Searching XSDT at %p",q));
  50     /* Searching for MADT with APIC signature */
  51     if (memcmp(q, XSDT, sizeof(XSDT) - 1) == 0) {
  52         s_xsdt *x = &acpi->xsdt;
  53         x->valid = true;
  54         get_acpi_description_header(q, &x->header);
  55         DEBUG_PRINT(("XSDT table found at %p : length=%d\n",x->address,x->header.length));
  56         DEBUG_PRINT(("Expected Tables = %d\n",(x->header.length-ACPI_HEADER_SIZE)/8));
  57
  58         /* We now have a set of pointers to some tables */
  59         uint64_t *p = NULL;
  60         for (p = ((uint64_t *)(x->address + ACPI_HEADER_SIZE));
  61              p < ((uint64_t *)(x->address + x->header.length)); p++) {
  62             DEBUG_PRINT((" Looking for HEADER at %p = %x\n",p,*p));
  63
  64             /* Let's grab the pointed table header */
  65             char address[16] = { 0 };
  66             sprintf(address, "%llx", *p);
  67             uint64_t *pointed_address = (uint64_t *)strtoul(address, NULL, 16);
  68
  69             x->entry[x->entry_count] = pointed_address;
  70             if (parse_header(pointed_address, acpi)) {
  71                 x->entry_count++;
  72             }
  73         }
  74         return XSDT_TABLE_FOUND;
  75     }
  76     return -XSDT_TABLE_FOUND;
  77 }