Commit 1068feca authored by Mylène Josserand's avatar Mylène Josserand Committed by Mauro Carvalho Chehab
Browse files

media: ov5640: Add light frequency control 



Add the light frequency control to be able to set the frequency
to manual (50Hz or 60Hz) or auto.

[Sakari Ailus: Rename "ctl" as "ctrl" as agreed.]
[mchehab+samsung@kernel.org: fixed two coding style warnings]

Signed-off-by: default avatarMylène Josserand <mylene.josserand@bootlin.com>
Signed-off-by: default avatarMaxime Ripard <maxime.ripard@bootlin.com>
Reviewed-by: default avatarLaurent Pinchart <laurent.pinchart@ideasonboard.com>
Signed-off-by: default avatarSakari Ailus <sakari.ailus@linux.intel.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab+samsung@kernel.org>
parent deb9eec6

drivers/media/i2c/ov5640.c

+25 −0
Original line number Diff line number Diff line
@@ -187,6 +187,7 @@ struct ov5640_ctrls { 
		struct v4l2_ctrl *gain;

	};

	struct v4l2_ctrl *brightness;

	struct v4l2_ctrl *light_freq;

	struct v4l2_ctrl *saturation;

	struct v4l2_ctrl *contrast;

	struct v4l2_ctrl *hue;
@@ -2155,6 +2156,21 @@ static int ov5640_set_ctrl_test_pattern(struct ov5640_dev *sensor, int value) 
			      0xa4, value ? 0xa4 : 0);

}



static int ov5640_set_ctrl_light_freq(struct ov5640_dev *sensor, int value)

{

	int ret;



	ret = ov5640_mod_reg(sensor, OV5640_REG_HZ5060_CTRL01, BIT(7),

			     (value == V4L2_CID_POWER_LINE_FREQUENCY_AUTO) ?

			     0 : BIT(7));

	if (ret)

		return ret;



	return ov5640_mod_reg(sensor, OV5640_REG_HZ5060_CTRL00, BIT(2),

			      (value == V4L2_CID_POWER_LINE_FREQUENCY_50HZ) ?

			      BIT(2) : 0);

}



static int ov5640_g_volatile_ctrl(struct v4l2_ctrl *ctrl)

{

	struct v4l2_subdev *sd = ctrl_to_sd(ctrl);
@@ -2223,6 +2239,9 @@ static int ov5640_s_ctrl(struct v4l2_ctrl *ctrl) 
	case V4L2_CID_TEST_PATTERN:

		ret = ov5640_set_ctrl_test_pattern(sensor, ctrl->val);

		break;

	case V4L2_CID_POWER_LINE_FREQUENCY:

		ret = ov5640_set_ctrl_light_freq(sensor, ctrl->val);

		break;

	default:

		ret = -EINVAL;

		break;
@@ -2285,6 +2304,12 @@ static int ov5640_init_controls(struct ov5640_dev *sensor) 
					     ARRAY_SIZE(test_pattern_menu) - 1,

					     0, 0, test_pattern_menu);



	ctrls->light_freq =

		v4l2_ctrl_new_std_menu(hdl, ops,

				       V4L2_CID_POWER_LINE_FREQUENCY,

				       V4L2_CID_POWER_LINE_FREQUENCY_AUTO, 0,

				       V4L2_CID_POWER_LINE_FREQUENCY_50HZ);



	if (hdl->error) {

		ret = hdl->error;

		goto free_ctrls;

CRA Git | Maintained and supported by SUSTech CRA and CCSE