1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (c) 2015, The Linux Foundation. All rights reserved.
4 */
5
6 #include <linux/bitfield.h>
7 #include <linux/nvmem-consumer.h>
8 #include <linux/platform_device.h>
9 #include "tsens.h"
10
11 /* ----- SROT ------ */
12 #define SROT_CTRL_OFF 0x0000
13
14 /* ----- TM ------ */
15 #define TM_INT_EN_OFF 0x0000
16 #define TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF 0x0004
17 #define TM_Sn_STATUS_OFF 0x0030
18 #define TM_TRDY_OFF 0x005c
19
20 /* extra data for 8974 */
21 #define BKP_SEL 0x3
22 #define BKP_REDUN_SEL 0xe0000000
23
24 #define BIT_APPEND 0x3
25
26 static struct tsens_legacy_calibration_format tsens_8916_nvmem = {
27 .base_len = 7,
28 .base_shift = 3,
29 .sp_len = 5,
30 .mode = { 0, 29, 1 },
31 .invalid = { 0, 31, 1 },
32 .base = { { 0, 0 }, { 1, 25 } },
33 .sp = {
34 { { 0, 7 }, { 0, 12 } },
35 { { 0, 17 }, { 0, 22 } },
36 { { 0, 27 }, { 1, 0 } },
37 { { 1, 5 }, { 1, 10 } },
38 { { 1, 15 }, { 1, 20 } },
39 },
40 };
41
42 static struct tsens_legacy_calibration_format tsens_8974_nvmem = {
43 .base_len = 8,
44 .base_shift = 2,
45 .sp_len = 6,
46 .mode = { 1, 30 },
47 .invalid = { 3, 30 },
48 .base = { { 0, 0 }, { 2, 12 } },
49 .sp = {
50 { { 0, 8 }, { 2, 20 } },
51 { { 0, 14 }, { 2, 26 } },
52 { { 0, 20 }, { 3, 0 } },
53 { { 0, 26 }, { 3, 6 } },
54 { { 1, 0 }, { 3, 12 } },
55 { { 1, 6 }, { 3, 18 } },
56 { { 1, 12 }, { 3, 24 } },
57 { { 1, 18 }, { 4, 0 } },
58 { { 1, 24 }, { 4, 6 } },
59 { { 2, 0 }, { 4, 12 } },
60 { { 2, 6 }, { 4, 18 } },
61 },
62 };
63
64 static struct tsens_legacy_calibration_format tsens_8974_backup_nvmem = {
65 .base_len = 8,
66 .base_shift = 2,
67 .sp_len = 6,
68 .mode = { 4, 30, 1 },
69 .invalid = { 5, 30, 1 },
70 .base = { { 0, 0 }, { 2, 18 } },
71 .sp = {
72 { { 0, 8 }, { 2, 26 } },
73 { { 0, 14 }, { 3, 0 } },
74 { { 0, 20 }, { 3, 6 } },
75 { { 0, 26 }, { 3, 12 } },
76 { { 1, 0 }, { 3, 18 } },
77 { { 1, 6 }, { 3, 24, 1 } },
78 { { 1, 12 }, { 4, 0, 1 } },
79 { { 1, 18 }, { 4, 6, 1 } },
80 { { 2, 0 }, { 4, 12, 1 } },
81 { { 2, 6 }, { 4, 18, 1 } },
82 { { 2, 12 }, { 4, 24, 1 } },
83 },
84 };
85
calibrate_8916(struct tsens_priv * priv)86 static int calibrate_8916(struct tsens_priv *priv)
87 {
88 u32 p1[5], p2[5];
89 u32 *qfprom_cdata, *qfprom_csel;
90 int mode, ret;
91
92 ret = tsens_calibrate_nvmem(priv, 3);
93 if (!ret)
94 return 0;
95
96 qfprom_cdata = (u32 *)qfprom_read(priv->dev, "calib");
97 if (IS_ERR(qfprom_cdata))
98 return PTR_ERR(qfprom_cdata);
99
100 qfprom_csel = (u32 *)qfprom_read(priv->dev, "calib_sel");
101 if (IS_ERR(qfprom_csel)) {
102 kfree(qfprom_cdata);
103 return PTR_ERR(qfprom_csel);
104 }
105
106 mode = tsens_read_calibration_legacy(priv, &tsens_8916_nvmem,
107 p1, p2,
108 qfprom_cdata, qfprom_csel);
109
110 compute_intercept_slope(priv, p1, p2, mode);
111 kfree(qfprom_cdata);
112 kfree(qfprom_csel);
113
114 return 0;
115 }
116
fixup_8974_points(int mode,u32 * p1,u32 * p2)117 static void fixup_8974_points(int mode, u32 *p1, u32 *p2)
118 {
119 int i;
120
121 if (mode == NO_PT_CALIB) {
122 p1[0] += 2;
123 p1[1] += 9;
124 p1[2] += 3;
125 p1[3] += 9;
126 p1[4] += 5;
127 p1[5] += 9;
128 p1[6] += 7;
129 p1[7] += 10;
130 p1[8] += 8;
131 p1[9] += 9;
132 p1[10] += 8;
133 } else {
134 for (i = 0; i < 11; i++) {
135 /*
136 * ONE_PT_CALIB requires using addition here instead of
137 * using OR operation.
138 */
139 p1[i] += BIT_APPEND;
140 p2[i] += BIT_APPEND;
141 }
142 }
143
144 }
145
calibrate_8974_nvmem(struct tsens_priv * priv)146 static int calibrate_8974_nvmem(struct tsens_priv *priv)
147 {
148 u32 p1[11], p2[11];
149 u32 backup;
150 int ret, mode;
151
152 ret = nvmem_cell_read_variable_le_u32(priv->dev, "use_backup", &backup);
153 if (ret == -ENOENT)
154 dev_warn(priv->dev, "Please migrate to separate nvmem cells for calibration data\n");
155 if (ret < 0)
156 return ret;
157
158 mode = tsens_read_calibration(priv, 2, p1, p2, backup == BKP_SEL);
159 if (mode < 0)
160 return mode;
161
162 fixup_8974_points(mode, p1, p2);
163
164 compute_intercept_slope(priv, p1, p2, mode);
165
166 return 0;
167 }
168
calibrate_8974(struct tsens_priv * priv)169 static int calibrate_8974(struct tsens_priv *priv)
170 {
171 u32 p1[11], p2[11];
172 u32 *calib, *bkp;
173 u32 calib_redun_sel;
174 int mode, ret;
175
176 ret = calibrate_8974_nvmem(priv);
177 if (ret == 0)
178 return 0;
179
180 calib = (u32 *)qfprom_read(priv->dev, "calib");
181 if (IS_ERR(calib))
182 return PTR_ERR(calib);
183
184 bkp = (u32 *)qfprom_read(priv->dev, "calib_backup");
185 if (IS_ERR(bkp)) {
186 kfree(calib);
187 return PTR_ERR(bkp);
188 }
189
190 calib_redun_sel = FIELD_GET(BKP_REDUN_SEL, bkp[1]);
191
192 if (calib_redun_sel == BKP_SEL)
193 mode = tsens_read_calibration_legacy(priv, &tsens_8974_backup_nvmem,
194 p1, p2,
195 bkp, calib);
196 else
197 mode = tsens_read_calibration_legacy(priv, &tsens_8974_nvmem,
198 p1, p2,
199 calib, NULL);
200
201 fixup_8974_points(mode, p1, p2);
202
203 compute_intercept_slope(priv, p1, p2, mode);
204 kfree(calib);
205 kfree(bkp);
206
207 return 0;
208 }
209
init_8226(struct tsens_priv * priv)210 static int __init init_8226(struct tsens_priv *priv)
211 {
212 priv->sensor[0].slope = 2901;
213 priv->sensor[1].slope = 2846;
214 priv->sensor[2].slope = 3038;
215 priv->sensor[3].slope = 2955;
216 priv->sensor[4].slope = 2901;
217 priv->sensor[5].slope = 2846;
218
219 return init_common(priv);
220 }
221
init_8909(struct tsens_priv * priv)222 static int __init init_8909(struct tsens_priv *priv)
223 {
224 int i;
225
226 for (i = 0; i < priv->num_sensors; ++i)
227 priv->sensor[i].slope = 3000;
228
229 priv->sensor[0].p1_calib_offset = 0;
230 priv->sensor[0].p2_calib_offset = 0;
231 priv->sensor[1].p1_calib_offset = -10;
232 priv->sensor[1].p2_calib_offset = -6;
233 priv->sensor[2].p1_calib_offset = 0;
234 priv->sensor[2].p2_calib_offset = 0;
235 priv->sensor[3].p1_calib_offset = -9;
236 priv->sensor[3].p2_calib_offset = -9;
237 priv->sensor[4].p1_calib_offset = -8;
238 priv->sensor[4].p2_calib_offset = -10;
239
240 return init_common(priv);
241 }
242
init_8939(struct tsens_priv * priv)243 static int __init init_8939(struct tsens_priv *priv) {
244 priv->sensor[0].slope = 2911;
245 priv->sensor[1].slope = 2789;
246 priv->sensor[2].slope = 2906;
247 priv->sensor[3].slope = 2763;
248 priv->sensor[4].slope = 2922;
249 priv->sensor[5].slope = 2867;
250 priv->sensor[6].slope = 2833;
251 priv->sensor[7].slope = 2838;
252 priv->sensor[8].slope = 2840;
253 /* priv->sensor[9].slope = 2852; */
254
255 return init_common(priv);
256 }
257
init_9607(struct tsens_priv * priv)258 static int __init init_9607(struct tsens_priv *priv)
259 {
260 int i;
261
262 for (i = 0; i < priv->num_sensors; ++i)
263 priv->sensor[i].slope = 3000;
264
265 priv->sensor[0].p1_calib_offset = 1;
266 priv->sensor[0].p2_calib_offset = 1;
267 priv->sensor[1].p1_calib_offset = -4;
268 priv->sensor[1].p2_calib_offset = -2;
269 priv->sensor[2].p1_calib_offset = 4;
270 priv->sensor[2].p2_calib_offset = 8;
271 priv->sensor[3].p1_calib_offset = -3;
272 priv->sensor[3].p2_calib_offset = -5;
273 priv->sensor[4].p1_calib_offset = -4;
274 priv->sensor[4].p2_calib_offset = -4;
275
276 return init_common(priv);
277 }
278
279 /* v0.1: 8226, 8909, 8916, 8939, 8974, 9607 */
280
281 static struct tsens_features tsens_v0_1_feat = {
282 .ver_major = VER_0_1,
283 .crit_int = 0,
284 .combo_int = 0,
285 .adc = 1,
286 .srot_split = 1,
287 .max_sensors = 11,
288 .trip_min_temp = -40000,
289 .trip_max_temp = 120000,
290 };
291
292 static const struct reg_field tsens_v0_1_regfields[MAX_REGFIELDS] = {
293 /* ----- SROT ------ */
294 /* No VERSION information */
295
296 /* CTRL_OFFSET */
297 [TSENS_EN] = REG_FIELD(SROT_CTRL_OFF, 0, 0),
298 [TSENS_SW_RST] = REG_FIELD(SROT_CTRL_OFF, 1, 1),
299
300 /* ----- TM ------ */
301 /* INTERRUPT ENABLE */
302 [INT_EN] = REG_FIELD(TM_INT_EN_OFF, 0, 0),
303
304 /* UPPER/LOWER TEMPERATURE THRESHOLDS */
305 REG_FIELD_FOR_EACH_SENSOR11(LOW_THRESH, TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF, 0, 9),
306 REG_FIELD_FOR_EACH_SENSOR11(UP_THRESH, TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF, 10, 19),
307
308 /* UPPER/LOWER INTERRUPTS [CLEAR/STATUS] */
309 REG_FIELD_FOR_EACH_SENSOR11(LOW_INT_CLEAR, TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF, 20, 20),
310 REG_FIELD_FOR_EACH_SENSOR11(UP_INT_CLEAR, TM_Sn_UPPER_LOWER_STATUS_CTRL_OFF, 21, 21),
311
312 /* NO CRITICAL INTERRUPT SUPPORT on v0.1 */
313
314 /* Sn_STATUS */
315 REG_FIELD_FOR_EACH_SENSOR11(LAST_TEMP, TM_Sn_STATUS_OFF, 0, 9),
316 /* No VALID field on v0.1 */
317 /* xxx_STATUS bits: 1 == threshold violated */
318 REG_FIELD_FOR_EACH_SENSOR11(MIN_STATUS, TM_Sn_STATUS_OFF, 10, 10),
319 REG_FIELD_FOR_EACH_SENSOR11(LOWER_STATUS, TM_Sn_STATUS_OFF, 11, 11),
320 REG_FIELD_FOR_EACH_SENSOR11(UPPER_STATUS, TM_Sn_STATUS_OFF, 12, 12),
321 /* No CRITICAL field on v0.1 */
322 REG_FIELD_FOR_EACH_SENSOR11(MAX_STATUS, TM_Sn_STATUS_OFF, 13, 13),
323
324 /* TRDY: 1=ready, 0=in progress */
325 [TRDY] = REG_FIELD(TM_TRDY_OFF, 0, 0),
326 };
327
328 static const struct tsens_ops ops_8226 = {
329 .init = init_8226,
330 .calibrate = tsens_calibrate_common,
331 .get_temp = get_temp_common,
332 };
333
334 struct tsens_plat_data data_8226 = {
335 .num_sensors = 6,
336 .ops = &ops_8226,
337 .feat = &tsens_v0_1_feat,
338 .fields = tsens_v0_1_regfields,
339 };
340
341 static const struct tsens_ops ops_8909 = {
342 .init = init_8909,
343 .calibrate = tsens_calibrate_common,
344 .get_temp = get_temp_common,
345 };
346
347 struct tsens_plat_data data_8909 = {
348 .num_sensors = 5,
349 .ops = &ops_8909,
350 .feat = &tsens_v0_1_feat,
351 .fields = tsens_v0_1_regfields,
352 };
353
354 static const struct tsens_ops ops_8916 = {
355 .init = init_common,
356 .calibrate = calibrate_8916,
357 .get_temp = get_temp_common,
358 };
359
360 struct tsens_plat_data data_8916 = {
361 .num_sensors = 5,
362 .ops = &ops_8916,
363 .hw_ids = (unsigned int []){0, 1, 2, 4, 5 },
364
365 .feat = &tsens_v0_1_feat,
366 .fields = tsens_v0_1_regfields,
367 };
368
369 static const struct tsens_ops ops_8939 = {
370 .init = init_8939,
371 .calibrate = tsens_calibrate_common,
372 .get_temp = get_temp_common,
373 };
374
375 struct tsens_plat_data data_8939 = {
376 .num_sensors = 9,
377 .ops = &ops_8939,
378 .hw_ids = (unsigned int []){ 0, 1, 2, 3, 5, 6, 7, 8, 9, /* 10 */ },
379
380 .feat = &tsens_v0_1_feat,
381 .fields = tsens_v0_1_regfields,
382 };
383
384 static const struct tsens_ops ops_8974 = {
385 .init = init_common,
386 .calibrate = calibrate_8974,
387 .get_temp = get_temp_common,
388 };
389
390 struct tsens_plat_data data_8974 = {
391 .num_sensors = 11,
392 .ops = &ops_8974,
393 .feat = &tsens_v0_1_feat,
394 .fields = tsens_v0_1_regfields,
395 };
396
397 static const struct tsens_ops ops_9607 = {
398 .init = init_9607,
399 .calibrate = tsens_calibrate_common,
400 .get_temp = get_temp_common,
401 };
402
403 struct tsens_plat_data data_9607 = {
404 .num_sensors = 5,
405 .ops = &ops_9607,
406 .feat = &tsens_v0_1_feat,
407 .fields = tsens_v0_1_regfields,
408 };
409