9a5238a9 |
1 | /* |
2 | * Hisilicon thermal sensor driver |
3 | * |
4 | * Copyright (c) 2014-2015 Hisilicon Limited. |
5 | * Copyright (c) 2014-2015 Linaro Limited. |
6 | * |
7 | * Xinwei Kong <kong.kongxinwei@hisilicon.com> |
8 | * Leo Yan <leo.yan@linaro.org> |
9 | * |
10 | * This program is free software; you can redistribute it and/or modify |
11 | * it under the terms of the GNU General Public License version 2 as |
12 | * published by the Free Software Foundation. |
13 | * |
14 | * This program is distributed "as is" WITHOUT ANY WARRANTY of any |
15 | * kind, whether express or implied; without even the implied warranty |
16 | * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
17 | * GNU General Public License for more details. |
18 | */ |
19 | |
20 | #include <linux/cpufreq.h> |
21 | #include <linux/delay.h> |
22 | #include <linux/interrupt.h> |
23 | #include <linux/module.h> |
24 | #include <linux/platform_device.h> |
25 | #include <linux/io.h> |
26 | |
27 | #include "thermal_core.h" |
28 | |
29 | #define TEMP0_TH (0x4) |
30 | #define TEMP0_RST_TH (0x8) |
31 | #define TEMP0_CFG (0xC) |
32 | #define TEMP0_EN (0x10) |
33 | #define TEMP0_INT_EN (0x14) |
34 | #define TEMP0_INT_CLR (0x18) |
35 | #define TEMP0_RST_MSK (0x1C) |
36 | #define TEMP0_VALUE (0x28) |
37 | |
38 | #define HISI_TEMP_BASE (-60) |
39 | #define HISI_TEMP_RESET (100000) |
40 | |
41 | #define HISI_MAX_SENSORS 4 |
42 | |
43 | struct hisi_thermal_sensor { |
44 | struct hisi_thermal_data *thermal; |
45 | struct thermal_zone_device *tzd; |
46 | |
47 | long sensor_temp; |
48 | uint32_t id; |
49 | uint32_t thres_temp; |
50 | }; |
51 | |
52 | struct hisi_thermal_data { |
53 | struct mutex thermal_lock; /* protects register data */ |
54 | struct platform_device *pdev; |
55 | struct clk *clk; |
56 | struct hisi_thermal_sensor sensors[HISI_MAX_SENSORS]; |
57 | |
58 | int irq, irq_bind_sensor; |
59 | bool irq_enabled; |
60 | |
61 | void __iomem *regs; |
62 | }; |
63 | |
64 | /* in millicelsius */ |
65 | static inline int _step_to_temp(int step) |
66 | { |
67 | /* |
68 | * Every step equals (1 * 200) / 255 celsius, and finally |
69 | * need convert to millicelsius. |
70 | */ |
71 | return (HISI_TEMP_BASE + (step * 200 / 255)) * 1000; |
72 | } |
73 | |
74 | static inline long _temp_to_step(long temp) |
75 | { |
76 | return ((temp / 1000 - HISI_TEMP_BASE) * 255 / 200); |
77 | } |
78 | |
79 | static long hisi_thermal_get_sensor_temp(struct hisi_thermal_data *data, |
80 | struct hisi_thermal_sensor *sensor) |
81 | { |
82 | long val; |
83 | |
84 | mutex_lock(&data->thermal_lock); |
85 | |
86 | /* disable interrupt */ |
87 | writel(0x0, data->regs + TEMP0_INT_EN); |
88 | writel(0x1, data->regs + TEMP0_INT_CLR); |
89 | |
90 | /* disable module firstly */ |
91 | writel(0x0, data->regs + TEMP0_EN); |
92 | |
93 | /* select sensor id */ |
94 | writel((sensor->id << 12), data->regs + TEMP0_CFG); |
95 | |
96 | /* enable module */ |
97 | writel(0x1, data->regs + TEMP0_EN); |
98 | |
99 | usleep_range(3000, 5000); |
100 | |
101 | val = readl(data->regs + TEMP0_VALUE); |
102 | val = _step_to_temp(val); |
103 | |
104 | mutex_unlock(&data->thermal_lock); |
105 | |
106 | return val; |
107 | } |
108 | |
109 | static void hisi_thermal_enable_bind_irq_sensor |
110 | (struct hisi_thermal_data *data) |
111 | { |
112 | struct hisi_thermal_sensor *sensor; |
113 | |
114 | mutex_lock(&data->thermal_lock); |
115 | |
116 | sensor = &data->sensors[data->irq_bind_sensor]; |
117 | |
118 | /* setting the hdak time */ |
119 | writel(0x0, data->regs + TEMP0_CFG); |
120 | |
121 | /* disable module firstly */ |
122 | writel(0x0, data->regs + TEMP0_RST_MSK); |
123 | writel(0x0, data->regs + TEMP0_EN); |
124 | |
125 | /* select sensor id */ |
126 | writel((sensor->id << 12), data->regs + TEMP0_CFG); |
127 | |
128 | /* enable for interrupt */ |
129 | writel(_temp_to_step(sensor->thres_temp) | 0x0FFFFFF00, |
130 | data->regs + TEMP0_TH); |
131 | |
132 | writel(_temp_to_step(HISI_TEMP_RESET), data->regs + TEMP0_RST_TH); |
133 | |
134 | /* enable module */ |
135 | writel(0x1, data->regs + TEMP0_RST_MSK); |
136 | writel(0x1, data->regs + TEMP0_EN); |
137 | |
138 | writel(0x0, data->regs + TEMP0_INT_CLR); |
139 | writel(0x1, data->regs + TEMP0_INT_EN); |
140 | |
141 | usleep_range(3000, 5000); |
142 | |
143 | mutex_unlock(&data->thermal_lock); |
144 | } |
145 | |
146 | static void hisi_thermal_disable_sensor(struct hisi_thermal_data *data) |
147 | { |
148 | mutex_lock(&data->thermal_lock); |
149 | |
150 | /* disable sensor module */ |
151 | writel(0x0, data->regs + TEMP0_INT_EN); |
152 | writel(0x0, data->regs + TEMP0_RST_MSK); |
153 | writel(0x0, data->regs + TEMP0_EN); |
154 | |
155 | mutex_unlock(&data->thermal_lock); |
156 | } |
157 | |
17e8351a |
158 | static int hisi_thermal_get_temp(void *_sensor, int *temp) |
9a5238a9 |
159 | { |
160 | struct hisi_thermal_sensor *sensor = _sensor; |
161 | struct hisi_thermal_data *data = sensor->thermal; |
162 | |
163 | int sensor_id = 0, i; |
164 | long max_temp = 0; |
165 | |
166 | *temp = hisi_thermal_get_sensor_temp(data, sensor); |
167 | |
168 | sensor->sensor_temp = *temp; |
169 | |
170 | for (i = 0; i < HISI_MAX_SENSORS; i++) { |
171 | if (data->sensors[i].sensor_temp >= max_temp) { |
172 | max_temp = data->sensors[i].sensor_temp; |
173 | sensor_id = i; |
174 | } |
175 | } |
176 | |
177 | mutex_lock(&data->thermal_lock); |
178 | data->irq_bind_sensor = sensor_id; |
179 | mutex_unlock(&data->thermal_lock); |
180 | |
17e8351a |
181 | dev_dbg(&data->pdev->dev, "id=%d, irq=%d, temp=%d, thres=%d\n", |
9a5238a9 |
182 | sensor->id, data->irq_enabled, *temp, sensor->thres_temp); |
183 | /* |
184 | * Bind irq to sensor for two cases: |
185 | * Reenable alarm IRQ if temperature below threshold; |
186 | * if irq has been enabled, always set it; |
187 | */ |
188 | if (data->irq_enabled) { |
189 | hisi_thermal_enable_bind_irq_sensor(data); |
190 | return 0; |
191 | } |
192 | |
193 | if (max_temp < sensor->thres_temp) { |
194 | data->irq_enabled = true; |
195 | hisi_thermal_enable_bind_irq_sensor(data); |
196 | enable_irq(data->irq); |
197 | } |
198 | |
199 | return 0; |
200 | } |
201 | |
202 | static struct thermal_zone_of_device_ops hisi_of_thermal_ops = { |
203 | .get_temp = hisi_thermal_get_temp, |
204 | }; |
205 | |
206 | static irqreturn_t hisi_thermal_alarm_irq(int irq, void *dev) |
207 | { |
208 | struct hisi_thermal_data *data = dev; |
209 | |
210 | disable_irq_nosync(irq); |
211 | data->irq_enabled = false; |
212 | |
213 | return IRQ_WAKE_THREAD; |
214 | } |
215 | |
216 | static irqreturn_t hisi_thermal_alarm_irq_thread(int irq, void *dev) |
217 | { |
218 | struct hisi_thermal_data *data = dev; |
219 | struct hisi_thermal_sensor *sensor; |
220 | int i; |
221 | |
222 | mutex_lock(&data->thermal_lock); |
223 | sensor = &data->sensors[data->irq_bind_sensor]; |
224 | |
225 | dev_crit(&data->pdev->dev, "THERMAL ALARM: T > %d\n", |
226 | sensor->thres_temp / 1000); |
227 | mutex_unlock(&data->thermal_lock); |
228 | |
229 | for (i = 0; i < HISI_MAX_SENSORS; i++) |
230 | thermal_zone_device_update(data->sensors[i].tzd); |
231 | |
232 | return IRQ_HANDLED; |
233 | } |
234 | |
235 | static int hisi_thermal_register_sensor(struct platform_device *pdev, |
236 | struct hisi_thermal_data *data, |
237 | struct hisi_thermal_sensor *sensor, |
238 | int index) |
239 | { |
240 | int ret, i; |
241 | const struct thermal_trip *trip; |
242 | |
243 | sensor->id = index; |
244 | sensor->thermal = data; |
245 | |
246 | sensor->tzd = thermal_zone_of_sensor_register(&pdev->dev, sensor->id, |
247 | sensor, &hisi_of_thermal_ops); |
248 | if (IS_ERR(sensor->tzd)) { |
249 | ret = PTR_ERR(sensor->tzd); |
250 | dev_err(&pdev->dev, "failed to register sensor id %d: %d\n", |
251 | sensor->id, ret); |
252 | return ret; |
253 | } |
254 | |
255 | trip = of_thermal_get_trip_points(sensor->tzd); |
256 | |
257 | for (i = 0; i < of_thermal_get_ntrips(sensor->tzd); i++) { |
258 | if (trip[i].type == THERMAL_TRIP_PASSIVE) { |
259 | sensor->thres_temp = trip[i].temperature; |
260 | break; |
261 | } |
262 | } |
263 | |
264 | return 0; |
265 | } |
266 | |
267 | static const struct of_device_id of_hisi_thermal_match[] = { |
268 | { .compatible = "hisilicon,tsensor" }, |
269 | { /* end */ } |
270 | }; |
271 | MODULE_DEVICE_TABLE(of, of_hisi_thermal_match); |
272 | |
273 | static void hisi_thermal_toggle_sensor(struct hisi_thermal_sensor *sensor, |
274 | bool on) |
275 | { |
276 | struct thermal_zone_device *tzd = sensor->tzd; |
277 | |
278 | tzd->ops->set_mode(tzd, |
279 | on ? THERMAL_DEVICE_ENABLED : THERMAL_DEVICE_DISABLED); |
280 | } |
281 | |
282 | static int hisi_thermal_probe(struct platform_device *pdev) |
283 | { |
284 | struct hisi_thermal_data *data; |
285 | struct resource *res; |
286 | int i; |
287 | int ret; |
288 | |
289 | data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); |
290 | if (!data) |
291 | return -ENOMEM; |
292 | |
293 | mutex_init(&data->thermal_lock); |
294 | data->pdev = pdev; |
295 | |
296 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
297 | data->regs = devm_ioremap_resource(&pdev->dev, res); |
298 | if (IS_ERR(data->regs)) { |
299 | dev_err(&pdev->dev, "failed to get io address\n"); |
300 | return PTR_ERR(data->regs); |
301 | } |
302 | |
303 | data->irq = platform_get_irq(pdev, 0); |
304 | if (data->irq < 0) |
305 | return data->irq; |
306 | |
307 | ret = devm_request_threaded_irq(&pdev->dev, data->irq, |
308 | hisi_thermal_alarm_irq, |
309 | hisi_thermal_alarm_irq_thread, |
310 | 0, "hisi_thermal", data); |
311 | if (ret < 0) { |
312 | dev_err(&pdev->dev, "failed to request alarm irq: %d\n", ret); |
313 | return ret; |
314 | } |
315 | |
316 | platform_set_drvdata(pdev, data); |
317 | |
318 | data->clk = devm_clk_get(&pdev->dev, "thermal_clk"); |
319 | if (IS_ERR(data->clk)) { |
320 | ret = PTR_ERR(data->clk); |
321 | if (ret != -EPROBE_DEFER) |
322 | dev_err(&pdev->dev, |
323 | "failed to get thermal clk: %d\n", ret); |
324 | return ret; |
325 | } |
326 | |
327 | /* enable clock for thermal */ |
328 | ret = clk_prepare_enable(data->clk); |
329 | if (ret) { |
330 | dev_err(&pdev->dev, "failed to enable thermal clk: %d\n", ret); |
331 | return ret; |
332 | } |
333 | |
334 | for (i = 0; i < HISI_MAX_SENSORS; ++i) { |
335 | ret = hisi_thermal_register_sensor(pdev, data, |
336 | &data->sensors[i], i); |
337 | if (ret) { |
338 | dev_err(&pdev->dev, |
339 | "failed to register thermal sensor: %d\n", ret); |
340 | goto err_get_sensor_data; |
341 | } |
342 | } |
343 | |
344 | hisi_thermal_enable_bind_irq_sensor(data); |
345 | data->irq_enabled = true; |
346 | |
347 | for (i = 0; i < HISI_MAX_SENSORS; i++) |
348 | hisi_thermal_toggle_sensor(&data->sensors[i], true); |
349 | |
350 | return 0; |
351 | |
352 | err_get_sensor_data: |
353 | clk_disable_unprepare(data->clk); |
354 | |
355 | return ret; |
356 | } |
357 | |
358 | static int hisi_thermal_remove(struct platform_device *pdev) |
359 | { |
360 | struct hisi_thermal_data *data = platform_get_drvdata(pdev); |
361 | int i; |
362 | |
363 | for (i = 0; i < HISI_MAX_SENSORS; i++) { |
364 | struct hisi_thermal_sensor *sensor = &data->sensors[i]; |
365 | |
366 | hisi_thermal_toggle_sensor(sensor, false); |
367 | thermal_zone_of_sensor_unregister(&pdev->dev, sensor->tzd); |
368 | } |
369 | |
370 | hisi_thermal_disable_sensor(data); |
371 | clk_disable_unprepare(data->clk); |
372 | |
373 | return 0; |
374 | } |
375 | |
376 | #ifdef CONFIG_PM_SLEEP |
377 | static int hisi_thermal_suspend(struct device *dev) |
378 | { |
379 | struct hisi_thermal_data *data = dev_get_drvdata(dev); |
380 | |
381 | hisi_thermal_disable_sensor(data); |
382 | data->irq_enabled = false; |
383 | |
384 | clk_disable_unprepare(data->clk); |
385 | |
386 | return 0; |
387 | } |
388 | |
389 | static int hisi_thermal_resume(struct device *dev) |
390 | { |
391 | struct hisi_thermal_data *data = dev_get_drvdata(dev); |
392 | |
393 | clk_prepare_enable(data->clk); |
394 | |
395 | data->irq_enabled = true; |
396 | hisi_thermal_enable_bind_irq_sensor(data); |
397 | |
398 | return 0; |
399 | } |
400 | #endif |
401 | |
402 | static SIMPLE_DEV_PM_OPS(hisi_thermal_pm_ops, |
403 | hisi_thermal_suspend, hisi_thermal_resume); |
404 | |
405 | static struct platform_driver hisi_thermal_driver = { |
406 | .driver = { |
407 | .name = "hisi_thermal", |
9a5238a9 |
408 | .pm = &hisi_thermal_pm_ops, |
409 | .of_match_table = of_hisi_thermal_match, |
410 | }, |
411 | .probe = hisi_thermal_probe, |
412 | .remove = hisi_thermal_remove, |
413 | }; |
414 | |
415 | module_platform_driver(hisi_thermal_driver); |
416 | |
417 | MODULE_AUTHOR("Xinwei Kong <kong.kongxinwei@hisilicon.com>"); |
418 | MODULE_AUTHOR("Leo Yan <leo.yan@linaro.org>"); |
419 | MODULE_DESCRIPTION("Hisilicon thermal driver"); |
420 | MODULE_LICENSE("GPL v2"); |