Some devices need to inject extra code into the Differentiated System
Descriptor Table (DSDT). Add a method to handle this.

Signed-off-by: Simon Glass <s...@chromium.org>
Reviewed-by: Wolfgang Wallner <wolfgang.wall...@br-automation.com>
---

Changes in v3:
- Fix 'THe' typo
- Rename build_type() to sort_acpi_item_type()

Changes in v1:
- Generalise the ACPI function recursion with acpi_recurse_method()

 arch/sandbox/dts/test.dts |  2 ++
 drivers/core/acpi.c       | 25 +++++++++++++++++++++-
 include/dm/acpi.h         | 23 ++++++++++++++++++++
 test/dm/acpi.c            | 44 +++++++++++++++++++++++++++++++++++++++
 4 files changed, 93 insertions(+), 1 deletion(-)

diff --git a/arch/sandbox/dts/test.dts b/arch/sandbox/dts/test.dts
index 993082763d..caf935cfdf 100644
--- a/arch/sandbox/dts/test.dts
+++ b/arch/sandbox/dts/test.dts
@@ -257,6 +257,7 @@
        acpi_test1: acpi-test {
                compatible = "denx,u-boot-acpi-test";
                acpi-ssdt-test-data = "ab";
+               acpi-dsdt-test-data = "hi";
                child {
                        compatible = "denx,u-boot-acpi-test";
                };
@@ -265,6 +266,7 @@
        acpi_test2: acpi-test2 {
                compatible = "denx,u-boot-acpi-test";
                acpi-ssdt-test-data = "cd";
+               acpi-dsdt-test-data = "jk";
        };
 
        clocks {
diff --git a/drivers/core/acpi.c b/drivers/core/acpi.c
index 4719a5c4e4..c1fc364550 100644
--- a/drivers/core/acpi.c
+++ b/drivers/core/acpi.c
@@ -22,12 +22,14 @@
 enum gen_type_t {
        TYPE_NONE,
        TYPE_SSDT,
+       TYPE_DSDT,
 };
 
 /* Type of method to call */
 enum method_t {
        METHOD_WRITE_TABLES,
        METHOD_FILL_SSDT,
+       METHOD_INJECT_DSDT,
 };
 
 /* Prototype for all methods */
@@ -144,7 +146,9 @@ static int sort_acpi_item_type(struct acpi_ctx *ctx, void 
*start,
        void *end = ctx->current;
 
        ptr = start;
-       order = ofnode_read_chosen_prop("u-boot,acpi-ssdt-order", &size);
+       order = ofnode_read_chosen_prop(type == TYPE_DSDT ?
+                                       "u-boot,acpi-dsdt-order" :
+                                       "u-boot,acpi-ssdt-order", &size);
        if (!order) {
                log_warning("Failed to find ordering, leaving as is\n");
                return 0;
@@ -189,6 +193,8 @@ acpi_method acpi_get_method(struct udevice *dev, enum 
method_t method)
                        return aops->write_tables;
                case METHOD_FILL_SSDT:
                        return aops->fill_ssdt;
+               case METHOD_INJECT_DSDT:
+                       return aops->inject_dsdt;
                }
        }
 
@@ -247,6 +253,23 @@ int acpi_fill_ssdt(struct acpi_ctx *ctx)
        return ret;
 }
 
+int acpi_inject_dsdt(struct acpi_ctx *ctx)
+{
+       void *start = ctx->current;
+       int ret;
+
+       log_debug("Writing DSDT tables\n");
+       item_count = 0;
+       ret = acpi_recurse_method(ctx, dm_root(), METHOD_INJECT_DSDT,
+                                 TYPE_DSDT);
+       log_debug("Writing DSDT finished, err=%d\n", ret);
+       ret = sort_acpi_item_type(ctx, start, TYPE_DSDT);
+       if (ret)
+               return log_msg_ret("build", ret);
+
+       return ret;
+}
+
 int acpi_write_dev_tables(struct acpi_ctx *ctx)
 {
        int ret;
diff --git a/include/dm/acpi.h b/include/dm/acpi.h
index eda23f97a6..18bce2baf6 100644
--- a/include/dm/acpi.h
+++ b/include/dm/acpi.h
@@ -87,6 +87,19 @@ struct acpi_ops {
         * @return 0 if OK, -ve on error
         */
        int (*fill_ssdt)(const struct udevice *dev, struct acpi_ctx *ctx);
+
+       /**
+        * inject_dsdt() - Generate DSDT code for a device
+        *
+        * This is called to create the DSDT code. The method should write out
+        * whatever ACPI code is needed by this device. It will end up in the
+        * DSDT table.
+        *
+        * @dev: Device to write
+        * @ctx: ACPI context to use
+        * @return 0 if OK, -ve on error
+        */
+       int (*inject_dsdt)(const struct udevice *dev, struct acpi_ctx *ctx);
 };
 
 #define device_get_acpi_ops(dev)       ((dev)->driver->acpi_ops)
@@ -141,6 +154,16 @@ int acpi_write_dev_tables(struct acpi_ctx *ctx);
  */
 int acpi_fill_ssdt(struct acpi_ctx *ctx);
 
+/**
+ * acpi_inject_dsdt() - Generate ACPI tables for DSDT
+ *
+ * This is called to create the DSDT code for all devices.
+ *
+ * @ctx: ACPI context to use
+ * @return 0 if OK, -ve on error
+ */
+int acpi_inject_dsdt(struct acpi_ctx *ctx);
+
 #endif /* __ACPI__ */
 
 #endif
diff --git a/test/dm/acpi.c b/test/dm/acpi.c
index 4e1d401e0d..1abde65c8c 100644
--- a/test/dm/acpi.c
+++ b/test/dm/acpi.c
@@ -81,10 +81,24 @@ static int testacpi_fill_ssdt(const struct udevice *dev, 
struct acpi_ctx *ctx)
        return 0;
 }
 
+static int testacpi_inject_dsdt(const struct udevice *dev, struct acpi_ctx 
*ctx)
+{
+       const char *data;
+
+       data = dev_read_string(dev, "acpi-dsdt-test-data");
+       if (data) {
+               while (*data)
+                       acpigen_emit_byte(ctx, *data++);
+       }
+
+       return 0;
+}
+
 struct acpi_ops testacpi_ops = {
        .get_name       = testacpi_get_name,
        .write_tables   = testacpi_write_tables,
        .fill_ssdt      = testacpi_fill_ssdt,
+       .inject_dsdt    = testacpi_inject_dsdt,
 };
 
 static const struct udevice_id testacpi_ids[] = {
@@ -441,3 +455,33 @@ static int dm_test_acpi_fill_ssdt(struct unit_test_state 
*uts)
        return 0;
 }
 DM_TEST(dm_test_acpi_fill_ssdt, DM_TESTF_SCAN_PDATA | DM_TESTF_SCAN_FDT);
+
+/* Test acpi_inject_dsdt() */
+static int dm_test_acpi_inject_dsdt(struct unit_test_state *uts)
+{
+       struct acpi_ctx ctx;
+       u8 *buf;
+
+       buf = malloc(BUF_SIZE);
+       ut_assertnonnull(buf);
+
+       ctx.current = buf;
+       buf[4] = 'z';   /* sentinel */
+       ut_assertok(acpi_inject_dsdt(&ctx));
+
+       /*
+        * These values come from acpi-test's acpi-dsdt-test-data property.
+        * There is no u-boot,acpi-dsdt-order so device-tree order is used.
+        */
+       ut_asserteq('h', buf[0]);
+       ut_asserteq('i', buf[1]);
+
+       /* These values come from acpi-test's acpi-dsdt-test-data property */
+       ut_asserteq('j', buf[2]);
+       ut_asserteq('k', buf[3]);
+
+       ut_asserteq('z', buf[4]);
+
+       return 0;
+}
+DM_TEST(dm_test_acpi_inject_dsdt, DM_TESTF_SCAN_PDATA | DM_TESTF_SCAN_FDT);
-- 
2.27.0.290.gba653c62da-goog

Reply via email to