Merge tag 'platform-drivers-x86-v5.18-1' of git://git.kernel.org/pub/scm/linux/kernel...

[linux-2.6-microblaze.git] / drivers / acpi / x86 / s2idle.c

diff --git a/drivers/acpi/x86/s2idle.c b/drivers/acpi/x86/s2idle.c
index ed889f8..2963229 100644 (file)
--- a/drivers/acpi/x86/s2idle.c
+++ b/drivers/acpi/x86/s2idle.c
@@ -86,6 +86,8 @@ struct lpi_device_constraint_amd {
        int min_dstate;
 };
 
+static LIST_HEAD(lps0_s2idle_devops_head);
+
 static struct lpi_constraints *lpi_constraints_table;
 static int lpi_constraints_table_size;
 static int rev_id;
@@ -440,6 +442,8 @@ static struct acpi_scan_handler lps0_handler = {
 
 int acpi_s2idle_prepare_late(void)
 {
+       struct acpi_s2idle_dev_ops *handler;
+
        if (!lps0_device_handle || sleep_no_lps0)
                return 0;
 
@@ -470,14 +474,26 @@ int acpi_s2idle_prepare_late(void)
                acpi_sleep_run_lps0_dsm(ACPI_LPS0_MS_ENTRY,
                                lps0_dsm_func_mask_microsoft, lps0_dsm_guid_microsoft);
        }
+
+       list_for_each_entry(handler, &lps0_s2idle_devops_head, list_node) {
+               if (handler->prepare)
+                       handler->prepare();
+       }
+
        return 0;
 }
 
 void acpi_s2idle_restore_early(void)
 {
+       struct acpi_s2idle_dev_ops *handler;
+
        if (!lps0_device_handle || sleep_no_lps0)
                return;
 
+       list_for_each_entry(handler, &lps0_s2idle_devops_head, list_node)
+               if (handler->restore)
+                       handler->restore();
+
        /* Modern standby exit */
        if (lps0_dsm_func_mask_microsoft > 0)
                acpi_sleep_run_lps0_dsm(ACPI_LPS0_MS_EXIT,
@@ -520,4 +536,28 @@ void acpi_s2idle_setup(void)
        s2idle_set_ops(&acpi_s2idle_ops_lps0);
 }
 
+int acpi_register_lps0_dev(struct acpi_s2idle_dev_ops *arg)
+{
+       if (!lps0_device_handle || sleep_no_lps0)
+               return -ENODEV;
+
+       lock_system_sleep();
+       list_add(&arg->list_node, &lps0_s2idle_devops_head);
+       unlock_system_sleep();
+
+       return 0;
+}
+EXPORT_SYMBOL_GPL(acpi_register_lps0_dev);
+
+void acpi_unregister_lps0_dev(struct acpi_s2idle_dev_ops *arg)
+{
+       if (!lps0_device_handle || sleep_no_lps0)
+               return;
+
+       lock_system_sleep();
+       list_del(&arg->list_node);
+       unlock_system_sleep();
+}
+EXPORT_SYMBOL_GPL(acpi_unregister_lps0_dev);
+
 #endif /* CONFIG_SUSPEND */