1 // SPDX-License-Identifier: GPL-2.0
3 * Copyright (c) 2015, The Linux Foundation. All rights reserved.
8 #include <linux/nvmem-consumer.h>
9 #include <linux/of_address.h>
10 #include <linux/of_platform.h>
11 #include <linux/platform_device.h>
12 #include <linux/regmap.h>
15 char *qfprom_read(struct device *dev, const char *cname)
17 struct nvmem_cell *cell;
21 cell = nvmem_cell_get(dev, cname);
23 return ERR_CAST(cell);
25 ret = nvmem_cell_read(cell, &data);
32 * Use this function on devices where slope and offset calculations
33 * depend on calibration data read from qfprom. On others the slope
34 * and offset values are derived from tz->tzp->slope and tz->tzp->offset
37 void compute_intercept_slope(struct tsens_priv *priv, u32 *p1,
43 for (i = 0; i < priv->num_sensors; i++) {
45 "sensor%d - data_point1:%#x data_point2:%#x\n",
48 priv->sensor[i].slope = SLOPE_DEFAULT;
49 if (mode == TWO_PT_CALIB) {
51 * slope (m) = adc_code2 - adc_code1 (y2 - y1)/
52 * temp_120_degc - temp_30_degc (x2 - x1)
56 den = CAL_DEGC_PT2 - CAL_DEGC_PT1;
57 priv->sensor[i].slope = num / den;
60 priv->sensor[i].offset = (p1[i] * SLOPE_FACTOR) -
62 priv->sensor[i].slope);
63 dev_dbg(priv->dev, "offset:%d\n", priv->sensor[i].offset);
67 static inline int code_to_degc(u32 adc_code, const struct tsens_sensor *s)
71 num = (adc_code * SLOPE_FACTOR) - s->offset;
75 degc = num + (den / 2);
77 degc = num - (den / 2);
86 int get_temp_tsens_valid(struct tsens_priv *priv, int i, int *temp)
88 struct tsens_sensor *s = &priv->sensor[i];
89 u32 temp_idx = LAST_TEMP_0 + s->hw_id;
90 u32 valid_idx = VALID_0 + s->hw_id;
91 u32 last_temp = 0, valid, mask;
94 ret = regmap_field_read(priv->rf[valid_idx], &valid);
98 /* Valid bit is 0 for 6 AHB clock cycles.
99 * At 19.2MHz, 1 AHB clock is ~60ns.
100 * We should enter this loop very, very rarely.
103 ret = regmap_field_read(priv->rf[valid_idx], &valid);
108 /* Valid bit is set, OK to read the temperature */
109 ret = regmap_field_read(priv->rf[temp_idx], &last_temp);
113 if (priv->feat->adc) {
114 /* Convert temperature from ADC code to milliCelsius */
115 *temp = code_to_degc(last_temp, s) * 1000;
117 mask = GENMASK(priv->fields[LAST_TEMP_0].msb,
118 priv->fields[LAST_TEMP_0].lsb);
119 /* Convert temperature from deciCelsius to milliCelsius */
120 *temp = sign_extend32(last_temp, fls(mask) - 1) * 100;
126 int get_temp_common(struct tsens_priv *priv, int i, int *temp)
128 struct tsens_sensor *s = &priv->sensor[i];
129 int last_temp = 0, ret;
131 ret = regmap_field_read(priv->rf[LAST_TEMP_0 + s->hw_id], &last_temp);
135 *temp = code_to_degc(last_temp, s) * 1000;
140 static const struct regmap_config tsens_config = {
147 static const struct regmap_config tsens_srot_config = {
154 int __init init_common(struct tsens_priv *priv)
156 void __iomem *tm_base, *srot_base;
157 struct device *dev = priv->dev;
158 struct resource *res;
161 struct platform_device *op = of_find_device_by_node(priv->dev->of_node);
166 if (op->num_resources > 1) {
167 /* DT with separate SROT and TM address space */
169 res = platform_get_resource(op, IORESOURCE_MEM, 1);
170 srot_base = devm_ioremap_resource(&op->dev, res);
171 if (IS_ERR(srot_base)) {
172 ret = PTR_ERR(srot_base);
176 priv->srot_map = devm_regmap_init_mmio(dev, srot_base,
178 if (IS_ERR(priv->srot_map)) {
179 ret = PTR_ERR(priv->srot_map);
183 /* old DTs where SROT and TM were in a contiguous 2K block */
184 priv->tm_offset = 0x1000;
187 res = platform_get_resource(op, IORESOURCE_MEM, 0);
188 tm_base = devm_ioremap_resource(&op->dev, res);
189 if (IS_ERR(tm_base)) {
190 ret = PTR_ERR(tm_base);
194 priv->tm_map = devm_regmap_init_mmio(dev, tm_base, &tsens_config);
195 if (IS_ERR(priv->tm_map)) {
196 ret = PTR_ERR(priv->tm_map);
200 priv->rf[TSENS_EN] = devm_regmap_field_alloc(dev, priv->srot_map,
201 priv->fields[TSENS_EN]);
202 if (IS_ERR(priv->rf[TSENS_EN])) {
203 ret = PTR_ERR(priv->rf[TSENS_EN]);
206 ret = regmap_field_read(priv->rf[TSENS_EN], &enabled);
210 dev_err(dev, "tsens device is not enabled\n");
215 priv->rf[SENSOR_EN] = devm_regmap_field_alloc(dev, priv->srot_map,
216 priv->fields[SENSOR_EN]);
217 if (IS_ERR(priv->rf[SENSOR_EN])) {
218 ret = PTR_ERR(priv->rf[SENSOR_EN]);
221 /* now alloc regmap_fields in tm_map */
222 for (i = 0, j = LAST_TEMP_0; i < priv->feat->max_sensors; i++, j++) {
223 priv->rf[j] = devm_regmap_field_alloc(dev, priv->tm_map,
225 if (IS_ERR(priv->rf[j])) {
226 ret = PTR_ERR(priv->rf[j]);
230 for (i = 0, j = VALID_0; i < priv->feat->max_sensors; i++, j++) {
231 priv->rf[j] = devm_regmap_field_alloc(dev, priv->tm_map,
233 if (IS_ERR(priv->rf[j])) {
234 ret = PTR_ERR(priv->rf[j]);
242 put_device(&op->dev);