V4L/DVB (11526): gspca - m5602-mt9m111: Add red balance ctrl (0746673d) · Commits · 戴 / test

drivers/media/video/gspca/m5602/m5602_mt9m111.c

+48 −0

Original line number	Diff line number	Diff line
		@@ -32,6 +32,8 @@ static int mt9m111_get_green_balance(struct gspca_dev gspca_dev, __s32 val);
		static int mt9m111_set_green_balance(struct gspca_dev *gspca_dev, __s32 val);
		static int mt9m111_get_blue_balance(struct gspca_dev gspca_dev, __s32 val);
		static int mt9m111_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val);
		static int mt9m111_get_red_balance(struct gspca_dev gspca_dev, __s32 val);
		static int mt9m111_set_red_balance(struct gspca_dev *gspca_dev, __s32 val);

		static struct v4l2_pix_format mt9m111_modes[] = {
		{
		@@ -134,6 +136,21 @@ const static struct ctrl mt9m111_ctrls[] = {
		.set = mt9m111_set_blue_balance,
		.get = mt9m111_get_blue_balance
		},
		#define RED_BALANCE_IDX 5
		{
		{
		.id = V4L2_CID_RED_BALANCE,
		.type = V4L2_CTRL_TYPE_INTEGER,
		.name = "red balance",
		.minimum = 0x00,
		.maximum = 0x7ff,
		.step = 0x1,
		.default_value = MT9M111_RED_GAIN_DEFAULT,
		.flags = V4L2_CTRL_FLAG_SLIDER
		},
		.set = mt9m111_set_red_balance,
		.get = mt9m111_get_red_balance
		},
		};

		static void mt9m111_dump_registers(struct sd *sd);
		@@ -240,6 +257,11 @@ int mt9m111_init(struct sd *sd)
		if (err < 0)
		return err;

		err = mt9m111_set_red_balance(&sd->gspca_dev,
		sensor_settings[RED_BALANCE_IDX]);
		if (err < 0)
		return err;

		return mt9m111_set_gain(&sd->gspca_dev, sensor_settings[GAIN_IDX]);
		}

		@@ -462,6 +484,32 @@ static int mt9m111_get_blue_balance(struct gspca_dev gspca_dev, __s32 val)
		return 0;
		}

		static int mt9m111_set_red_balance(struct gspca_dev *gspca_dev, __s32 val)
		{
		u8 data[2];
		struct sd sd = (struct sd ) gspca_dev;
		s32 *sensor_settings = sd->sensor_priv;

		sensor_settings[RED_BALANCE_IDX] = val;
		data[0] = (val & 0xff);
		data[1] = (val & 0xff00) >> 8;

		PDEBUG(D_V4L2, "Set red balance %d", val);

		return m5602_write_sensor(sd, MT9M111_SC_RED_GAIN,
		data, 2);
		}

		static int mt9m111_get_red_balance(struct gspca_dev gspca_dev, __s32 val)
		{
		struct sd sd = (struct sd ) gspca_dev;
		s32 *sensor_settings = sd->sensor_priv;

		*val = sensor_settings[RED_BALANCE_IDX];
		PDEBUG(D_V4L2, "Read red balance %d", *val);
		return 0;
		}

		static void mt9m111_dump_registers(struct sd *sd)
		{
		u8 address, value[2] = {0x00, 0x00};

drivers/media/video/gspca/m5602/m5602_mt9m111.h

+1 −0

Original line number	Diff line number	Diff line
		@@ -95,6 +95,7 @@
		#define DEFAULT_GAIN 283
		#define MT9M111_GREEN_GAIN_DEFAULT 0x20
		#define MT9M111_BLUE_GAIN_DEFAULT 0x20
		#define MT9M111_RED_GAIN_DEFAULT 0x20

		/*****************************************************************************/

Admin message