GNU Linux-libre 4.9.283-gnu1
[releases.git] / drivers / thermal / int340x_thermal / int3402_thermal.c
1 /*
2  * INT3402 thermal driver for memory temperature reporting
3  *
4  * Copyright (C) 2014, Intel Corporation
5  * Authors: Aaron Lu <aaron.lu@intel.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  *
11  */
12
13 #include <linux/module.h>
14 #include <linux/platform_device.h>
15 #include <linux/acpi.h>
16 #include <linux/thermal.h>
17 #include "int340x_thermal_zone.h"
18
19 #define INT3402_PERF_CHANGED_EVENT      0x80
20 #define INT3402_THERMAL_EVENT           0x90
21
22 struct int3402_thermal_data {
23         acpi_handle *handle;
24         struct int34x_thermal_zone *int340x_zone;
25 };
26
27 static void int3402_notify(acpi_handle handle, u32 event, void *data)
28 {
29         struct int3402_thermal_data *priv = data;
30
31         if (!priv)
32                 return;
33
34         switch (event) {
35         case INT3402_PERF_CHANGED_EVENT:
36                 break;
37         case INT3402_THERMAL_EVENT:
38                 int340x_thermal_zone_device_update(priv->int340x_zone,
39                                                    THERMAL_TRIP_VIOLATED);
40                 break;
41         default:
42                 break;
43         }
44 }
45
46 static int int3402_thermal_probe(struct platform_device *pdev)
47 {
48         struct acpi_device *adev = ACPI_COMPANION(&pdev->dev);
49         struct int3402_thermal_data *d;
50         int ret;
51
52         if (!acpi_has_method(adev->handle, "_TMP"))
53                 return -ENODEV;
54
55         d = devm_kzalloc(&pdev->dev, sizeof(*d), GFP_KERNEL);
56         if (!d)
57                 return -ENOMEM;
58
59         d->int340x_zone = int340x_thermal_zone_add(adev, NULL);
60         if (IS_ERR(d->int340x_zone))
61                 return PTR_ERR(d->int340x_zone);
62
63         ret = acpi_install_notify_handler(adev->handle,
64                                           ACPI_DEVICE_NOTIFY,
65                                           int3402_notify,
66                                           d);
67         if (ret) {
68                 int340x_thermal_zone_remove(d->int340x_zone);
69                 return ret;
70         }
71
72         d->handle = adev->handle;
73         platform_set_drvdata(pdev, d);
74
75         return 0;
76 }
77
78 static int int3402_thermal_remove(struct platform_device *pdev)
79 {
80         struct int3402_thermal_data *d = platform_get_drvdata(pdev);
81
82         acpi_remove_notify_handler(d->handle,
83                                    ACPI_DEVICE_NOTIFY, int3402_notify);
84         int340x_thermal_zone_remove(d->int340x_zone);
85
86         return 0;
87 }
88
89 static const struct acpi_device_id int3402_thermal_match[] = {
90         {"INT3402", 0},
91         {}
92 };
93
94 MODULE_DEVICE_TABLE(acpi, int3402_thermal_match);
95
96 static struct platform_driver int3402_thermal_driver = {
97         .probe = int3402_thermal_probe,
98         .remove = int3402_thermal_remove,
99         .driver = {
100                    .name = "int3402 thermal",
101                    .acpi_match_table = int3402_thermal_match,
102                    },
103 };
104
105 module_platform_driver(int3402_thermal_driver);
106
107 MODULE_DESCRIPTION("INT3402 Thermal driver");
108 MODULE_LICENSE("GPL");