mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-21 16:29:59 +00:00
watchdog: intel-mid_wdt: Convert to use new SCU IPC API
This converts the Intel MID watchdog driver over the new SCU IPC API where the SCU IPC instance is passed to the functions. Signed-off-by: Mika Westerberg <mika.westerberg@linux.intel.com> Acked-by: Guenter Roeck <linux@roeck-us.net> Reviewed-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Signed-off-by: Lee Jones <lee.jones@linaro.org>
This commit is contained in:
parent
595694bd38
commit
80ae679b8f
1 changed files with 37 additions and 16 deletions
|
@ -33,14 +33,24 @@ enum {
|
||||||
SCU_WATCHDOG_KEEPALIVE,
|
SCU_WATCHDOG_KEEPALIVE,
|
||||||
};
|
};
|
||||||
|
|
||||||
static inline int wdt_command(int sub, u32 *in, int inlen)
|
struct mid_wdt {
|
||||||
|
struct watchdog_device wd;
|
||||||
|
struct device *dev;
|
||||||
|
struct intel_scu_ipc_dev *scu;
|
||||||
|
};
|
||||||
|
|
||||||
|
static inline int
|
||||||
|
wdt_command(struct mid_wdt *mid, int sub, const void *in, size_t inlen, size_t size)
|
||||||
{
|
{
|
||||||
return intel_scu_ipc_command(IPC_WATCHDOG, sub, in, inlen, NULL, 0);
|
struct intel_scu_ipc_dev *scu = mid->scu;
|
||||||
|
|
||||||
|
return intel_scu_ipc_dev_command_with_size(scu, IPC_WATCHDOG, sub, in,
|
||||||
|
inlen, size, NULL, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int wdt_start(struct watchdog_device *wd)
|
static int wdt_start(struct watchdog_device *wd)
|
||||||
{
|
{
|
||||||
struct device *dev = watchdog_get_drvdata(wd);
|
struct mid_wdt *mid = watchdog_get_drvdata(wd);
|
||||||
int ret, in_size;
|
int ret, in_size;
|
||||||
int timeout = wd->timeout;
|
int timeout = wd->timeout;
|
||||||
struct ipc_wd_start {
|
struct ipc_wd_start {
|
||||||
|
@ -49,38 +59,41 @@ static int wdt_start(struct watchdog_device *wd)
|
||||||
} ipc_wd_start = { timeout - MID_WDT_PRETIMEOUT, timeout };
|
} ipc_wd_start = { timeout - MID_WDT_PRETIMEOUT, timeout };
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* SCU expects the input size for watchdog IPC to
|
* SCU expects the input size for watchdog IPC to be 2 which is the
|
||||||
* be based on 4 bytes
|
* size of the structure in dwords. SCU IPC normally takes bytes
|
||||||
|
* but this is a special case where we specify size to be different
|
||||||
|
* than inlen.
|
||||||
*/
|
*/
|
||||||
in_size = DIV_ROUND_UP(sizeof(ipc_wd_start), 4);
|
in_size = DIV_ROUND_UP(sizeof(ipc_wd_start), 4);
|
||||||
|
|
||||||
ret = wdt_command(SCU_WATCHDOG_START, (u32 *)&ipc_wd_start, in_size);
|
ret = wdt_command(mid, SCU_WATCHDOG_START, &ipc_wd_start,
|
||||||
|
sizeof(ipc_wd_start), in_size);
|
||||||
if (ret)
|
if (ret)
|
||||||
dev_crit(dev, "error starting watchdog: %d\n", ret);
|
dev_crit(mid->dev, "error starting watchdog: %d\n", ret);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int wdt_ping(struct watchdog_device *wd)
|
static int wdt_ping(struct watchdog_device *wd)
|
||||||
{
|
{
|
||||||
struct device *dev = watchdog_get_drvdata(wd);
|
struct mid_wdt *mid = watchdog_get_drvdata(wd);
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
ret = wdt_command(SCU_WATCHDOG_KEEPALIVE, NULL, 0);
|
ret = wdt_command(mid, SCU_WATCHDOG_KEEPALIVE, NULL, 0, 0);
|
||||||
if (ret)
|
if (ret)
|
||||||
dev_crit(dev, "Error executing keepalive: %d\n", ret);
|
dev_crit(mid->dev, "Error executing keepalive: %d\n", ret);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int wdt_stop(struct watchdog_device *wd)
|
static int wdt_stop(struct watchdog_device *wd)
|
||||||
{
|
{
|
||||||
struct device *dev = watchdog_get_drvdata(wd);
|
struct mid_wdt *mid = watchdog_get_drvdata(wd);
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
ret = wdt_command(SCU_WATCHDOG_STOP, NULL, 0);
|
ret = wdt_command(mid, SCU_WATCHDOG_STOP, NULL, 0, 0);
|
||||||
if (ret)
|
if (ret)
|
||||||
dev_crit(dev, "Error stopping watchdog: %d\n", ret);
|
dev_crit(mid->dev, "Error stopping watchdog: %d\n", ret);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
@ -110,6 +123,7 @@ static int mid_wdt_probe(struct platform_device *pdev)
|
||||||
struct device *dev = &pdev->dev;
|
struct device *dev = &pdev->dev;
|
||||||
struct watchdog_device *wdt_dev;
|
struct watchdog_device *wdt_dev;
|
||||||
struct intel_mid_wdt_pdata *pdata = dev->platform_data;
|
struct intel_mid_wdt_pdata *pdata = dev->platform_data;
|
||||||
|
struct mid_wdt *mid;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
if (!pdata) {
|
if (!pdata) {
|
||||||
|
@ -123,10 +137,13 @@ static int mid_wdt_probe(struct platform_device *pdev)
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
wdt_dev = devm_kzalloc(dev, sizeof(*wdt_dev), GFP_KERNEL);
|
mid = devm_kzalloc(dev, sizeof(*mid), GFP_KERNEL);
|
||||||
if (!wdt_dev)
|
if (!mid)
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
|
|
||||||
|
mid->dev = dev;
|
||||||
|
wdt_dev = &mid->wd;
|
||||||
|
|
||||||
wdt_dev->info = &mid_wdt_info;
|
wdt_dev->info = &mid_wdt_info;
|
||||||
wdt_dev->ops = &mid_wdt_ops;
|
wdt_dev->ops = &mid_wdt_ops;
|
||||||
wdt_dev->min_timeout = MID_WDT_TIMEOUT_MIN;
|
wdt_dev->min_timeout = MID_WDT_TIMEOUT_MIN;
|
||||||
|
@ -135,7 +152,7 @@ static int mid_wdt_probe(struct platform_device *pdev)
|
||||||
wdt_dev->parent = dev;
|
wdt_dev->parent = dev;
|
||||||
|
|
||||||
watchdog_set_nowayout(wdt_dev, WATCHDOG_NOWAYOUT);
|
watchdog_set_nowayout(wdt_dev, WATCHDOG_NOWAYOUT);
|
||||||
watchdog_set_drvdata(wdt_dev, dev);
|
watchdog_set_drvdata(wdt_dev, mid);
|
||||||
|
|
||||||
ret = devm_request_irq(dev, pdata->irq, mid_wdt_irq,
|
ret = devm_request_irq(dev, pdata->irq, mid_wdt_irq,
|
||||||
IRQF_SHARED | IRQF_NO_SUSPEND, "watchdog",
|
IRQF_SHARED | IRQF_NO_SUSPEND, "watchdog",
|
||||||
|
@ -145,6 +162,10 @@ static int mid_wdt_probe(struct platform_device *pdev)
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
mid->scu = devm_intel_scu_ipc_dev_get(dev);
|
||||||
|
if (!mid->scu)
|
||||||
|
return -EPROBE_DEFER;
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* The firmware followed by U-Boot leaves the watchdog running
|
* The firmware followed by U-Boot leaves the watchdog running
|
||||||
* with the default threshold which may vary. When we get here
|
* with the default threshold which may vary. When we get here
|
||||||
|
|
Loading…
Reference in a new issue