aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authorNaresh Bhat <naresh.bhat@linaro.org>2014-07-01 00:38:05 +0530
committerNaresh Bhat <naresh.bhat@linaro.org>2014-09-03 16:38:45 +0530
commit746d650ed6d1df2ef7edc11200556d933107c78b (patch)
treeff1a99ee74a40be4fe40d517603bf80f07259e2d
parent12f0140170cf9fc6b0f36195d8d3ff10f7287243 (diff)
downloadxen-746d650ed6d1df2ef7edc11200556d933107c78b.tar.gz
ACPI: Introduce acpi_parse_entries
Introduce acpi_parse_entries Signed-off-by: Naresh Bhat <Naresh.Bhat@linaro.org>
-rw-r--r--xen/drivers/acpi/tables.c64
-rw-r--r--xen/include/xen/acpi.h4
2 files changed, 68 insertions, 0 deletions
diff --git a/xen/drivers/acpi/tables.c b/xen/drivers/acpi/tables.c
index 43f4305467..a03a0b48c3 100644
--- a/xen/drivers/acpi/tables.c
+++ b/xen/drivers/acpi/tables.c
@@ -239,6 +239,70 @@ void __init acpi_table_print_madt_entry(struct acpi_subtable_header *header)
int __init
+acpi_parse_entries(unsigned long table_size,
+ acpi_table_entry_handler handler,
+ struct acpi_table_header *table_header,
+ int entry_id, unsigned int max_entries)
+{
+ struct acpi_subtable_header *entry;
+ int count = 0;
+ unsigned long table_end;
+
+ if (acpi_disabled)
+ return -ENODEV;
+
+ if (!handler)
+ return -EINVAL;
+
+ if (!table_size)
+ return -EINVAL;
+
+ if (!table_header) {
+ printk("Table header not present\n");
+ return -ENODEV;
+ }
+
+ 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->type == entry_id
+ && (!max_entries || count++ < max_entries))
+ if (handler(entry, table_end)) {
+ count = -EINVAL;
+ goto err;
+ }
+
+ /*
+ * If entry->length is 0, break from this loop to avoid
+ * infinite loop.
+ */
+ if (entry->length == 0) {
+ printk("[0x%02x] Invalid zero length\n", entry_id);
+ count = -EINVAL;
+ goto err;
+ }
+
+ entry = (struct acpi_subtable_header *)
+ ((unsigned long)entry + entry->length);
+ }
+
+ if (max_entries && count > max_entries) {
+ printk("[0x%02x] ignored %i entries of %i found\n",
+ entry_id, count - max_entries, count);
+ }
+
+err:
+ return count;
+}
+
+
+int __init
acpi_table_parse_entries(char *id,
unsigned long table_size,
int entry_id,
diff --git a/xen/include/xen/acpi.h b/xen/include/xen/acpi.h
index 9387b36046..bf6033483e 100644
--- a/xen/include/xen/acpi.h
+++ b/xen/include/xen/acpi.h
@@ -81,6 +81,10 @@ void acpi_hest_init(void);
int acpi_table_init (void);
int acpi_table_parse(char *id, acpi_table_handler handler);
+int __init acpi_parse_entries(unsigned long table_size,
+ acpi_table_entry_handler handler,
+ struct acpi_table_header *table_header,
+ int entry_id, unsigned int max_entries);
int acpi_table_parse_entries(char *id, unsigned long table_size,
int entry_id, acpi_table_entry_handler handler, unsigned int max_entries);
int acpi_table_parse_madt(enum acpi_madt_type id, acpi_table_entry_handler handler, unsigned int max_entries);