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 } 73