From: Raffaele Recalcati <[email protected]>
Signed-off-by: Raffaele Recalcati <[email protected]>
---
drivers/media/video/davinci/vpfe_capture.c | 45 ++++++++++++++++++++++++++++
1 files changed, 45 insertions(+), 0 deletions(-)
diff --git a/drivers/media/video/davinci/vpfe_capture.c
b/drivers/media/video/davinci/vpfe_capture.c
index 353eada..21fa9bf 100644
--- a/drivers/media/video/davinci/vpfe_capture.c
+++ b/drivers/media/video/davinci/vpfe_capture.c
@@ -74,6 +74,8 @@
#include <media/v4l2-common.h>
#include <linux/io.h>
#include <media/davinci/vpfe_capture.h>
+#include <linux/pm.h>
+#include <linux/pm_loss.h>
#include "ccdc_hw_device.h"
static int debug;
@@ -2051,6 +2053,46 @@ static int __devexit vpfe_remove(struct platform_device
*pdev)
return 0;
}
+#ifdef CONFIG_PM_LOSS
+static int vpfe_capture_power_changed(struct device *dev,
+ enum sys_power_state s)
+{
+ int ret;
+ struct vpfe_device *vpfe_dev = dev_get_drvdata(dev);
+ struct vpfe_subdev_info *sdinfo = vpfe_dev->current_subdev;
+
+ if (!sdinfo)
+ return -EINVAL;
+
+ if (!vpfe_dev->started) {
+ pr_debug_pm_loss("vpfe_capture_power_changed(%d) "
+ "BUT NOTHING TO DO\n", s);
+ return 0;
+ }
+
+ sdinfo = vpfe_dev->current_subdev;
+
+ switch (s) {
+ case SYS_PWR_GOOD:
+ pr_debug_pm_loss("vpfe_capture_power_changed(%d)\n", s);
+ ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev,
+ sdinfo->grp_id,
+ video, s_stream, 1);
+ break;
+ case SYS_PWR_FAILING:
+ pr_debug_pm_loss("vpfe_capture_power_changed(%d)\n", s);
+ ret = v4l2_device_call_until_err(&vpfe_dev->v4l2_dev,
+ sdinfo->grp_id,
+ video, s_stream, 0);
+ break;
+ default:
+ BUG();
+ ret = -ENODEV;
+ }
+ return ret;
+}
+#endif /* CONFIG_PM_LOSS */
+
static int vpfe_suspend(struct device *dev)
{
return 0;
@@ -2064,6 +2106,9 @@ static int vpfe_resume(struct device *dev)
static const struct dev_pm_ops vpfe_dev_pm_ops = {
.suspend = vpfe_suspend,
.resume = vpfe_resume,
+#ifdef CONFIG_PM_LOSS
+ .power_changed = vpfe_capture_power_changed,
+#endif
};
static struct platform_driver vpfe_driver = {
--
1.7.0.4
_______________________________________________
Davinci-linux-open-source mailing list
[email protected]
http://linux.davincidsp.com/mailman/listinfo/davinci-linux-open-source
