thermal: ti-soc-thermal: Simplify polling with iopoll

We can use iopoll for checking the EOCZ (end of conversion) bit. And with
this we now also want to handle the timeout errors properly.

For omap3, we need about 1.2ms for the single mode sampling to wait for
EOCZ down, so let's use 1.5ms timeout there. Waiting for sampling to start
is faster and we can use 1ms timeout.

Cc: Adam Ford <aford173@gmail.com>
Cc: Carl Philipp Klemm <philipp@uvos.xyz>
Cc: Eduardo Valentin <edubezval@gmail.com>
Cc: H. Nikolaus Schaller <hns@goldelico.com>
Cc: Merlijn Wajer <merlijn@wizzup.org>
Cc: Pavel Machek <pavel@ucw.cz>
Cc: Peter Ujfalusi <peter.ujfalusi@gmail.com>
Cc: Sebastian Reichel <sre@kernel.org>
Signed-off-by: Tony Lindgren <tony@atomide.com>
Tested-by: Adam Ford <aford173@gmail.com> #logicpd-torpedo-37xx-devkit
Acked-by: Pavel Machek <pavel@ucw.cz>
Signed-off-by: Daniel Lezcano <daniel.lezcano@linaro.org>
Link: https://lore.kernel.org/r/20210205134534.49200-4-tony@atomide.com
This commit is contained in:
Tony Lindgren 2021-02-05 15:45:33 +02:00 коммит произвёл Daniel Lezcano
Родитель 735c35352a
Коммит 514cbabb01
1 изменённых файлов: 14 добавлений и 16 удалений

Просмотреть файл

@ -15,7 +15,6 @@
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
#include <linux/clk.h> #include <linux/clk.h>
#include <linux/delay.h>
#include <linux/gpio/consumer.h> #include <linux/gpio/consumer.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/err.h> #include <linux/err.h>
@ -27,6 +26,7 @@
#include <linux/of_platform.h> #include <linux/of_platform.h>
#include <linux/of_irq.h> #include <linux/of_irq.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/iopoll.h>
#include <linux/cpu_pm.h> #include <linux/cpu_pm.h>
#include <linux/device.h> #include <linux/device.h>
#include <linux/pm_runtime.h> #include <linux/pm_runtime.h>
@ -604,7 +604,9 @@ static int
ti_bandgap_force_single_read(struct ti_bandgap *bgp, int id) ti_bandgap_force_single_read(struct ti_bandgap *bgp, int id)
{ {
struct temp_sensor_registers *tsr = bgp->conf->sensors[id].registers; struct temp_sensor_registers *tsr = bgp->conf->sensors[id].registers;
u32 counter; void __iomem *temp_sensor_ctrl = bgp->base + tsr->temp_sensor_ctrl;
int error;
u32 val;
/* Select continuous or single conversion mode */ /* Select continuous or single conversion mode */
if (TI_BANDGAP_HAS(bgp, MODE_CONFIG)) { if (TI_BANDGAP_HAS(bgp, MODE_CONFIG)) {
@ -619,26 +621,22 @@ ti_bandgap_force_single_read(struct ti_bandgap *bgp, int id)
RMW_BITS(bgp, id, temp_sensor_ctrl, bgap_soc_mask, 1); RMW_BITS(bgp, id, temp_sensor_ctrl, bgap_soc_mask, 1);
/* Wait for EOCZ going up */ /* Wait for EOCZ going up */
counter = 1000; error = readl_poll_timeout_atomic(temp_sensor_ctrl, val,
while (--counter) { val & tsr->bgap_eocz_mask,
if (ti_bandgap_readl(bgp, tsr->temp_sensor_ctrl) & 1, 1000);
tsr->bgap_eocz_mask) if (error)
break; dev_warn(bgp->dev, "eocz timed out waiting high\n");
udelay(1);
}
/* Clear Start of Conversion if available */ /* Clear Start of Conversion if available */
RMW_BITS(bgp, id, temp_sensor_ctrl, bgap_soc_mask, 0); RMW_BITS(bgp, id, temp_sensor_ctrl, bgap_soc_mask, 0);
} }
/* Wait for EOCZ going down, always needed even if no bgap_soc_mask */ /* Wait for EOCZ going down, always needed even if no bgap_soc_mask */
counter = 1000; error = readl_poll_timeout_atomic(temp_sensor_ctrl, val,
while (--counter) { !(val & tsr->bgap_eocz_mask),
if (!(ti_bandgap_readl(bgp, tsr->temp_sensor_ctrl) & 1, 1500);
tsr->bgap_eocz_mask)) if (error)
break; dev_warn(bgp->dev, "eocz timed out waiting low\n");
udelay(1);
}
return 0; return 0;
} }