[media] via-camera: Add suspend/resume support

Add suspend/resume support to the via-camera driver, so that the video
continues streaming over a suspend-resume cycle.

Originally implemented by Jon Corbet.

[mchehab@redhat.com: fix a small CodingStyle issue]
Signed-off-by: Daniel Drake <dsd@laptop.org>
Acked-by: Jonathan Corbet <corbet@lwn.net>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Daniel Drake 2011-02-11 18:15:02 -03:00 committed by Mauro Carvalho Chehab
parent 498e677cfd
commit 0522921c0f
1 changed files with 64 additions and 0 deletions

View File

@ -1246,6 +1246,62 @@ static const struct v4l2_ioctl_ops viacam_ioctl_ops = {
/*
* Power management.
*/
#ifdef CONFIG_PM
static int viacam_suspend(void *priv)
{
struct via_camera *cam = priv;
enum viacam_opstate state = cam->opstate;
if (cam->opstate != S_IDLE) {
viacam_stop_engine(cam);
cam->opstate = state; /* So resume restarts */
}
return 0;
}
static int viacam_resume(void *priv)
{
struct via_camera *cam = priv;
int ret = 0;
/*
* Get back to a reasonable operating state.
*/
via_write_reg_mask(VIASR, 0x78, 0, 0x80);
via_write_reg_mask(VIASR, 0x1e, 0xc0, 0xc0);
viacam_int_disable(cam);
set_bit(CF_CONFIG_NEEDED, &cam->flags);
/*
* Make sure the sensor's power state is correct
*/
if (cam->users > 0)
via_sensor_power_up(cam);
else
via_sensor_power_down(cam);
/*
* If it was operating, try to restart it.
*/
if (cam->opstate != S_IDLE) {
mutex_lock(&cam->lock);
ret = viacam_configure_sensor(cam);
if (!ret)
ret = viacam_config_controller(cam);
mutex_unlock(&cam->lock);
if (!ret)
viacam_start_engine(cam);
}
return ret;
}
static struct viafb_pm_hooks viacam_pm_hooks = {
.suspend = viacam_suspend,
.resume = viacam_resume
};
#endif /* CONFIG_PM */
/*
* Setup stuff.
@ -1369,6 +1425,14 @@ static __devinit int viacam_probe(struct platform_device *pdev)
goto out_irq;
video_set_drvdata(&cam->vdev, cam);
#ifdef CONFIG_PM
/*
* Hook into PM events
*/
viacam_pm_hooks.private = cam;
viafb_pm_register(&viacam_pm_hooks);
#endif
/* Power the sensor down until somebody opens the device */
via_sensor_power_down(cam);
return 0;