diff options
Diffstat (limited to 'drivers/media/platform/imx8/mxc-isi-core.c')
| -rw-r--r-- | drivers/media/platform/imx8/mxc-isi-core.c | 37 |
1 files changed, 37 insertions, 0 deletions
diff --git a/drivers/media/platform/imx8/mxc-isi-core.c b/drivers/media/platform/imx8/mxc-isi-core.c index 7f4c2eefb057..dfa985f6dd38 100644 --- a/drivers/media/platform/imx8/mxc-isi-core.c +++ b/drivers/media/platform/imx8/mxc-isi-core.c @@ -174,6 +174,8 @@ static int mxc_isi_probe(struct platform_device *pdev) goto err_sclk; } + mxc_isi->flags = MXC_ISI_PM_POWERED; + dev_dbg(dev, "mxc_isi.%d registered successfully\n", mxc_isi->id); return 0; @@ -194,6 +196,40 @@ static int mxc_isi_remove(struct platform_device *pdev) return 0; } +#ifdef CONFIG_PM_SLEEP +static int mxc_isi_pm_suspend(struct device *dev) +{ + struct mxc_isi_dev *mxc_isi = dev_get_drvdata(dev); + + if (mxc_isi->flags & MXC_ISI_PM_SUSPENDED) + return 0; + + clk_disable_unprepare(mxc_isi->clk); + mxc_isi->flags |= MXC_ISI_PM_SUSPENDED; + mxc_isi->flags &= ~MXC_ISI_PM_POWERED; + + return 0; +} + +static int mxc_isi_pm_resume(struct device *dev) +{ + struct mxc_isi_dev *mxc_isi = dev_get_drvdata(dev); + int ret; + + if (mxc_isi->flags & MXC_ISI_PM_POWERED) + return 0; + + mxc_isi->flags |= MXC_ISI_PM_POWERED; + mxc_isi->flags &= ~MXC_ISI_PM_SUSPENDED; + + ret = clk_prepare_enable(mxc_isi->clk); + return (ret) ? -EAGAIN : 0; +} + +static const struct dev_pm_ops mxc_isi_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(mxc_isi_pm_suspend, mxc_isi_pm_resume) +}; + static const struct of_device_id mxc_isi_of_match[] = { {.compatible = "fsl,imx8-isi",}, { /* sentinel */ }, @@ -206,6 +242,7 @@ static struct platform_driver mxc_isi_driver = { .driver = { .of_match_table = mxc_isi_of_match, .name = MXC_ISI_DRIVER_NAME, + .pm = &mxc_isi_pm_ops, } }; |