diff options
author | Guoniu.Zhou <guoniu.zhou@nxp.com> | 2017-11-10 09:58:20 +0800 |
---|---|---|
committer | Jason Liu <jason.hui.liu@nxp.com> | 2019-02-12 10:29:09 +0800 |
commit | a03d33f3f37f7c40bfa9ed4ee860f10eae6da38b (patch) | |
tree | 6b4bf9c9c7d677b5a11f29956d5bd0e49e1f41e1 /drivers/media/platform/imx8/mxc-mipi-csi2.c | |
parent | 2de551167d02bd1c42bb7828249fe6fe9089685c (diff) |
MLK-16695-1: mipi_csi: Add pm suspend and resume
Add mipi_csi power manager suspend and resume support.
Reviewed-by: Sandor Yu <sandor.yu@nxp.com>
Signed-off-by: Guoniu.Zhou <guoniu.zhou@nxp.com>
Diffstat (limited to 'drivers/media/platform/imx8/mxc-mipi-csi2.c')
-rw-r--r-- | drivers/media/platform/imx8/mxc-mipi-csi2.c | 49 |
1 files changed, 48 insertions, 1 deletions
diff --git a/drivers/media/platform/imx8/mxc-mipi-csi2.c b/drivers/media/platform/imx8/mxc-mipi-csi2.c index 3143152c9e31..1cf55249522b 100644 --- a/drivers/media/platform/imx8/mxc-mipi-csi2.c +++ b/drivers/media/platform/imx8/mxc-mipi-csi2.c @@ -589,6 +589,8 @@ static int mipi_csi2_probe(struct platform_device *pdev) csi2dev->num_lanes, csi2dev->sd.name); csi2dev->running = 0; + csi2dev->flags = MXC_MIPI_CSI2_PM_POWERED; + return 0; e_clkdis: @@ -608,6 +610,50 @@ static int mipi_csi2_remove(struct platform_device *pdev) return 0; } +static int mipi_csi2_pm_suspend(struct device *dev) +{ + struct mxc_mipi_csi2_dev *csi2dev = dev_get_drvdata(dev); + struct v4l2_subdev *sd = &csi2dev->sd; + + if (csi2dev->flags & MXC_MIPI_CSI2_PM_SUSPENDED) + return 0; + + if (csi2dev->running) + mipi_csi2_s_stream(sd, false); + mipi_csi2_clk_disable(csi2dev); + csi2dev->flags &= ~MXC_MIPI_CSI2_PM_POWERED; + csi2dev->flags |= MXC_MIPI_CSI2_PM_SUSPENDED; + + return 0; +} + +static int mipi_csi2_pm_resume(struct device *dev) +{ + struct mxc_mipi_csi2_dev *csi2dev = dev_get_drvdata(dev); + struct v4l2_subdev *sd = &csi2dev->sd; + int ret; + + if (csi2dev->flags & MXC_MIPI_CSI2_PM_POWERED) + return 0; + + ret = mipi_csi2_clk_enable(csi2dev); + if (ret < 0) { + dev_info(dev, "%s:%d fail\n", __func__, __LINE__); + return -EAGAIN; + } + + if (csi2dev->running) + mipi_csi2_s_stream(sd, true); + csi2dev->flags |= MXC_MIPI_CSI2_PM_POWERED; + csi2dev->flags &= ~MXC_MIPI_CSI2_PM_SUSPENDED; + + return 0; +} + +static const struct dev_pm_ops mipi_csi_pm_ops = { + SET_SYSTEM_SLEEP_PM_OPS(mipi_csi2_pm_suspend, mipi_csi2_pm_resume) +}; + static const struct of_device_id mipi_csi2_of_match[] = { { .compatible = "fsl,mxc-mipi-csi2",}, { /* sentinel */ }, @@ -618,7 +664,8 @@ MODULE_DEVICE_TABLE(of, mipi_csi2_of_match); static struct platform_driver mipi_csi2_driver = { .driver = { .name = MXC_MIPI_CSI2_DRIVER_NAME, - .of_match_table = mipi_csi2_of_match, + .of_match_table = mipi_csi2_of_match, + .pm = &mipi_csi_pm_ops, }, .probe = mipi_csi2_probe, .remove = mipi_csi2_remove, |