1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (c) 2015, The Linux Foundation. All rights reserved.
4  */
5 
6 #include <linux/platform_device.h>
7 #include <linux/delay.h>
8 #include <linux/bitops.h>
9 #include <linux/regmap.h>
10 #include <linux/thermal.h>
11 #include "tsens.h"
12 
13 #define CAL_MDEGC		30000
14 
15 #define CONFIG_ADDR		0x3640
16 #define CONFIG_ADDR_8660	0x3620
17 /* CONFIG_ADDR bitmasks */
18 #define CONFIG			0x9b
19 #define CONFIG_MASK		0xf
20 #define CONFIG_8660		1
21 #define CONFIG_SHIFT_8660	28
22 #define CONFIG_MASK_8660	(3 << CONFIG_SHIFT_8660)
23 
24 #define STATUS_CNTL_ADDR_8064	0x3660
25 #define CNTL_ADDR		0x3620
26 /* CNTL_ADDR bitmasks */
27 #define EN			BIT(0)
28 #define SW_RST			BIT(1)
29 #define SENSOR0_EN		BIT(3)
30 #define SLP_CLK_ENA		BIT(26)
31 #define SLP_CLK_ENA_8660	BIT(24)
32 #define MEASURE_PERIOD		1
33 #define SENSOR0_SHIFT		3
34 
35 /* INT_STATUS_ADDR bitmasks */
36 #define MIN_STATUS_MASK		BIT(0)
37 #define LOWER_STATUS_CLR	BIT(1)
38 #define UPPER_STATUS_CLR	BIT(2)
39 #define MAX_STATUS_MASK		BIT(3)
40 
41 #define THRESHOLD_ADDR		0x3624
42 /* THRESHOLD_ADDR bitmasks */
43 #define THRESHOLD_MAX_LIMIT_SHIFT	24
44 #define THRESHOLD_MIN_LIMIT_SHIFT	16
45 #define THRESHOLD_UPPER_LIMIT_SHIFT	8
46 #define THRESHOLD_LOWER_LIMIT_SHIFT	0
47 
48 /* Initial temperature threshold values */
49 #define LOWER_LIMIT_TH		0x50
50 #define UPPER_LIMIT_TH		0xdf
51 #define MIN_LIMIT_TH		0x0
52 #define MAX_LIMIT_TH		0xff
53 
54 #define S0_STATUS_ADDR		0x3628
55 #define INT_STATUS_ADDR		0x363c
56 #define TRDY_MASK		BIT(7)
57 #define TIMEOUT_US		100
58 
59 static int suspend_8960(struct tsens_priv *priv)
60 {
61 	int ret;
62 	unsigned int mask;
63 	struct regmap *map = priv->tm_map;
64 
65 	ret = regmap_read(map, THRESHOLD_ADDR, &priv->ctx.threshold);
66 	if (ret)
67 		return ret;
68 
69 	ret = regmap_read(map, CNTL_ADDR, &priv->ctx.control);
70 	if (ret)
71 		return ret;
72 
73 	if (priv->num_sensors > 1)
74 		mask = SLP_CLK_ENA | EN;
75 	else
76 		mask = SLP_CLK_ENA_8660 | EN;
77 
78 	ret = regmap_update_bits(map, CNTL_ADDR, mask, 0);
79 	if (ret)
80 		return ret;
81 
82 	return 0;
83 }
84 
85 static int resume_8960(struct tsens_priv *priv)
86 {
87 	int ret;
88 	struct regmap *map = priv->tm_map;
89 
90 	ret = regmap_update_bits(map, CNTL_ADDR, SW_RST, SW_RST);
91 	if (ret)
92 		return ret;
93 
94 	/*
95 	 * Separate CONFIG restore is not needed only for 8660 as
96 	 * config is part of CTRL Addr and its restored as such
97 	 */
98 	if (priv->num_sensors > 1) {
99 		ret = regmap_update_bits(map, CONFIG_ADDR, CONFIG_MASK, CONFIG);
100 		if (ret)
101 			return ret;
102 	}
103 
104 	ret = regmap_write(map, THRESHOLD_ADDR, priv->ctx.threshold);
105 	if (ret)
106 		return ret;
107 
108 	ret = regmap_write(map, CNTL_ADDR, priv->ctx.control);
109 	if (ret)
110 		return ret;
111 
112 	return 0;
113 }
114 
115 static int enable_8960(struct tsens_priv *priv, int id)
116 {
117 	int ret;
118 	u32 reg, mask;
119 
120 	ret = regmap_read(priv->tm_map, CNTL_ADDR, &reg);
121 	if (ret)
122 		return ret;
123 
124 	mask = BIT(id + SENSOR0_SHIFT);
125 	ret = regmap_write(priv->tm_map, CNTL_ADDR, reg | SW_RST);
126 	if (ret)
127 		return ret;
128 
129 	if (priv->num_sensors > 1)
130 		reg |= mask | SLP_CLK_ENA | EN;
131 	else
132 		reg |= mask | SLP_CLK_ENA_8660 | EN;
133 
134 	ret = regmap_write(priv->tm_map, CNTL_ADDR, reg);
135 	if (ret)
136 		return ret;
137 
138 	return 0;
139 }
140 
141 static void disable_8960(struct tsens_priv *priv)
142 {
143 	int ret;
144 	u32 reg_cntl;
145 	u32 mask;
146 
147 	mask = GENMASK(priv->num_sensors - 1, 0);
148 	mask <<= SENSOR0_SHIFT;
149 	mask |= EN;
150 
151 	ret = regmap_read(priv->tm_map, CNTL_ADDR, &reg_cntl);
152 	if (ret)
153 		return;
154 
155 	reg_cntl &= ~mask;
156 
157 	if (priv->num_sensors > 1)
158 		reg_cntl &= ~SLP_CLK_ENA;
159 	else
160 		reg_cntl &= ~SLP_CLK_ENA_8660;
161 
162 	regmap_write(priv->tm_map, CNTL_ADDR, reg_cntl);
163 }
164 
165 static int init_8960(struct tsens_priv *priv)
166 {
167 	int ret, i;
168 	u32 reg_cntl;
169 
170 	priv->tm_map = dev_get_regmap(priv->dev, NULL);
171 	if (!priv->tm_map)
172 		return -ENODEV;
173 
174 	/*
175 	 * The status registers for each sensor are discontiguous
176 	 * because some SoCs have 5 sensors while others have more
177 	 * but the control registers stay in the same place, i.e
178 	 * directly after the first 5 status registers.
179 	 */
180 	for (i = 0; i < priv->num_sensors; i++) {
181 		if (i >= 5)
182 			priv->sensor[i].status = S0_STATUS_ADDR + 40;
183 		priv->sensor[i].status += i * 4;
184 	}
185 
186 	reg_cntl = SW_RST;
187 	ret = regmap_update_bits(priv->tm_map, CNTL_ADDR, SW_RST, reg_cntl);
188 	if (ret)
189 		return ret;
190 
191 	if (priv->num_sensors > 1) {
192 		reg_cntl |= SLP_CLK_ENA | (MEASURE_PERIOD << 18);
193 		reg_cntl &= ~SW_RST;
194 		ret = regmap_update_bits(priv->tm_map, CONFIG_ADDR,
195 					 CONFIG_MASK, CONFIG);
196 	} else {
197 		reg_cntl |= SLP_CLK_ENA_8660 | (MEASURE_PERIOD << 16);
198 		reg_cntl &= ~CONFIG_MASK_8660;
199 		reg_cntl |= CONFIG_8660 << CONFIG_SHIFT_8660;
200 	}
201 
202 	reg_cntl |= GENMASK(priv->num_sensors - 1, 0) << SENSOR0_SHIFT;
203 	ret = regmap_write(priv->tm_map, CNTL_ADDR, reg_cntl);
204 	if (ret)
205 		return ret;
206 
207 	reg_cntl |= EN;
208 	ret = regmap_write(priv->tm_map, CNTL_ADDR, reg_cntl);
209 	if (ret)
210 		return ret;
211 
212 	return 0;
213 }
214 
215 static int calibrate_8960(struct tsens_priv *priv)
216 {
217 	int i;
218 	char *data;
219 
220 	ssize_t num_read = priv->num_sensors;
221 	struct tsens_sensor *s = priv->sensor;
222 
223 	data = qfprom_read(priv->dev, "calib");
224 	if (IS_ERR(data))
225 		data = qfprom_read(priv->dev, "calib_backup");
226 	if (IS_ERR(data))
227 		return PTR_ERR(data);
228 
229 	for (i = 0; i < num_read; i++, s++)
230 		s->offset = data[i];
231 
232 	return 0;
233 }
234 
235 /* Temperature on y axis and ADC-code on x-axis */
236 static inline int code_to_mdegC(u32 adc_code, const struct tsens_sensor *s)
237 {
238 	int slope, offset;
239 
240 	slope = thermal_zone_get_slope(s->tzd);
241 	offset = CAL_MDEGC - slope * s->offset;
242 
243 	return adc_code * slope + offset;
244 }
245 
246 static int get_temp_8960(struct tsens_priv *priv, int id, int *temp)
247 {
248 	int ret;
249 	u32 code, trdy;
250 	const struct tsens_sensor *s = &priv->sensor[id];
251 	unsigned long timeout;
252 
253 	timeout = jiffies + usecs_to_jiffies(TIMEOUT_US);
254 	do {
255 		ret = regmap_read(priv->tm_map, INT_STATUS_ADDR, &trdy);
256 		if (ret)
257 			return ret;
258 		if (!(trdy & TRDY_MASK))
259 			continue;
260 		ret = regmap_read(priv->tm_map, s->status, &code);
261 		if (ret)
262 			return ret;
263 		*temp = code_to_mdegC(code, s);
264 		return 0;
265 	} while (time_before(jiffies, timeout));
266 
267 	return -ETIMEDOUT;
268 }
269 
270 static const struct tsens_ops ops_8960 = {
271 	.init		= init_8960,
272 	.calibrate	= calibrate_8960,
273 	.get_temp	= get_temp_8960,
274 	.enable		= enable_8960,
275 	.disable	= disable_8960,
276 	.suspend	= suspend_8960,
277 	.resume		= resume_8960,
278 };
279 
280 const struct tsens_plat_data data_8960 = {
281 	.num_sensors	= 11,
282 	.ops		= &ops_8960,
283 };
284