[PATCH v2 3/5] thermal: rockchip: fixes invalid temperature case
Caesar Wang
wxt at rock-chips.com
Wed Nov 23 17:16:25 PST 2016
在 2016年11月24日 02:35, Brian Norris 写道:
> Hi Caesar,
>
> On Wed, Nov 23, 2016 at 10:29:32PM +0800, Caesar Wang wrote:
>> The temp_to_code function will return 0 when we set the temperature to a
>> invalid value (e.g. 61C, 62C, 63C....), that's unpractical. This patch
>> will prevent this case happening. That will return the max analog value to
>> indicate the temperature is invalid or over table temperature range.
>>
>> Signed-off-by: Caesar Wang <wxt at rock-chips.com>
>> ---
>>
>> Changes in v2:
>> - As Brian commnets that restructure this to pass error codes back to the
>> upper layers.
>> - Improve the commit message.
>>
>> Changes in v1: None
>>
>> drivers/thermal/rockchip_thermal.c | 41 ++++++++++++++++++++++++++------------
>> 1 file changed, 28 insertions(+), 13 deletions(-)
>>
>> diff --git a/drivers/thermal/rockchip_thermal.c b/drivers/thermal/rockchip_thermal.c
>> index 766486f..e243e40 100644
>> --- a/drivers/thermal/rockchip_thermal.c
>> +++ b/drivers/thermal/rockchip_thermal.c
>> @@ -120,9 +120,9 @@ struct rockchip_tsadc_chip {
>> /* Per-sensor methods */
>> int (*get_temp)(const struct chip_tsadc_table *table,
>> int chn, void __iomem *reg, int *temp);
>> - void (*set_alarm_temp)(const struct chip_tsadc_table *table,
>> + int (*set_alarm_temp)(const struct chip_tsadc_table *table,
>> int chn, void __iomem *reg, int temp);
>> - void (*set_tshut_temp)(const struct chip_tsadc_table *table,
>> + int (*set_tshut_temp)(const struct chip_tsadc_table *table,
>> int chn, void __iomem *reg, int temp);
>> void (*set_tshut_mode)(int chn, void __iomem *reg, enum tshut_mode m);
>>
>> @@ -401,17 +401,15 @@ static u32 rk_tsadcv2_temp_to_code(const struct chip_tsadc_table *table,
>> int temp)
>> {
>> int high, low, mid;
>> - u32 error = 0;
>> + u32 error = table->data_mask;
>>
>> low = 0;
>> high = table->length - 1;
>> mid = (high + low) / 2;
>>
>> /* Return mask code data when the temp is over table range */
>> - if (temp < table->id[low].temp || temp > table->id[high].temp) {
>> - error = table->data_mask;
>> + if (temp < table->id[low].temp || temp > table->id[high].temp)
>> goto exit;
>> - }
>>
>> while (low <= high) {
>> if (temp == table->id[mid].temp)
>> @@ -651,7 +649,7 @@ static int rk_tsadcv2_get_temp(const struct chip_tsadc_table *table,
>> return rk_tsadcv2_code_to_temp(table, val, temp);
>> }
>>
>> -static void rk_tsadcv2_alarm_temp(const struct chip_tsadc_table *table,
>> +static int rk_tsadcv2_alarm_temp(const struct chip_tsadc_table *table,
>> int chn, void __iomem *regs, int temp)
>> {
>> u32 alarm_value, int_en;
>> @@ -659,7 +657,7 @@ static void rk_tsadcv2_alarm_temp(const struct chip_tsadc_table *table,
>> /* Make sure the value is valid */
>> alarm_value = rk_tsadcv2_temp_to_code(table, temp);
>> if (alarm_value == table->data_mask)
>> - return;
>> + return -ERANGE;
>>
>> writel_relaxed(alarm_value & table->data_mask,
>> regs + TSADCV2_COMP_INT(chn));
>> @@ -667,9 +665,11 @@ static void rk_tsadcv2_alarm_temp(const struct chip_tsadc_table *table,
>> int_en = readl_relaxed(regs + TSADCV2_INT_EN);
>> int_en |= TSADCV2_INT_SRC_EN(chn);
>> writel_relaxed(int_en, regs + TSADCV2_INT_EN);
>> +
>> + return 0;
>> }
>>
>> -static void rk_tsadcv2_tshut_temp(const struct chip_tsadc_table *table,
>> +static int rk_tsadcv2_tshut_temp(const struct chip_tsadc_table *table,
>> int chn, void __iomem *regs, int temp)
>> {
>> u32 tshut_value, val;
>> @@ -677,13 +677,15 @@ static void rk_tsadcv2_tshut_temp(const struct chip_tsadc_table *table,
>> /* Make sure the value is valid */
>> tshut_value = rk_tsadcv2_temp_to_code(table, temp);
>> if (tshut_value == table->data_mask)
>> - return;
>> + return -ERANGE;
>>
>> writel_relaxed(tshut_value, regs + TSADCV2_COMP_SHUT(chn));
>>
>> /* TSHUT will be valid */
>> val = readl_relaxed(regs + TSADCV2_AUTO_CON);
>> writel_relaxed(val | TSADCV2_AUTO_SRC_EN(chn), regs + TSADCV2_AUTO_CON);
>> +
>> + return 0;
>> }
>>
>> static void rk_tsadcv2_tshut_mode(int chn, void __iomem *regs,
>> @@ -882,12 +884,17 @@ static int rockchip_thermal_set_trips(void *_sensor, int low, int high)
>> struct rockchip_thermal_sensor *sensor = _sensor;
>> struct rockchip_thermal_data *thermal = sensor->thermal;
>> const struct rockchip_tsadc_chip *tsadc = thermal->chip;
>> + int ret;
>>
>> dev_dbg(&thermal->pdev->dev, "%s: sensor %d: low: %d, high %d\n",
>> __func__, sensor->id, low, high);
>>
>> - tsadc->set_alarm_temp(&tsadc->table,
>> + ret = tsadc->set_alarm_temp(&tsadc->table,
>> sensor->id, thermal->regs, high);
>> + if (ret)
>> + dev_err(&thermal->pdev->dev,
>> + "%s: disable sensor[%d] alarm temp: %d, ret: %d\n",
> You're not necessarily disabling the sensor; you're just not programming
> it. If this is the second time setting the trip points (e.g., using
> 'echo > trip_X_temp') then this just means you've retained the old
> value.
>
> Also, I'm not sure you need to print anything here, as the thermal core
> prints errors for you. Maybe make this dev_dbg() so it doesn't print by
> default?
Yeah, the thermal core will print something, look like I just print
"failed set the sensor*....
or return ret".
Anyway, that's not ugly thing.
>> + __func__, sensor->id, high, ret);
>>
>> return 0;
> Oh, but you missed the whole point of returning errors; you need to
> propagate 'ret' here! i.e.:
>
> return ret;
Right, thanks for tracking into it.
I will wait someone feedback for this series patches before posting new
patchset.
-Caesar
>
> Brian
>
>> }
>> @@ -985,8 +992,12 @@ rockchip_thermal_register_sensor(struct platform_device *pdev,
>> int error;
>>
>> tsadc->set_tshut_mode(id, thermal->regs, thermal->tshut_mode);
>> - tsadc->set_tshut_temp(&tsadc->table, id, thermal->regs,
>> +
>> + error = tsadc->set_tshut_temp(&tsadc->table, id, thermal->regs,
>> thermal->tshut_temp);
>> + if (error)
>> + dev_err(&pdev->dev, "%s: invalid tshut=%d, error=%d\n",
>> + __func__, thermal->tshut_temp, error);
>>
>> sensor->thermal = thermal;
>> sensor->id = id;
>> @@ -1199,9 +1210,13 @@ static int __maybe_unused rockchip_thermal_resume(struct device *dev)
>>
>> thermal->chip->set_tshut_mode(id, thermal->regs,
>> thermal->tshut_mode);
>> - thermal->chip->set_tshut_temp(&thermal->chip->table,
>> +
>> + error = thermal->chip->set_tshut_temp(&thermal->chip->table,
>> id, thermal->regs,
>> thermal->tshut_temp);
>> + if (error)
>> + dev_err(&pdev->dev, "%s: invalid tshut=%d, error=%d\n",
>> + __func__, thermal->tshut_temp, error);
>> }
>>
>> thermal->chip->control(thermal->regs, true);
>> --
>> 2.7.4
>>
> _______________________________________________
> Linux-rockchip mailing list
> Linux-rockchip at lists.infradead.org
> http://lists.infradead.org/mailman/listinfo/linux-rockchip
More information about the Linux-rockchip
mailing list