com32/gpllib/acpi/rsdt.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 <stdlib.h>
  31 #include <string.h>
  32 #include <memory.h>
  33 #include <dprintf.h>
  34 #include "acpi/acpi.h"
  35
  36 int parse_rsdt(s_rsdt *r)
  37 {
  38     /* Let's seach for RSDT table */
  39     uint8_t *q;
  40
  41     /* Let's start for the base address */
  42     q = r->address;
  43
  44     DEBUG_PRINT(("Searching for RSDT at %p\n",q));
  45     /* Searching for MADT with APIC signature */
  46     if (memcmp(q, RSDT, sizeof(RSDT)-1) == 0) {
  47 //        DEBUG_PRINT(("RSDT : %c %c %c %c\n",q[0], q[1], q[2], q[3]));
  48         r->valid = true;
  49         DEBUG_PRINT(("Before \n"));
  50         get_acpi_description_header(q, &r->header);
  51         DEBUG_PRINT(("RSDT table at %p found with %d bytes long with %d items\n",r->address, r->header.length,(r->header.length-ACPI_HEADER_SIZE)/4));
  52
  53         uint32_t *start = (uint32_t *)r->address;
  54         start += (ACPI_HEADER_SIZE / 4);
  55         uint32_t *max = (uint32_t *)r->address;
  56         max += (r->header.length / 4);
  57         DEBUG_PRINT(("Searching starting at %p till %p\n",start,max));
  58         uint32_t *p;
  59         for (p = start ; p < max; p++) {
  60             /* Let's grab the pointed table header */
  61             char address[16] = { 0 };
  62             sprintf(address, "%x", *p);
  63             uint32_t *pointed_address = (uint32_t *)strtoul(address, NULL, 16);
  64             r->entry[r->entry_count] = (uint8_t *)pointed_address;
  65             DEBUG_PRINT(("%d : %p\n",r->entry_count, r->entry[r->entry_count]));
  66             r->entry_count++;
  67         }
  68         return RSDT_TABLE_FOUND;
  69     }
  70
  71     return -RSDT_TABLE_FOUND;
  72 }