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 
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 
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 
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 
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 
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 
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 
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 
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_v0_1 = {
329 	.init		= init_common,
330 	.calibrate	= tsens_calibrate_common,
331 	.get_temp	= get_temp_common,
332 };
333 
334 static const struct tsens_ops ops_8226 = {
335 	.init		= init_8226,
336 	.calibrate	= tsens_calibrate_common,
337 	.get_temp	= get_temp_common,
338 };
339 
340 struct tsens_plat_data data_8226 = {
341 	.num_sensors	= 6,
342 	.ops		= &ops_8226,
343 	.feat		= &tsens_v0_1_feat,
344 	.fields	= tsens_v0_1_regfields,
345 };
346 
347 static const struct tsens_ops ops_8909 = {
348 	.init		= init_8909,
349 	.calibrate	= tsens_calibrate_common,
350 	.get_temp	= get_temp_common,
351 };
352 
353 struct tsens_plat_data data_8909 = {
354 	.num_sensors	= 5,
355 	.ops		= &ops_8909,
356 	.feat		= &tsens_v0_1_feat,
357 	.fields	= tsens_v0_1_regfields,
358 };
359 
360 static const struct tsens_ops ops_8916 = {
361 	.init		= init_common,
362 	.calibrate	= calibrate_8916,
363 	.get_temp	= get_temp_common,
364 };
365 
366 struct tsens_plat_data data_8916 = {
367 	.num_sensors	= 5,
368 	.ops		= &ops_8916,
369 	.hw_ids		= (unsigned int []){0, 1, 2, 4, 5 },
370 
371 	.feat		= &tsens_v0_1_feat,
372 	.fields	= tsens_v0_1_regfields,
373 };
374 
375 static const struct tsens_ops ops_8939 = {
376 	.init		= init_8939,
377 	.calibrate	= tsens_calibrate_common,
378 	.get_temp	= get_temp_common,
379 };
380 
381 struct tsens_plat_data data_8939 = {
382 	.num_sensors	= 9,
383 	.ops		= &ops_8939,
384 	.hw_ids		= (unsigned int []){ 0, 1, 2, 3, 5, 6, 7, 8, 9, /* 10 */ },
385 
386 	.feat		= &tsens_v0_1_feat,
387 	.fields	= tsens_v0_1_regfields,
388 };
389 
390 static const struct tsens_ops ops_8974 = {
391 	.init		= init_common,
392 	.calibrate	= calibrate_8974,
393 	.get_temp	= get_temp_common,
394 };
395 
396 struct tsens_plat_data data_8974 = {
397 	.num_sensors	= 11,
398 	.ops		= &ops_8974,
399 	.feat		= &tsens_v0_1_feat,
400 	.fields	= tsens_v0_1_regfields,
401 };
402 
403 static const struct tsens_ops ops_9607 = {
404 	.init		= init_9607,
405 	.calibrate	= tsens_calibrate_common,
406 	.get_temp	= get_temp_common,
407 };
408 
409 struct tsens_plat_data data_9607 = {
410 	.num_sensors	= 5,
411 	.ops		= &ops_9607,
412 	.feat		= &tsens_v0_1_feat,
413 	.fields	= tsens_v0_1_regfields,
414 };
415