1
2
3
4
5
6
7
8
9#include <linux/module.h>
10#include <linux/platform_device.h>
11#include <linux/acpi.h>
12#include <linux/backlight.h>
13#include <linux/thermal.h>
14#include <acpi/video.h>
15
16#define INT3406_BRIGHTNESS_LIMITS_CHANGED 0x80
17
18struct int3406_thermal_data {
19 int upper_limit;
20 int lower_limit;
21 acpi_handle handle;
22 struct acpi_video_device_brightness *br;
23 struct backlight_device *raw_bd;
24 struct thermal_cooling_device *cooling_dev;
25};
26
27
28
29
30
31
32
33
34
35
36
37#define ACPI_TO_RAW(v, d) (d->raw_bd->props.max_brightness * v / 100)
38#define RAW_TO_ACPI(v, d) (v * 100 / d->raw_bd->props.max_brightness)
39
40static int
41int3406_thermal_get_max_state(struct thermal_cooling_device *cooling_dev,
42 unsigned long *state)
43{
44 struct int3406_thermal_data *d = cooling_dev->devdata;
45
46 *state = d->upper_limit - d->lower_limit;
47 return 0;
48}
49
50static int
51int3406_thermal_set_cur_state(struct thermal_cooling_device *cooling_dev,
52 unsigned long state)
53{
54 struct int3406_thermal_data *d = cooling_dev->devdata;
55 int acpi_level, raw_level;
56
57 if (state > d->upper_limit - d->lower_limit)
58 return -EINVAL;
59
60 acpi_level = d->br->levels[d->upper_limit - state];
61
62 raw_level = ACPI_TO_RAW(acpi_level, d);
63
64 return backlight_device_set_brightness(d->raw_bd, raw_level);
65}
66
67static int
68int3406_thermal_get_cur_state(struct thermal_cooling_device *cooling_dev,
69 unsigned long *state)
70{
71 struct int3406_thermal_data *d = cooling_dev->devdata;
72 int acpi_level;
73 int index;
74
75 acpi_level = RAW_TO_ACPI(d->raw_bd->props.brightness, d);
76
77
78
79
80
81
82 for (index = d->lower_limit; index < d->upper_limit; index++) {
83 if (acpi_level <= d->br->levels[index])
84 break;
85 }
86
87 *state = d->upper_limit - index;
88 return 0;
89}
90
91static const struct thermal_cooling_device_ops video_cooling_ops = {
92 .get_max_state = int3406_thermal_get_max_state,
93 .get_cur_state = int3406_thermal_get_cur_state,
94 .set_cur_state = int3406_thermal_set_cur_state,
95};
96
97static int int3406_thermal_get_index(int *array, int nr, int value)
98{
99 int i;
100
101 for (i = 2; i < nr; i++) {
102 if (array[i] == value)
103 break;
104 }
105 return i == nr ? -ENOENT : i;
106}
107
108static void int3406_thermal_get_limit(struct int3406_thermal_data *d)
109{
110 acpi_status status;
111 unsigned long long lower_limit, upper_limit;
112
113 status = acpi_evaluate_integer(d->handle, "DDDL", NULL, &lower_limit);
114 if (ACPI_SUCCESS(status))
115 d->lower_limit = int3406_thermal_get_index(d->br->levels,
116 d->br->count, lower_limit);
117
118 status = acpi_evaluate_integer(d->handle, "DDPC", NULL, &upper_limit);
119 if (ACPI_SUCCESS(status))
120 d->upper_limit = int3406_thermal_get_index(d->br->levels,
121 d->br->count, upper_limit);
122
123
124 d->lower_limit = d->lower_limit > 0 ? d->lower_limit : 2;
125 d->upper_limit = d->upper_limit > 0 ? d->upper_limit : d->br->count - 1;
126}
127
128static void int3406_notify(acpi_handle handle, u32 event, void *data)
129{
130 if (event == INT3406_BRIGHTNESS_LIMITS_CHANGED)
131 int3406_thermal_get_limit(data);
132}
133
134static int int3406_thermal_probe(struct platform_device *pdev)
135{
136 struct acpi_device *adev = ACPI_COMPANION(&pdev->dev);
137 struct int3406_thermal_data *d;
138 struct backlight_device *bd;
139 int ret;
140
141 if (!ACPI_HANDLE(&pdev->dev))
142 return -ENODEV;
143
144 d = devm_kzalloc(&pdev->dev, sizeof(*d), GFP_KERNEL);
145 if (!d)
146 return -ENOMEM;
147 d->handle = ACPI_HANDLE(&pdev->dev);
148
149 bd = backlight_device_get_by_type(BACKLIGHT_RAW);
150 if (!bd)
151 return -ENODEV;
152 d->raw_bd = bd;
153
154 ret = acpi_video_get_levels(ACPI_COMPANION(&pdev->dev), &d->br, NULL);
155 if (ret)
156 return ret;
157
158 int3406_thermal_get_limit(d);
159
160 d->cooling_dev = thermal_cooling_device_register(acpi_device_bid(adev),
161 d, &video_cooling_ops);
162 if (IS_ERR(d->cooling_dev))
163 goto err;
164
165 ret = acpi_install_notify_handler(adev->handle, ACPI_DEVICE_NOTIFY,
166 int3406_notify, d);
167 if (ret)
168 goto err_cdev;
169
170 platform_set_drvdata(pdev, d);
171
172 return 0;
173
174err_cdev:
175 thermal_cooling_device_unregister(d->cooling_dev);
176err:
177 kfree(d->br);
178 return -ENODEV;
179}
180
181static int int3406_thermal_remove(struct platform_device *pdev)
182{
183 struct int3406_thermal_data *d = platform_get_drvdata(pdev);
184
185 thermal_cooling_device_unregister(d->cooling_dev);
186 kfree(d->br);
187 return 0;
188}
189
190static const struct acpi_device_id int3406_thermal_match[] = {
191 {"INT3406", 0},
192 {}
193};
194
195MODULE_DEVICE_TABLE(acpi, int3406_thermal_match);
196
197static struct platform_driver int3406_thermal_driver = {
198 .probe = int3406_thermal_probe,
199 .remove = int3406_thermal_remove,
200 .driver = {
201 .name = "int3406 thermal",
202 .acpi_match_table = int3406_thermal_match,
203 },
204};
205
206module_platform_driver(int3406_thermal_driver);
207
208MODULE_DESCRIPTION("INT3406 Thermal driver");
209MODULE_LICENSE("GPL v2");
210