Commit d22066c1 authored by Amit Kucheria's avatar Amit Kucheria Committed by Daniel Lezcano

drivers: thermal: tsens: Add watchdog support

TSENS IP v2.3 onwards adds support for a watchdog to detect if the TSENS
HW FSM is stuck. Add support to detect and restart the FSM in the
driver. The watchdog is configured by the bootloader, we just enable the
watchdog bark as a debug feature in the kernel.
Signed-off-by: default avatarAmit Kucheria <amit.kucheria@linaro.org>
Reviewed-by: default avatarBjorn Andersson <bjorn.andersson@linaro.org>
Reviewed-by: default avatarStephen Boyd <swboyd@chromium.org>
Signed-off-by: default avatarDaniel Lezcano <daniel.lezcano@linaro.org>
Link: https://lore.kernel.org/r/a314747664a065db592ad77da7beae68128a5b6e.1584015867.git.amit.kucheria@linaro.org
parent 79125e03
...@@ -365,6 +365,7 @@ static inline u32 masked_irq(u32 hw_id, u32 mask, enum tsens_ver ver) ...@@ -365,6 +365,7 @@ static inline u32 masked_irq(u32 hw_id, u32 mask, enum tsens_ver ver)
* @irq: irq number * @irq: irq number
* @data: tsens controller private data * @data: tsens controller private data
* *
* Check FSM watchdog bark status and clear if needed.
* Check all sensors to find ones that violated their critical threshold limits. * Check all sensors to find ones that violated their critical threshold limits.
* Clear and then re-enable the interrupt. * Clear and then re-enable the interrupt.
* *
...@@ -379,6 +380,29 @@ irqreturn_t tsens_critical_irq_thread(int irq, void *data) ...@@ -379,6 +380,29 @@ irqreturn_t tsens_critical_irq_thread(int irq, void *data)
struct tsens_priv *priv = data; struct tsens_priv *priv = data;
struct tsens_irq_data d; struct tsens_irq_data d;
int temp, ret, i; int temp, ret, i;
u32 wdog_status, wdog_count;
if (priv->feat->has_watchdog) {
ret = regmap_field_read(priv->rf[WDOG_BARK_STATUS],
&wdog_status);
if (ret)
return ret;
if (wdog_status) {
/* Clear WDOG interrupt */
regmap_field_write(priv->rf[WDOG_BARK_CLEAR], 1);
regmap_field_write(priv->rf[WDOG_BARK_CLEAR], 0);
ret = regmap_field_read(priv->rf[WDOG_BARK_COUNT],
&wdog_count);
if (ret)
return ret;
if (wdog_count)
dev_dbg(priv->dev, "%s: watchdog count: %d\n",
__func__, wdog_count);
/* Fall through to handle critical interrupts if any */
}
}
for (i = 0; i < priv->num_sensors; i++) { for (i = 0; i < priv->num_sensors; i++) {
const struct tsens_sensor *s = &priv->sensor[i]; const struct tsens_sensor *s = &priv->sensor[i];
...@@ -675,6 +699,7 @@ int __init init_common(struct tsens_priv *priv) ...@@ -675,6 +699,7 @@ int __init init_common(struct tsens_priv *priv)
{ {
void __iomem *tm_base, *srot_base; void __iomem *tm_base, *srot_base;
struct device *dev = priv->dev; struct device *dev = priv->dev;
u32 ver_minor;
struct resource *res; struct resource *res;
u32 enabled; u32 enabled;
int ret, i, j; int ret, i, j;
...@@ -724,6 +749,9 @@ int __init init_common(struct tsens_priv *priv) ...@@ -724,6 +749,9 @@ int __init init_common(struct tsens_priv *priv)
if (IS_ERR(priv->rf[i])) if (IS_ERR(priv->rf[i]))
return PTR_ERR(priv->rf[i]); return PTR_ERR(priv->rf[i]);
} }
ret = regmap_field_read(priv->rf[VER_MINOR], &ver_minor);
if (ret)
goto err_put_device;
} }
priv->rf[TSENS_EN] = devm_regmap_field_alloc(dev, priv->srot_map, priv->rf[TSENS_EN] = devm_regmap_field_alloc(dev, priv->srot_map,
...@@ -786,6 +814,25 @@ int __init init_common(struct tsens_priv *priv) ...@@ -786,6 +814,25 @@ int __init init_common(struct tsens_priv *priv)
} }
} }
if (tsens_version(priv) > VER_1_X && ver_minor > 2) {
/* Watchdog is present only on v2.3+ */
priv->feat->has_watchdog = 1;
for (i = WDOG_BARK_STATUS; i <= CC_MON_MASK; i++) {
priv->rf[i] = devm_regmap_field_alloc(dev, priv->tm_map,
priv->fields[i]);
if (IS_ERR(priv->rf[i])) {
ret = PTR_ERR(priv->rf[i]);
goto err_put_device;
}
}
/*
* Watchdog is already enabled, unmask the bark.
* Disable cycle completion monitoring
*/
regmap_field_write(priv->rf[WDOG_BARK_MASK], 0);
regmap_field_write(priv->rf[CC_MON_MASK], 1);
}
spin_lock_init(&priv->ul_lock); spin_lock_init(&priv->ul_lock);
tsens_enable_irq(priv); tsens_enable_irq(priv);
tsens_debug_init(op); tsens_debug_init(op);
......
...@@ -24,6 +24,7 @@ ...@@ -24,6 +24,7 @@
#define TM_Sn_CRITICAL_THRESHOLD_OFF 0x0060 #define TM_Sn_CRITICAL_THRESHOLD_OFF 0x0060
#define TM_Sn_STATUS_OFF 0x00a0 #define TM_Sn_STATUS_OFF 0x00a0
#define TM_TRDY_OFF 0x00e4 #define TM_TRDY_OFF 0x00e4
#define TM_WDOG_LOG_OFF 0x013c
/* v2.x: 8996, 8998, sdm845 */ /* v2.x: 8996, 8998, sdm845 */
...@@ -66,6 +67,15 @@ static const struct reg_field tsens_v2_regfields[MAX_REGFIELDS] = { ...@@ -66,6 +67,15 @@ static const struct reg_field tsens_v2_regfields[MAX_REGFIELDS] = {
REG_FIELD_SPLIT_BITS_0_15(CRIT_INT_CLEAR, TM_CRITICAL_INT_CLEAR_OFF), REG_FIELD_SPLIT_BITS_0_15(CRIT_INT_CLEAR, TM_CRITICAL_INT_CLEAR_OFF),
REG_FIELD_SPLIT_BITS_0_15(CRIT_INT_MASK, TM_CRITICAL_INT_MASK_OFF), REG_FIELD_SPLIT_BITS_0_15(CRIT_INT_MASK, TM_CRITICAL_INT_MASK_OFF),
/* WATCHDOG on v2.3 or later */
[WDOG_BARK_STATUS] = REG_FIELD(TM_CRITICAL_INT_STATUS_OFF, 31, 31),
[WDOG_BARK_CLEAR] = REG_FIELD(TM_CRITICAL_INT_CLEAR_OFF, 31, 31),
[WDOG_BARK_MASK] = REG_FIELD(TM_CRITICAL_INT_MASK_OFF, 31, 31),
[CC_MON_STATUS] = REG_FIELD(TM_CRITICAL_INT_STATUS_OFF, 30, 30),
[CC_MON_CLEAR] = REG_FIELD(TM_CRITICAL_INT_CLEAR_OFF, 30, 30),
[CC_MON_MASK] = REG_FIELD(TM_CRITICAL_INT_MASK_OFF, 30, 30),
[WDOG_BARK_COUNT] = REG_FIELD(TM_WDOG_LOG_OFF, 0, 7),
/* Sn_STATUS */ /* Sn_STATUS */
REG_FIELD_FOR_EACH_SENSOR16(LAST_TEMP, TM_Sn_STATUS_OFF, 0, 11), REG_FIELD_FOR_EACH_SENSOR16(LAST_TEMP, TM_Sn_STATUS_OFF, 0, 11),
REG_FIELD_FOR_EACH_SENSOR16(VALID, TM_Sn_STATUS_OFF, 21, 21), REG_FIELD_FOR_EACH_SENSOR16(VALID, TM_Sn_STATUS_OFF, 21, 21),
......
...@@ -440,6 +440,18 @@ enum regfield_ids { ...@@ -440,6 +440,18 @@ enum regfield_ids {
CRIT_THRESH_13, CRIT_THRESH_13,
CRIT_THRESH_14, CRIT_THRESH_14,
CRIT_THRESH_15, CRIT_THRESH_15,
/* WATCHDOG */
WDOG_BARK_STATUS,
WDOG_BARK_CLEAR,
WDOG_BARK_MASK,
WDOG_BARK_COUNT,
/* CYCLE COMPLETION MONITOR */
CC_MON_STATUS,
CC_MON_CLEAR,
CC_MON_MASK,
MIN_STATUS_0, /* MIN threshold violated */ MIN_STATUS_0, /* MIN threshold violated */
MIN_STATUS_1, MIN_STATUS_1,
MIN_STATUS_2, MIN_STATUS_2,
...@@ -484,6 +496,7 @@ enum regfield_ids { ...@@ -484,6 +496,7 @@ enum regfield_ids {
* @adc: do the sensors only output adc code (instead of temperature)? * @adc: do the sensors only output adc code (instead of temperature)?
* @srot_split: does the IP neatly splits the register space into SROT and TM, * @srot_split: does the IP neatly splits the register space into SROT and TM,
* with SROT only being available to secure boot firmware? * with SROT only being available to secure boot firmware?
* @has_watchdog: does this IP support watchdog functionality?
* @max_sensors: maximum sensors supported by this version of the IP * @max_sensors: maximum sensors supported by this version of the IP
*/ */
struct tsens_features { struct tsens_features {
...@@ -491,6 +504,7 @@ struct tsens_features { ...@@ -491,6 +504,7 @@ struct tsens_features {
unsigned int crit_int:1; unsigned int crit_int:1;
unsigned int adc:1; unsigned int adc:1;
unsigned int srot_split:1; unsigned int srot_split:1;
unsigned int has_watchdog:1;
unsigned int max_sensors; unsigned int max_sensors;
}; };
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment