@@ -76,10 +76,8 @@ static int suspend_8960(struct tsens_priv *priv)
mask = SLP_CLK_ENA_8660 | EN;
ret = regmap_update_bits(map, CNTL_ADDR, mask, 0);
- if (ret)
- return ret;
- return 0;
+ return ret;
}
static int resume_8960(struct tsens_priv *priv)
@@ -106,10 +104,8 @@ static int resume_8960(struct tsens_priv *priv)
return ret;
ret = regmap_write(map, CNTL_ADDR, priv->ctx.control);
- if (ret)
- return ret;
- return 0;
+ return ret;
}
static int enable_8960(struct tsens_priv *priv, int id)
@@ -132,10 +128,8 @@ static int enable_8960(struct tsens_priv *priv, int id)
reg |= mask | SLP_CLK_ENA_8660 | EN;
ret = regmap_write(priv->tm_map, CNTL_ADDR, reg);
- if (ret)
- return ret;
- return 0;
+ return ret;
}
static void disable_8960(struct tsens_priv *priv)
@@ -206,10 +200,8 @@ static int init_8960(struct tsens_priv *priv)
reg_cntl |= EN;
ret = regmap_write(priv->tm_map, CNTL_ADDR, reg_cntl);
- if (ret)
- return ret;
- return 0;
+ return ret;
}
static int calibrate_8960(struct tsens_priv *priv)
@@ -221,10 +213,11 @@ static int calibrate_8960(struct tsens_priv *priv)
struct tsens_sensor *s = priv->sensor;
data = qfprom_read(priv->dev, "calib");
- if (IS_ERR(data))
+ if (IS_ERR(data)) {
data = qfprom_read(priv->dev, "calib_backup");
- if (IS_ERR(data))
- return PTR_ERR(data);
+ if (IS_ERR(data))
+ return PTR_ERR(data);
+ }
for (i = 0; i < num_read; i++, s++)
s->offset = data[i];
@@ -278,6 +271,6 @@ static const struct tsens_ops ops_8960 = {
};
const struct tsens_plat_data data_8960 = {
- .num_sensors = 11,
+ .num_sensors = MAX_NUM_SENSORS,
.ops = &ops_8960,
};
@@ -66,19 +66,17 @@ void compute_intercept_slope(struct tsens_priv *priv, u32 *p1,
static inline int code_to_degc(u32 adc_code, const struct tsens_sensor *s)
{
- int degc, num, den;
+ int degc, den;
- num = (adc_code * SLOPE_FACTOR) - s->offset;
+ degc = (adc_code * SLOPE_FACTOR) - s->offset;
den = s->slope;
- if (num > 0)
- degc = num + (den / 2);
- else if (num < 0)
- degc = num - (den / 2);
- else
- degc = num;
-
- degc /= den;
+ if (degc != 0) {
+ if (degc > 0)
+ degc = (degc + (den / 2)) / den;
+ else
+ degc = (degc - (den / 2)) / den;
+ }
return degc;
}
@@ -188,7 +188,7 @@ static int calibrate_8916(struct tsens_priv *priv)
static int calibrate_8974(struct tsens_priv *priv)
{
int base1 = 0, base2 = 0, i;
- u32 p1[11], p2[11];
+ u32 p1[MAX_NUM_SENSORS], p2[MAX_NUM_SENSORS];
int mode = 0;
u32 *calib, *bkp;
u32 calib_redun_sel;
@@ -324,7 +324,7 @@ static const struct tsens_features tsens_v0_1_feat = {
.crit_int = 0,
.adc = 1,
.srot_split = 1,
- .max_sensors = 11,
+ .max_sensors = MAX_NUM_SENSORS,
};
static const struct reg_field tsens_v0_1_regfields[MAX_REGFIELDS] = {
@@ -374,7 +374,7 @@ static const struct tsens_ops ops_8974 = {
};
const struct tsens_plat_data data_8974 = {
- .num_sensors = 11,
+ .num_sensors = MAX_NUM_SENSORS,
.ops = &ops_8974,
.feat = &tsens_v0_1_feat,
.fields = tsens_v0_1_regfields,
@@ -149,7 +149,7 @@ static const struct tsens_features tsens_v1_feat = {
.crit_int = 0,
.adc = 1,
.srot_split = 1,
- .max_sensors = 11,
+ .max_sensors = MAX_NUM_SENSORS,
};
static const struct reg_field tsens_v1_regfields[MAX_REGFIELDS] = {
@@ -6,6 +6,7 @@
#ifndef __QCOM_TSENS_H__
#define __QCOM_TSENS_H__
+#define MAX_NUM_SENSORS 11
#define ONE_PT_CALIB 0x1
#define ONE_PT_CALIB2 0x2
#define TWO_PT_CALIB 0x3
Some functions in tsens-8960.c can directly return ret instead of doing an extra check. In function calibrate_8960(), a second check for IS_ERR(data) can also be avoided in some cases. A constant could be used to represent the maximum number of sensors (11). Finally, function code_to_degc() can be simplified, avoiding using an extra variable. Include these small refactoring changes. Signed-off-by: Carlos Bilbao <carlos.bilbao@amd.com> --- drivers/thermal/qcom/tsens-8960.c | 25 +++++++++---------------- drivers/thermal/qcom/tsens-common.c | 18 ++++++++---------- drivers/thermal/qcom/tsens-v0_1.c | 6 +++--- drivers/thermal/qcom/tsens-v1.c | 2 +- drivers/thermal/qcom/tsens.h | 1 + 5 files changed, 22 insertions(+), 30 deletions(-)