input: add suspend wakeup support to sh_keysc
This patch adds wakeup support to the sh_keysc driver. With this feature the ".../power/wakeup" file can be used to enable and disable if the device takes the system out of suspend. Default is enabled. Signed-off-by: Magnus Damm <damm@igel.co.jp> Signed-off-by: Paul Mundt <lethal@linux-sh.org>
This commit is contained in:
parent
508407149a
commit
a29b99ecce
1 changed files with 25 additions and 4 deletions
|
@ -219,6 +219,8 @@ static int __devinit sh_keysc_probe(struct platform_device *pdev)
|
||||||
pdata->scan_timing, priv->iomem_base + KYCR1_OFFS);
|
pdata->scan_timing, priv->iomem_base + KYCR1_OFFS);
|
||||||
iowrite16(0, priv->iomem_base + KYOUTDR_OFFS);
|
iowrite16(0, priv->iomem_base + KYOUTDR_OFFS);
|
||||||
iowrite16(KYCR2_IRQ_LEVEL, priv->iomem_base + KYCR2_OFFS);
|
iowrite16(KYCR2_IRQ_LEVEL, priv->iomem_base + KYCR2_OFFS);
|
||||||
|
|
||||||
|
device_init_wakeup(&pdev->dev, 1);
|
||||||
return 0;
|
return 0;
|
||||||
err5:
|
err5:
|
||||||
free_irq(irq, pdev);
|
free_irq(irq, pdev);
|
||||||
|
@ -253,17 +255,36 @@ static int __devexit sh_keysc_remove(struct platform_device *pdev)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int sh_keysc_suspend(struct device *dev)
|
||||||
|
{
|
||||||
|
struct platform_device *pdev;
|
||||||
|
struct sh_keysc_priv *priv;
|
||||||
|
unsigned short value;
|
||||||
|
|
||||||
#define sh_keysc_suspend NULL
|
pdev = container_of(dev, struct platform_device, dev);
|
||||||
#define sh_keysc_resume NULL
|
priv = platform_get_drvdata(pdev);
|
||||||
|
|
||||||
|
value = ioread16(priv->iomem_base + KYCR1_OFFS);
|
||||||
|
|
||||||
|
if (device_may_wakeup(dev))
|
||||||
|
value |= 0x80;
|
||||||
|
else
|
||||||
|
value &= ~0x80;
|
||||||
|
|
||||||
|
iowrite16(value, priv->iomem_base + KYCR1_OFFS);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct dev_pm_ops sh_keysc_dev_pm_ops = {
|
||||||
|
.suspend = sh_keysc_suspend,
|
||||||
|
};
|
||||||
|
|
||||||
struct platform_driver sh_keysc_device_driver = {
|
struct platform_driver sh_keysc_device_driver = {
|
||||||
.probe = sh_keysc_probe,
|
.probe = sh_keysc_probe,
|
||||||
.remove = __devexit_p(sh_keysc_remove),
|
.remove = __devexit_p(sh_keysc_remove),
|
||||||
.suspend = sh_keysc_suspend,
|
|
||||||
.resume = sh_keysc_resume,
|
|
||||||
.driver = {
|
.driver = {
|
||||||
.name = "sh_keysc",
|
.name = "sh_keysc",
|
||||||
|
.pm = &sh_keysc_dev_pm_ops,
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
Loading…
Add table
Reference in a new issue