mirror of
https://github.com/openwrt/openwrt.git
synced 2024-12-28 09:39:00 +00:00
96f10c9d7a
Use improved tsens patch proposed upstream. Signed-off-by: Ansuel Smith <ansuelsmth@gmail.com>
115 lines
3.0 KiB
Diff
115 lines
3.0 KiB
Diff
From 1ff9f982051759e0387e8c7e793b49c48eae291d Mon Sep 17 00:00:00 2001
|
|
From: Ansuel Smith <ansuelsmth@gmail.com>
|
|
Date: Wed, 25 Nov 2020 17:11:05 +0100
|
|
Subject: [PATCH 06/10] drivers: thermal: tsens: Replace custom 8960 apis with
|
|
generic apis
|
|
|
|
Rework calibrate function to use common function. Derive the offset from
|
|
a missing hardcoded slope table and the data from the nvmem calib
|
|
efuses.
|
|
Drop custom get_temp function and use generic api.
|
|
|
|
Signed-off-by: Ansuel Smith <ansuelsmth@gmail.com>
|
|
Acked-by: Thara Gopinath <thara.gopinath@linaro.org>
|
|
---
|
|
drivers/thermal/qcom/tsens-8960.c | 56 +++++++++----------------------
|
|
1 file changed, 15 insertions(+), 41 deletions(-)
|
|
|
|
diff --git a/drivers/thermal/qcom/tsens-8960.c b/drivers/thermal/qcom/tsens-8960.c
|
|
index 95fcccafae14..9cc8a7dd23ae 100644
|
|
--- a/drivers/thermal/qcom/tsens-8960.c
|
|
+++ b/drivers/thermal/qcom/tsens-8960.c
|
|
@@ -67,6 +67,13 @@
|
|
#define S9_STATUS_OFF 0x3674
|
|
#define S10_STATUS_OFF 0x3678
|
|
|
|
+/* Original slope - 200 to compensate mC to C inaccuracy */
|
|
+static u32 tsens_msm8960_slope[] = {
|
|
+ 976, 976, 954, 976,
|
|
+ 911, 932, 932, 999,
|
|
+ 932, 999, 932
|
|
+ };
|
|
+
|
|
static int suspend_8960(struct tsens_priv *priv)
|
|
{
|
|
int ret;
|
|
@@ -194,9 +201,7 @@ static int calibrate_8960(struct tsens_priv *priv)
|
|
{
|
|
int i;
|
|
char *data;
|
|
-
|
|
- ssize_t num_read = priv->num_sensors;
|
|
- struct tsens_sensor *s = priv->sensor;
|
|
+ u32 p1[11];
|
|
|
|
data = qfprom_read(priv->dev, "calib");
|
|
if (IS_ERR(data))
|
|
@@ -204,49 +209,18 @@ static int calibrate_8960(struct tsens_priv *priv)
|
|
if (IS_ERR(data))
|
|
return PTR_ERR(data);
|
|
|
|
- for (i = 0; i < num_read; i++, s++)
|
|
- s->offset = data[i];
|
|
+ for (i = 0; i < priv->num_sensors; i++) {
|
|
+ p1[i] = data[i];
|
|
+ priv->sensor[i].slope = tsens_msm8960_slope[i];
|
|
+ }
|
|
+
|
|
+ compute_intercept_slope(priv, p1, NULL, ONE_PT_CALIB);
|
|
|
|
kfree(data);
|
|
|
|
return 0;
|
|
}
|
|
|
|
-/* Temperature on y axis and ADC-code on x-axis */
|
|
-static inline int code_to_mdegC(u32 adc_code, const struct tsens_sensor *s)
|
|
-{
|
|
- int slope, offset;
|
|
-
|
|
- slope = thermal_zone_get_slope(s->tzd);
|
|
- offset = CAL_MDEGC - slope * s->offset;
|
|
-
|
|
- return adc_code * slope + offset;
|
|
-}
|
|
-
|
|
-static int get_temp_8960(const struct tsens_sensor *s, int *temp)
|
|
-{
|
|
- int ret;
|
|
- u32 code, trdy;
|
|
- struct tsens_priv *priv = s->priv;
|
|
- unsigned long timeout;
|
|
-
|
|
- timeout = jiffies + usecs_to_jiffies(TIMEOUT_US);
|
|
- do {
|
|
- ret = regmap_read(priv->tm_map, INT_STATUS_ADDR, &trdy);
|
|
- if (ret)
|
|
- return ret;
|
|
- if (!(trdy & TRDY_MASK))
|
|
- continue;
|
|
- ret = regmap_read(priv->tm_map, s->status, &code);
|
|
- if (ret)
|
|
- return ret;
|
|
- *temp = code_to_mdegC(code, s);
|
|
- return 0;
|
|
- } while (time_before(jiffies, timeout));
|
|
-
|
|
- return -ETIMEDOUT;
|
|
-}
|
|
-
|
|
static struct tsens_features tsens_8960_feat = {
|
|
.ver_major = VER_0,
|
|
.crit_int = 0,
|
|
@@ -315,7 +289,7 @@ static const struct reg_field tsens_8960_regfields[MAX_REGFIELDS] = {
|
|
static const struct tsens_ops ops_8960 = {
|
|
.init = init_common,
|
|
.calibrate = calibrate_8960,
|
|
- .get_temp = get_temp_8960,
|
|
+ .get_temp = get_temp_common,
|
|
.enable = enable_8960,
|
|
.disable = disable_8960,
|
|
.suspend = suspend_8960,
|
|
--
|
|
2.30.2
|
|
|