diff --git a/drivers/thermal/armada_thermal.c b/drivers/thermal/armada_thermal.c index 53e757a28506..4164a5a4e480 100644 --- a/drivers/thermal/armada_thermal.c +++ b/drivers/thermal/armada_thermal.c @@ -83,9 +83,6 @@ struct armada_thermal_data { void (*init)(struct platform_device *pdev, struct armada_thermal_priv *priv); - /* Test for a valid sensor value (optional) */ - bool (*is_valid)(struct armada_thermal_priv *); - /* Formula coeficients: temp = (b - m * reg) / div */ s64 coef_b; s64 coef_m; @@ -267,6 +264,9 @@ static bool armada_is_valid(struct armada_thermal_priv *priv) { u32 reg; + if (!priv->data->is_valid_bit) + return true; + regmap_read(priv->syscon, priv->data->syscon_status_off, ®); return reg & priv->data->is_valid_bit; @@ -357,7 +357,7 @@ static int armada_get_temp_legacy(struct thermal_zone_device *thermal, int ret; /* Valid check */ - if (priv->data->is_valid && !priv->data->is_valid(priv)) { + if (armada_is_valid(priv)) { dev_err(priv->dev, "Temperature sensor reading not valid\n"); return -EIO; @@ -411,7 +411,6 @@ static const struct armada_thermal_data armadaxp_data = { }; static const struct armada_thermal_data armada370_data = { - .is_valid = armada_is_valid, .init = armada370_init, .is_valid_bit = BIT(9), .temp_shift = 10, @@ -424,7 +423,6 @@ static const struct armada_thermal_data armada370_data = { }; static const struct armada_thermal_data armada375_data = { - .is_valid = armada_is_valid, .init = armada375_init, .is_valid_bit = BIT(10), .temp_shift = 0, @@ -438,7 +436,6 @@ static const struct armada_thermal_data armada375_data = { }; static const struct armada_thermal_data armada380_data = { - .is_valid = armada_is_valid, .init = armada380_init, .is_valid_bit = BIT(10), .temp_shift = 0, @@ -453,7 +450,6 @@ static const struct armada_thermal_data armada380_data = { }; static const struct armada_thermal_data armada_ap806_data = { - .is_valid = armada_is_valid, .init = armada_ap806_init, .is_valid_bit = BIT(16), .temp_shift = 0, @@ -470,7 +466,6 @@ static const struct armada_thermal_data armada_ap806_data = { }; static const struct armada_thermal_data armada_cp110_data = { - .is_valid = armada_is_valid, .init = armada_cp110_init, .is_valid_bit = BIT(10), .temp_shift = 0,