4 files changed, 61 insertions, 0 deletions
diff --git a/src/soc/amd/picasso/Makefile.inc b/src/soc/amd/picasso/Makefile.inc
index d62ccda74d..ce0a7a8f43 100644
--- a/src/soc/amd/picasso/Makefile.inc
+++ b/src/soc/amd/picasso/Makefile.inc
@@ -47,6 +47,7 @@ ramstage-y += data_fabric_util.c
 ramstage-y += root_complex.c
 ramstage-y += mca.c
 ramstage-$(CONFIG_HAVE_ACPI_TABLES) += acpi.c
+ramstage-$(CONFIG_HAVE_ACPI_TABLES) += agesa_acpi.c
 ramstage-y += gpio.c
 ramstage-y += southbridge.c
 ramstage-y += pmutil.c
diff --git a/src/soc/amd/picasso/agesa_acpi.c b/src/soc/amd/picasso/agesa_acpi.c
new file mode 100644
index 0000000000..fb168a1f5a
--- /dev/null
+++ b/src/soc/amd/picasso/agesa_acpi.c
@@ -0,0 +1,55 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#include <acpi/acpi.h>
+#include <console/console.h>
+#include <fsp/util.h>
+#include <FspGuids.h>
+#include <soc/acpi.h>
+#include <stdint.h>
+
+struct amd_fsp_acpi_hob_info {
+	uint32_t table_size_in_bytes;
+	uint8_t total_hobs_for_table;
+	uint8_t sequence_number;
+	uint16_t reserved;
+	uint16_t hob_payload[0xffc8];
+} __packed;
+
+static uintptr_t add_agesa_acpi_table(guid_t guid, const char *name, acpi_rsdp_t *rsdp,
+				      uintptr_t current)
+{
+	const struct amd_fsp_acpi_hob_info *data;
+	void *table = (void *)current;
+	size_t hob_size;
+
+	data = fsp_find_extension_hob_by_guid(guid.b, &hob_size);
+	if (!data) {
+		printk(BIOS_ERR, "AGESA %s ACPI table was not found.\n", name);
+		return current;
+	}
+
+	printk(BIOS_INFO, "ACPI:    * %s (AGESA).\n", name);
+
+	memcpy(table, data->hob_payload, data->table_size_in_bytes);
+
+	current += data->table_size_in_bytes;
+	acpi_add_table(rsdp, table);
+	current = acpi_align_current(current);
+
+	return current;
+}
+
+uintptr_t agesa_write_acpi_tables(const struct device *device, uintptr_t current,
+				  acpi_rsdp_t *rsdp)
+{
+	printk(BIOS_DEBUG, "Searching for AGESA FSP ACPI Tables\n");
+
+	current = add_agesa_acpi_table(AMD_FSP_ACPI_SSDT_HOB_GUID, "SSDT", rsdp, current);
+	current = add_agesa_acpi_table(AMD_FSP_ACPI_CRAT_HOB_GUID, "CRAT", rsdp, current);
+	current = add_agesa_acpi_table(AMD_FSP_ACPI_ALIB_HOB_GUID, "ALIB", rsdp, current);
+	current = add_agesa_acpi_table(AMD_FSP_ACPI_IVRS_HOB_GUID, "IVRS", rsdp, current);
+
+	/* Add SRAT, MSCT, SLIT if needed in the future */
+
+	return current;
+}
diff --git a/src/soc/amd/picasso/chip.c b/src/soc/amd/picasso/chip.c
index 4ea962f715..7c6e6fb967 100644
--- a/src/soc/amd/picasso/chip.c
+++ b/src/soc/amd/picasso/chip.c
@@ -143,6 +143,8 @@ static void enable_dev(struct device *dev)
 
 static void soc_init(void *chip_info)
 {
+	default_dev_ops_root.write_acpi_tables = agesa_write_acpi_tables;
+
 	fsp_silicon_init(acpi_is_wakeup_s3());
 
 	data_fabric_set_mmio_np();
diff --git a/src/soc/amd/picasso/include/soc/acpi.h b/src/soc/amd/picasso/include/soc/acpi.h
index 6250f8682a..77f836cec2 100644
--- a/src/soc/amd/picasso/include/soc/acpi.h
+++ b/src/soc/amd/picasso/include/soc/acpi.h
@@ -14,6 +14,9 @@ unsigned long southbridge_write_acpi_tables(const struct device *device,
 
 void southbridge_inject_dsdt(const struct device *device);
 
+uintptr_t agesa_write_acpi_tables(const struct device *device, uintptr_t current,
+				  acpi_rsdp_t *rsdp);
+
 const char *soc_acpi_name(const struct device *dev);
 
 #endif /* __SOC_PICASSO_ACPI_H__ */