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
parse_rsdt(s_rsdt * r)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 }
73