Thermal/int340x/int3402: Provide notification support

This driver supports programmable trips, but didn't register
notification handler to receive threshold violation notification.

Signed-off-by: Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com>
Signed-off-by: Zhang Rui <rui.zhang@intel.com>

1 files changed, 33 insertions, 0 deletions

diff --git a/drivers/thermal/int340x_thermal/int3402_thermal.c b/drivers/thermal/int340x_thermal/int3402_thermal.c
index 7ffc749ce0f2..69df3d960303 100644
--- a/drivers/thermal/int340x_thermal/int3402_thermal.c
+++ b/drivers/thermal/int340x_thermal/int3402_thermal.c
@@ -16,15 +16,37 @@
 #include <linux/thermal.h>
 #include "int340x_thermal_zone.h"
 
+#define INT3402_PERF_CHANGED_EVENT      0x80
+#define INT3402_THERMAL_EVENT           0x90
+
 struct int3402_thermal_data {
         acpi_handle *handle;
         struct int34x_thermal_zone *int340x_zone;
 };
 
+static void int3402_notify(acpi_handle handle, u32 event, void *data)
+{
+        struct int3402_thermal_data *priv = data;
+
+        if (!priv)
+                return;
+
+        switch (event) {
+        case INT3402_PERF_CHANGED_EVENT:
+                break;
+        case INT3402_THERMAL_EVENT:
+                int340x_thermal_zone_device_update(priv->int340x_zone);
+                break;
+        default:
+                break;
+        }
+}
+
 static int int3402_thermal_probe(struct platform_device *pdev)
 {
         struct acpi_device *adev = ACPI_COMPANION(&pdev->dev);
         struct int3402_thermal_data *d;
+        int ret;
 
         if (!acpi_has_method(adev->handle, "_TMP"))
                 return -ENODEV;
@@ -37,6 +59,15 @@ static int int3402_thermal_probe(struct platform_device *pdev)
         if (IS_ERR(d->int340x_zone))
                 return PTR_ERR(d->int340x_zone);
 
+        ret = acpi_install_notify_handler(adev->handle,
+                                          ACPI_DEVICE_NOTIFY,
+                                          int3402_notify,
+                                          d);
+        if (ret) {
+                int340x_thermal_zone_remove(d->int340x_zone);
+                return ret;
+        }
+
         d->handle = adev->handle;
         platform_set_drvdata(pdev, d);
 
@@ -47,6 +78,8 @@ static int int3402_thermal_remove(struct platform_device *pdev)
 {
         struct int3402_thermal_data *d = platform_get_drvdata(pdev);
 
+        acpi_remove_notify_handler(d->handle,
+                                   ACPI_DEVICE_NOTIFY, int3402_notify);
         int340x_thermal_zone_remove(d->int340x_zone);
 
         return 0;