[media] V4L: soc-camera: call subdevice .s_power() method, when powering up or down

Currently soc-camera can use power regulators and platform specific
methods to power clients up and down. Additionally, client drivers can
provide their own subdevice .s_power() methods, acting directly on the
device. This patch adds calls to this method, when external power
supplies are on.

Signed-off-by: Guennadi Liakhovetski <g.liakhovetski@gmx.de>
Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Guennadi Liakhovetski 2011-09-08 04:36:06 -03:00 committed by Mauro Carvalho Chehab
parent fff96b6685
commit 7b9d8c3c4c

View File

@ -53,10 +53,9 @@ static DEFINE_MUTEX(list_lock); /* Protects the list of hosts */
static int soc_camera_power_on(struct soc_camera_device *icd, static int soc_camera_power_on(struct soc_camera_device *icd,
struct soc_camera_link *icl) struct soc_camera_link *icl)
{ {
int ret; struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
int ret = regulator_bulk_enable(icl->num_regulators,
ret = regulator_bulk_enable(icl->num_regulators, icl->regulators);
icl->regulators);
if (ret < 0) { if (ret < 0) {
dev_err(icd->pdev, "Cannot enable regulators\n"); dev_err(icd->pdev, "Cannot enable regulators\n");
return ret; return ret;
@ -67,19 +66,33 @@ static int soc_camera_power_on(struct soc_camera_device *icd,
if (ret < 0) { if (ret < 0) {
dev_err(icd->pdev, dev_err(icd->pdev,
"Platform failed to power-on the camera.\n"); "Platform failed to power-on the camera.\n");
goto elinkpwr;
regulator_bulk_disable(icl->num_regulators,
icl->regulators);
} }
} }
ret = v4l2_subdev_call(sd, core, s_power, 1);
if (ret < 0 && ret != -ENOIOCTLCMD && ret != -ENODEV)
goto esdpwr;
return 0;
esdpwr:
if (icl->power)
icl->power(icd->pdev, 0);
elinkpwr:
regulator_bulk_disable(icl->num_regulators,
icl->regulators);
return ret; return ret;
} }
static int soc_camera_power_off(struct soc_camera_device *icd, static int soc_camera_power_off(struct soc_camera_device *icd,
struct soc_camera_link *icl) struct soc_camera_link *icl)
{ {
int ret; struct v4l2_subdev *sd = soc_camera_to_subdev(icd);
int ret = v4l2_subdev_call(sd, core, s_power, 0);
if (ret < 0 && ret != -ENOIOCTLCMD && ret != -ENODEV)
return ret;
if (icl->power) { if (icl->power) {
ret = icl->power(icd->pdev, 0); ret = icl->power(icd->pdev, 0);
@ -1029,6 +1042,12 @@ static int soc_camera_probe(struct soc_camera_device *icd)
if (ret < 0) if (ret < 0)
goto ereg; goto ereg;
/*
* This will not yet call v4l2_subdev_core_ops::s_power(1), because the
* subdevice has not been initialised yet. We'll have to call it once
* again after initialisation, even though it shouldn't be needed, we
* don't do any IO here.
*/
ret = soc_camera_power_on(icd, icl); ret = soc_camera_power_on(icd, icl);
if (ret < 0) if (ret < 0)
goto epower; goto epower;
@ -1099,6 +1118,10 @@ static int soc_camera_probe(struct soc_camera_device *icd)
if (ret < 0) if (ret < 0)
goto evidstart; goto evidstart;
ret = v4l2_subdev_call(sd, core, s_power, 1);
if (ret < 0 && ret != -ENOIOCTLCMD)
goto esdpwr;
/* Try to improve our guess of a reasonable window format */ /* Try to improve our guess of a reasonable window format */
if (!v4l2_subdev_call(sd, video, g_mbus_fmt, &mf)) { if (!v4l2_subdev_call(sd, video, g_mbus_fmt, &mf)) {
icd->user_width = mf.width; icd->user_width = mf.width;
@ -1115,6 +1138,8 @@ static int soc_camera_probe(struct soc_camera_device *icd)
return 0; return 0;
esdpwr:
video_unregister_device(icd->vdev);
evidstart: evidstart:
mutex_unlock(&icd->video_lock); mutex_unlock(&icd->video_lock);
soc_camera_free_user_formats(icd); soc_camera_free_user_formats(icd);
@ -1129,6 +1154,7 @@ ectrl:
enodrv: enodrv:
eadddev: eadddev:
video_device_release(icd->vdev); video_device_release(icd->vdev);
icd->vdev = NULL;
evdc: evdc:
ici->ops->remove(icd); ici->ops->remove(icd);
eadd: eadd: