staging: most: i2c: prevent zero delay polling
This patch avoids that a configured scan_rate of more than MSEC_PER_SEC
might result in a polling delay of zero.
Signed-off-by: Christian Gromm <christian.gromm@microchip.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
diff --git a/drivers/staging/most/i2c/i2c.c b/drivers/staging/most/i2c/i2c.c
index e03cb6c..30d18cc 100644
--- a/drivers/staging/most/i2c/i2c.c
+++ b/drivers/staging/most/i2c/i2c.c
@@ -49,6 +49,7 @@
struct list_head list;
struct mutex list_mutex;
bool int_disabled;
+ unsigned int delay;
} rx;
char name[64];
};
@@ -75,6 +76,7 @@
{
int ret;
struct hdm_i2c *dev = to_hdm(most_iface);
+ unsigned int delay;
BUG_ON(ch_idx < 0 || ch_idx >= NUM_CHANNELS);
BUG_ON(dev->is_open[ch_idx]);
@@ -105,6 +107,8 @@
return ret;
}
} else if (scan_rate) {
+ delay = msecs_to_jiffies(MSEC_PER_SEC / scan_rate);
+ dev->rx.delay = delay ? delay : 1;
pr_info("polling rate is %d Hz\n", scan_rate);
}
}
@@ -265,9 +269,7 @@
if (dev->polling_mode) {
if (dev->is_open[CH_RX] && scan_rate)
- schedule_delayed_work(&dev->rx.dwork,
- msecs_to_jiffies(MSEC_PER_SEC
- / scan_rate));
+ schedule_delayed_work(&dev->rx.dwork, dev->rx.delay);
} else {
dev->rx.int_disabled = false;
enable_irq(dev->client->irq);