@@ -221,6 +221,51 @@ void __init acpi_table_print_madt_entry(struct acpi_subtable_header *header)
}
}
+struct acpi_subtable_header * __init
+acpi_get_entry(char *id, unsigned long table_size,
+ struct acpi_table_header *table_header, int entry_id,
+ unsigned int entry_index)
+{
+ struct acpi_subtable_header *entry;
+ unsigned int count = 0;
+ unsigned long table_end;
+
+ if ( !table_size )
+ return NULL;
+
+ if ( !table_header )
+ {
+ printk("Table header not present\n");
+ return NULL;
+ }
+
+ table_end = (unsigned long)table_header + table_header->length;
+
+ /* Parse all entries looking for a match. */
+ entry = (struct acpi_subtable_header *)
+ ((unsigned long)table_header + table_size);
+
+ while (((unsigned long)entry) + sizeof(struct acpi_subtable_header) <
+ table_end) {
+ if (entry->length < sizeof(*entry)) {
+ printk(KERN_ERR PREFIX "[%4.4s:%#x] Invalid length\n",
+ id, entry_id);
+ return NULL;
+ }
+
+ if (entry->type == entry_id) {
+ if (count == entry_index)
+ return entry;
+ count++;
+ }
+
+ entry = (struct acpi_subtable_header *)
+ ((unsigned long)entry + entry->length);
+ }
+
+ return NULL;
+}
+
int __init
acpi_parse_entries(char *id,
unsigned long table_size,
@@ -72,6 +72,10 @@ int acpi_table_init (void);
int acpi_table_parse(char *id, acpi_table_handler handler);
int acpi_table_parse_entries(char *id, unsigned long table_size,
int entry_id, acpi_table_entry_handler handler, unsigned int max_entries);
+struct acpi_subtable_header *
+acpi_get_entry(char *id, unsigned long table_size,
+ struct acpi_table_header *table_header, int entry_id,
+ unsigned int entry_index);
int acpi_parse_entries(char *id, unsigned long table_size,
acpi_table_entry_handler handler, struct acpi_table_header *table_header,
int entry_id, unsigned int max_entries);