Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit f9826514 authored by Guennadi Liakhovetski's avatar Guennadi Liakhovetski Committed by Mauro Carvalho Chehab
Browse files

V4L/DVB (11347): mt9t031: use platform power hook



Use platform power hook to turn the camera on and off.

Signed-off-by: default avatarGuennadi Liakhovetski <lg@denx.de>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 6252d257
Loading
Loading
Loading
Loading
+21 −0
Original line number Diff line number Diff line
@@ -141,8 +141,19 @@ static int get_shutter(struct soc_camera_device *icd, u32 *data)

static int mt9t031_init(struct soc_camera_device *icd)
{
	struct mt9t031 *mt9t031 = container_of(icd, struct mt9t031, icd);
	struct soc_camera_link *icl = mt9t031->client->dev.platform_data;
	int ret;

	if (icl->power) {
		ret = icl->power(&mt9t031->client->dev, 1);
		if (ret < 0) {
			dev_err(icd->vdev->parent,
				"Platform failed to power-on the camera.\n");
			return ret;
		}
	}

	/* Disable chip output, synchronous option update */
	ret = reg_write(icd, MT9T031_RESET, 1);
	if (ret >= 0)
@@ -150,13 +161,23 @@ static int mt9t031_init(struct soc_camera_device *icd)
	if (ret >= 0)
		ret = reg_clear(icd, MT9T031_OUTPUT_CONTROL, 2);

	if (ret < 0 && icl->power)
		icl->power(&mt9t031->client->dev, 0);

	return ret >= 0 ? 0 : -EIO;
}

static int mt9t031_release(struct soc_camera_device *icd)
{
	struct mt9t031 *mt9t031 = container_of(icd, struct mt9t031, icd);
	struct soc_camera_link *icl = mt9t031->client->dev.platform_data;

	/* Disable the chip */
	reg_clear(icd, MT9T031_OUTPUT_CONTROL, 2);

	if (icl->power)
		icl->power(&mt9t031->client->dev, 0);

	return 0;
}