From acebf7eea449f8e18f443804f1f20bc090f22d0a Mon Sep 17 00:00:00 2001 From: Srinivas Pandruvada Date: Tue, 23 Dec 2014 15:29:57 -0800 Subject: [PATCH] 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 Signed-off-by: Zhang Rui --- .../thermal/int340x_thermal/int3402_thermal.c | 33 +++++++++++++++++++ 1 file changed, 33 insertions(+) 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 #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;