Commit | Line | Data |
---|---|---|
c942fddf | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
aa1acb04 | 2 | /* |
3 | * db8500_thermal.c - DB8500 Thermal Management Implementation | |
4 | * | |
5 | * Copyright (C) 2012 ST-Ericsson | |
6c375ecc | 6 | * Copyright (C) 2012-2019 Linaro Ltd. |
aa1acb04 | 7 | * |
6c375ecc | 8 | * Authors: Hongbo Zhang, Linus Walleij |
aa1acb04 | 9 | */ |
10 | ||
11 | #include <linux/cpu_cooling.h> | |
12 | #include <linux/interrupt.h> | |
13 | #include <linux/mfd/dbx500-prcmu.h> | |
14 | #include <linux/module.h> | |
15 | #include <linux/of.h> | |
aa1acb04 | 16 | #include <linux/platform_device.h> |
17 | #include <linux/slab.h> | |
18 | #include <linux/thermal.h> | |
19 | ||
20 | #define PRCMU_DEFAULT_MEASURE_TIME 0xFFF | |
21 | #define PRCMU_DEFAULT_LOW_TEMP 0 | |
cb063a83 | 22 | |
6c375ecc LW |
23 | /** |
24 | * db8500_thermal_points - the interpolation points that trigger | |
25 | * interrupts | |
26 | */ | |
27 | static const unsigned long db8500_thermal_points[] = { | |
28 | 15000, | |
29 | 20000, | |
30 | 25000, | |
31 | 30000, | |
32 | 35000, | |
33 | 40000, | |
34 | 45000, | |
35 | 50000, | |
36 | 55000, | |
37 | 60000, | |
38 | 65000, | |
39 | 70000, | |
40 | 75000, | |
41 | 80000, | |
42 | /* | |
43 | * This is where things start to get really bad for the | |
44 | * SoC and the thermal zones should be set up to trigger | |
45 | * critical temperature at 85000 mC so we don't get above | |
46 | * this point. | |
47 | */ | |
48 | 85000, | |
49 | 90000, | |
50 | 95000, | |
51 | 100000, | |
cb063a83 | 52 | }; |
aa1acb04 | 53 | |
54 | struct db8500_thermal_zone { | |
6c375ecc | 55 | struct thermal_zone_device *tz; |
aa1acb04 | 56 | enum thermal_trend trend; |
6c375ecc | 57 | unsigned long interpolated_temp; |
aa1acb04 | 58 | unsigned int cur_index; |
59 | }; | |
60 | ||
aa1acb04 | 61 | /* Callback to get current temperature */ |
6c375ecc | 62 | static int db8500_thermal_get_temp(void *data, int *temp) |
aa1acb04 | 63 | { |
6c375ecc | 64 | struct db8500_thermal_zone *th = data; |
aa1acb04 | 65 | |
66 | /* | |
67 | * TODO: There is no PRCMU interface to get temperature data currently, | |
68 | * so a pseudo temperature is returned , it works for thermal framework | |
69 | * and this will be fixed when the PRCMU interface is available. | |
70 | */ | |
6c375ecc | 71 | *temp = th->interpolated_temp; |
aa1acb04 | 72 | |
73 | return 0; | |
74 | } | |
75 | ||
76 | /* Callback to get temperature changing trend */ | |
6c375ecc | 77 | static int db8500_thermal_get_trend(void *data, int trip, enum thermal_trend *trend) |
aa1acb04 | 78 | { |
6c375ecc | 79 | struct db8500_thermal_zone *th = data; |
aa1acb04 | 80 | |
6c375ecc | 81 | *trend = th->trend; |
aa1acb04 | 82 | |
83 | return 0; | |
84 | } | |
85 | ||
6c375ecc LW |
86 | static struct thermal_zone_of_device_ops thdev_ops = { |
87 | .get_temp = db8500_thermal_get_temp, | |
88 | .get_trend = db8500_thermal_get_trend, | |
aa1acb04 | 89 | }; |
90 | ||
6c375ecc LW |
91 | static void db8500_thermal_update_config(struct db8500_thermal_zone *th, |
92 | unsigned int idx, | |
93 | enum thermal_trend trend, | |
94 | unsigned long next_low, | |
95 | unsigned long next_high) | |
aa1acb04 | 96 | { |
97 | prcmu_stop_temp_sense(); | |
98 | ||
6c375ecc LW |
99 | th->cur_index = idx; |
100 | th->interpolated_temp = (next_low + next_high)/2; | |
101 | th->trend = trend; | |
aa1acb04 | 102 | |
6c375ecc LW |
103 | /* |
104 | * The PRCMU accept absolute temperatures in celsius so divide | |
105 | * down the millicelsius with 1000 | |
106 | */ | |
aa1acb04 | 107 | prcmu_config_hotmon((u8)(next_low/1000), (u8)(next_high/1000)); |
108 | prcmu_start_temp_sense(PRCMU_DEFAULT_MEASURE_TIME); | |
109 | } | |
110 | ||
111 | static irqreturn_t prcmu_low_irq_handler(int irq, void *irq_data) | |
112 | { | |
6c375ecc LW |
113 | struct db8500_thermal_zone *th = irq_data; |
114 | unsigned int idx = th->cur_index; | |
aa1acb04 | 115 | unsigned long next_low, next_high; |
116 | ||
6c375ecc | 117 | if (idx == 0) |
aa1acb04 | 118 | /* Meaningless for thermal management, ignoring it */ |
119 | return IRQ_HANDLED; | |
120 | ||
121 | if (idx == 1) { | |
6c375ecc | 122 | next_high = db8500_thermal_points[0]; |
aa1acb04 | 123 | next_low = PRCMU_DEFAULT_LOW_TEMP; |
124 | } else { | |
6c375ecc LW |
125 | next_high = db8500_thermal_points[idx - 1]; |
126 | next_low = db8500_thermal_points[idx - 2]; | |
aa1acb04 | 127 | } |
128 | idx -= 1; | |
129 | ||
6c375ecc LW |
130 | db8500_thermal_update_config(th, idx, THERMAL_TREND_DROPPING, |
131 | next_low, next_high); | |
132 | dev_dbg(&th->tz->device, | |
aa1acb04 | 133 | "PRCMU set max %ld, min %ld\n", next_high, next_low); |
134 | ||
6c375ecc | 135 | thermal_zone_device_update(th->tz, THERMAL_EVENT_UNSPECIFIED); |
aa1acb04 | 136 | |
137 | return IRQ_HANDLED; | |
138 | } | |
139 | ||
140 | static irqreturn_t prcmu_high_irq_handler(int irq, void *irq_data) | |
141 | { | |
6c375ecc LW |
142 | struct db8500_thermal_zone *th = irq_data; |
143 | unsigned int idx = th->cur_index; | |
aa1acb04 | 144 | unsigned long next_low, next_high; |
6c375ecc | 145 | int num_points = ARRAY_SIZE(db8500_thermal_points); |
aa1acb04 | 146 | |
6c375ecc LW |
147 | if (idx < num_points - 1) { |
148 | next_high = db8500_thermal_points[idx+1]; | |
149 | next_low = db8500_thermal_points[idx]; | |
aa1acb04 | 150 | idx += 1; |
151 | ||
6c375ecc LW |
152 | db8500_thermal_update_config(th, idx, THERMAL_TREND_RAISING, |
153 | next_low, next_high); | |
aa1acb04 | 154 | |
c56dcfa3 LW |
155 | dev_dbg(&th->tz->device, |
156 | "PRCMU set max %ld, min %ld\n", next_high, next_low); | |
6c375ecc LW |
157 | } else if (idx == num_points - 1) |
158 | /* So we roof out 1 degree over the max point */ | |
159 | th->interpolated_temp = db8500_thermal_points[idx] + 1; | |
aa1acb04 | 160 | |
6c375ecc | 161 | thermal_zone_device_update(th->tz, THERMAL_EVENT_UNSPECIFIED); |
aa1acb04 | 162 | |
163 | return IRQ_HANDLED; | |
164 | } | |
165 | ||
aa1acb04 | 166 | static int db8500_thermal_probe(struct platform_device *pdev) |
167 | { | |
6c375ecc | 168 | struct db8500_thermal_zone *th = NULL; |
3de9e4df | 169 | struct device *dev = &pdev->dev; |
aa1acb04 | 170 | int low_irq, high_irq, ret = 0; |
aa1acb04 | 171 | |
6c375ecc LW |
172 | th = devm_kzalloc(dev, sizeof(*th), GFP_KERNEL); |
173 | if (!th) | |
aa1acb04 | 174 | return -ENOMEM; |
175 | ||
aa1acb04 | 176 | low_irq = platform_get_irq_byname(pdev, "IRQ_HOTMON_LOW"); |
177 | if (low_irq < 0) { | |
6c375ecc LW |
178 | dev_err(dev, "Get IRQ_HOTMON_LOW failed\n"); |
179 | return low_irq; | |
aa1acb04 | 180 | } |
181 | ||
3de9e4df | 182 | ret = devm_request_threaded_irq(dev, low_irq, NULL, |
aa1acb04 | 183 | prcmu_low_irq_handler, IRQF_NO_SUSPEND | IRQF_ONESHOT, |
6c375ecc | 184 | "dbx500_temp_low", th); |
aa1acb04 | 185 | if (ret < 0) { |
6c375ecc LW |
186 | dev_err(dev, "failed to allocate temp low irq\n"); |
187 | return ret; | |
aa1acb04 | 188 | } |
189 | ||
190 | high_irq = platform_get_irq_byname(pdev, "IRQ_HOTMON_HIGH"); | |
191 | if (high_irq < 0) { | |
6c375ecc LW |
192 | dev_err(dev, "Get IRQ_HOTMON_HIGH failed\n"); |
193 | return high_irq; | |
aa1acb04 | 194 | } |
195 | ||
3de9e4df | 196 | ret = devm_request_threaded_irq(dev, high_irq, NULL, |
aa1acb04 | 197 | prcmu_high_irq_handler, IRQF_NO_SUSPEND | IRQF_ONESHOT, |
6c375ecc | 198 | "dbx500_temp_high", th); |
aa1acb04 | 199 | if (ret < 0) { |
6c375ecc LW |
200 | dev_err(dev, "failed to allocate temp high irq\n"); |
201 | return ret; | |
aa1acb04 | 202 | } |
203 | ||
6c375ecc LW |
204 | /* register of thermal sensor and get info from DT */ |
205 | th->tz = devm_thermal_zone_of_sensor_register(dev, 0, th, &thdev_ops); | |
206 | if (IS_ERR(th->tz)) { | |
207 | dev_err(dev, "register thermal zone sensor failed\n"); | |
208 | return PTR_ERR(th->tz); | |
aa1acb04 | 209 | } |
6c375ecc | 210 | dev_info(dev, "thermal zone sensor registered\n"); |
aa1acb04 | 211 | |
6c375ecc LW |
212 | /* Start measuring at the lowest point */ |
213 | db8500_thermal_update_config(th, 0, THERMAL_TREND_STABLE, | |
214 | PRCMU_DEFAULT_LOW_TEMP, | |
215 | db8500_thermal_points[0]); | |
aa1acb04 | 216 | |
6c375ecc | 217 | platform_set_drvdata(pdev, th); |
aa1acb04 | 218 | |
219 | return 0; | |
220 | } | |
221 | ||
222 | static int db8500_thermal_suspend(struct platform_device *pdev, | |
223 | pm_message_t state) | |
224 | { | |
aa1acb04 | 225 | prcmu_stop_temp_sense(); |
226 | ||
227 | return 0; | |
228 | } | |
229 | ||
230 | static int db8500_thermal_resume(struct platform_device *pdev) | |
231 | { | |
6c375ecc | 232 | struct db8500_thermal_zone *th = platform_get_drvdata(pdev); |
aa1acb04 | 233 | |
6c375ecc LW |
234 | /* Resume and start measuring at the lowest point */ |
235 | db8500_thermal_update_config(th, 0, THERMAL_TREND_STABLE, | |
236 | PRCMU_DEFAULT_LOW_TEMP, | |
237 | db8500_thermal_points[0]); | |
aa1acb04 | 238 | |
239 | return 0; | |
240 | } | |
241 | ||
aa1acb04 | 242 | static const struct of_device_id db8500_thermal_match[] = { |
243 | { .compatible = "stericsson,db8500-thermal" }, | |
244 | {}, | |
245 | }; | |
8093a116 | 246 | MODULE_DEVICE_TABLE(of, db8500_thermal_match); |
aa1acb04 | 247 | |
248 | static struct platform_driver db8500_thermal_driver = { | |
249 | .driver = { | |
aa1acb04 | 250 | .name = "db8500-thermal", |
c3136376 | 251 | .of_match_table = of_match_ptr(db8500_thermal_match), |
aa1acb04 | 252 | }, |
253 | .probe = db8500_thermal_probe, | |
254 | .suspend = db8500_thermal_suspend, | |
255 | .resume = db8500_thermal_resume, | |
aa1acb04 | 256 | }; |
257 | ||
258 | module_platform_driver(db8500_thermal_driver); | |
259 | ||
260 | MODULE_AUTHOR("Hongbo Zhang <hongbo.zhang@stericsson.com>"); | |
261 | MODULE_DESCRIPTION("DB8500 thermal driver"); | |
262 | MODULE_LICENSE("GPL"); |