mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-30 11:41:38 -04:00
watchdog: imgpdc: Set timeout before starting watchdog
Set up the watchdog for the specified timeout before attempting to start it. Signed-off-by: Naidu Tellapati <[email protected]> Signed-off-by: Andrew Bresticker <[email protected]> Reviewed-by: Ezequiel Garcia <[email protected]> Tested-by: Ezequiel Garcia <[email protected]> Cc: James Hogan <[email protected]> Reviewed-by: Guenter Roeck <[email protected]> Signed-off-by: Wim Van Sebroeck <[email protected]>
This commit is contained in:
parent
7094e1dd2b
commit
8aa453a533
1 changed files with 13 additions and 5 deletions
|
|
@ -84,18 +84,24 @@ static int pdc_wdt_stop(struct watchdog_device *wdt_dev)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void __pdc_wdt_set_timeout(struct pdc_wdt_dev *wdt)
|
||||
{
|
||||
unsigned long clk_rate = clk_get_rate(wdt->wdt_clk);
|
||||
unsigned int val;
|
||||
|
||||
val = readl(wdt->base + PDC_WDT_CONFIG) & ~PDC_WDT_CONFIG_DELAY_MASK;
|
||||
val |= order_base_2(wdt->wdt_dev.timeout * clk_rate) - 1;
|
||||
writel(val, wdt->base + PDC_WDT_CONFIG);
|
||||
}
|
||||
|
||||
static int pdc_wdt_set_timeout(struct watchdog_device *wdt_dev,
|
||||
unsigned int new_timeout)
|
||||
{
|
||||
unsigned int val;
|
||||
struct pdc_wdt_dev *wdt = watchdog_get_drvdata(wdt_dev);
|
||||
unsigned long clk_rate = clk_get_rate(wdt->wdt_clk);
|
||||
|
||||
wdt->wdt_dev.timeout = new_timeout;
|
||||
|
||||
val = readl(wdt->base + PDC_WDT_CONFIG) & ~PDC_WDT_CONFIG_DELAY_MASK;
|
||||
val |= order_base_2(new_timeout * clk_rate) - 1;
|
||||
writel(val, wdt->base + PDC_WDT_CONFIG);
|
||||
__pdc_wdt_set_timeout(wdt);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
@ -106,6 +112,8 @@ static int pdc_wdt_start(struct watchdog_device *wdt_dev)
|
|||
unsigned int val;
|
||||
struct pdc_wdt_dev *wdt = watchdog_get_drvdata(wdt_dev);
|
||||
|
||||
__pdc_wdt_set_timeout(wdt);
|
||||
|
||||
val = readl(wdt->base + PDC_WDT_CONFIG);
|
||||
val |= PDC_WDT_CONFIG_ENABLE;
|
||||
writel(val, wdt->base + PDC_WDT_CONFIG);
|
||||
|
|
|
|||
Loading…
Reference in a new issue