[linux-2.6-block.git] / drivers / media / video / gspca / m5602 / m5602_mt9m111.c

/*
 * Driver for the mt9m111 sensor
 *
 * Copyright (C) 2008 Erik Andrén
 * Copyright (C) 2007 Ilyes Gouta. Based on the m5603x Linux Driver Project.
 * Copyright (C) 2005 m5603x Linux Driver Project <m5602@x3ng.com.br>
 *
 * Portions of code to USB interface and ALi driver software,
 * Copyright (c) 2006 Willem Duinker
 * v4l2 interface modeled after the V4L2 driver
 * for SN9C10x PC Camera Controllers
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation, version 2.
 *
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include "m5602_mt9m111.h"

static int mt9m111_set_vflip(struct gspca_dev *gspca_dev, __s32 val);
static int mt9m111_get_vflip(struct gspca_dev *gspca_dev, __s32 *val);
static int mt9m111_get_hflip(struct gspca_dev *gspca_dev, __s32 *val);
static int mt9m111_set_hflip(struct gspca_dev *gspca_dev, __s32 val);
static int mt9m111_get_gain(struct gspca_dev *gspca_dev, __s32 *val);
static int mt9m111_set_gain(struct gspca_dev *gspca_dev, __s32 val);
static int mt9m111_set_auto_white_balance(struct gspca_dev *gspca_dev,
					 __s32 val);
static int mt9m111_get_auto_white_balance(struct gspca_dev *gspca_dev,
					  __s32 *val);
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[] = {
	{
		640,
		480,
		V4L2_PIX_FMT_SBGGR8,
		V4L2_FIELD_NONE,
		.sizeimage = 640 * 480,
		.bytesperline = 640,
		.colorspace = V4L2_COLORSPACE_SRGB,
		.priv = 0
	}
};

static const struct ctrl mt9m111_ctrls[] = {
#define VFLIP_IDX 0
	{
		{
			.id		= V4L2_CID_VFLIP,
			.type           = V4L2_CTRL_TYPE_BOOLEAN,
			.name           = "vertical flip",
			.minimum        = 0,
			.maximum        = 1,
			.step           = 1,
			.default_value  = 0
		},
		.set = mt9m111_set_vflip,
		.get = mt9m111_get_vflip
	},
#define HFLIP_IDX 1
	{
		{
			.id             = V4L2_CID_HFLIP,
			.type           = V4L2_CTRL_TYPE_BOOLEAN,
			.name           = "horizontal flip",
			.minimum        = 0,
			.maximum        = 1,
			.step           = 1,
			.default_value  = 0
		},
		.set = mt9m111_set_hflip,
		.get = mt9m111_get_hflip
	},
#define GAIN_IDX 2
	{
		{
			.id             = V4L2_CID_GAIN,
			.type           = V4L2_CTRL_TYPE_INTEGER,
			.name           = "gain",
			.minimum        = 0,
			.maximum        = (INITIAL_MAX_GAIN - 1) * 2 * 2 * 2,
			.step           = 1,
			.default_value  = MT9M111_DEFAULT_GAIN,
			.flags          = V4L2_CTRL_FLAG_SLIDER
		},
		.set = mt9m111_set_gain,
		.get = mt9m111_get_gain
	},
#define AUTO_WHITE_BALANCE_IDX 3
	{
		{
			.id             = V4L2_CID_AUTO_WHITE_BALANCE,
			.type           = V4L2_CTRL_TYPE_BOOLEAN,
			.name           = "auto white balance",
			.minimum        = 0,
			.maximum        = 1,
			.step           = 1,
			.default_value  = 0,
		},
		.set = mt9m111_set_auto_white_balance,
		.get = mt9m111_get_auto_white_balance
	},
#define GREEN_BALANCE_IDX 4
	{
		{
			.id		= M5602_V4L2_CID_GREEN_BALANCE,
			.type		= V4L2_CTRL_TYPE_INTEGER,
			.name		= "green balance",
			.minimum	= 0x00,
			.maximum	= 0x7ff,
			.step		= 0x1,
			.default_value	= MT9M111_GREEN_GAIN_DEFAULT,
			.flags		= V4L2_CTRL_FLAG_SLIDER
		},
		.set = mt9m111_set_green_balance,
		.get = mt9m111_get_green_balance
	},
#define BLUE_BALANCE_IDX 5
	{
		{
			.id		= V4L2_CID_BLUE_BALANCE,
			.type		= V4L2_CTRL_TYPE_INTEGER,
			.name		= "blue balance",
			.minimum	= 0x00,
			.maximum	= 0x7ff,
			.step		= 0x1,
			.default_value	= MT9M111_BLUE_GAIN_DEFAULT,
			.flags		= V4L2_CTRL_FLAG_SLIDER
		},
		.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);

int mt9m111_probe(struct sd *sd)
{
	u8 data[2] = {0x00, 0x00};
	int i;
	s32 *sensor_settings;

	if (force_sensor) {
		if (force_sensor == MT9M111_SENSOR) {
			pr_info("Forcing a %s sensor\n", mt9m111.name);
			goto sensor_found;
		}
		/* If we want to force another sensor, don't try to probe this
		 * one */
		return -ENODEV;
	}

	PDEBUG(D_PROBE, "Probing for a mt9m111 sensor");

	/* Do the preinit */
	for (i = 0; i < ARRAY_SIZE(preinit_mt9m111); i++) {
		if (preinit_mt9m111[i][0] == BRIDGE) {
			m5602_write_bridge(sd,
				preinit_mt9m111[i][1],
				preinit_mt9m111[i][2]);
		} else {
			data[0] = preinit_mt9m111[i][2];
			data[1] = preinit_mt9m111[i][3];
			m5602_write_sensor(sd,
				preinit_mt9m111[i][1], data, 2);
		}
	}

	if (m5602_read_sensor(sd, MT9M111_SC_CHIPVER, data, 2))
		return -ENODEV;

	if ((data[0] == 0x14) && (data[1] == 0x3a)) {
		pr_info("Detected a mt9m111 sensor\n");
		goto sensor_found;
	}

	return -ENODEV;

sensor_found:
	sensor_settings = kmalloc(ARRAY_SIZE(mt9m111_ctrls) * sizeof(s32),
				  GFP_KERNEL);
	if (!sensor_settings)
		return -ENOMEM;

	sd->gspca_dev.cam.cam_mode = mt9m111_modes;
	sd->gspca_dev.cam.nmodes = ARRAY_SIZE(mt9m111_modes);
	sd->desc->ctrls = mt9m111_ctrls;
	sd->desc->nctrls = ARRAY_SIZE(mt9m111_ctrls);

	for (i = 0; i < ARRAY_SIZE(mt9m111_ctrls); i++)
		sensor_settings[i] = mt9m111_ctrls[i].qctrl.default_value;
	sd->sensor_priv = sensor_settings;

	return 0;
}

int mt9m111_init(struct sd *sd)
{
	int i, err = 0;
	s32 *sensor_settings = sd->sensor_priv;

	/* Init the sensor */
	for (i = 0; i < ARRAY_SIZE(init_mt9m111) && !err; i++) {
		u8 data[2];

		if (init_mt9m111[i][0] == BRIDGE) {
			err = m5602_write_bridge(sd,
				init_mt9m111[i][1],
				init_mt9m111[i][2]);
		} else {
			data[0] = init_mt9m111[i][2];
			data[1] = init_mt9m111[i][3];
			err = m5602_write_sensor(sd,
				init_mt9m111[i][1], data, 2);
		}
	}

	if (dump_sensor)
		mt9m111_dump_registers(sd);

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

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

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

	err = mt9m111_set_blue_balance(&sd->gspca_dev,
					 sensor_settings[BLUE_BALANCE_IDX]);
	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]);
}

int mt9m111_start(struct sd *sd)
{
	int i, err = 0;
	u8 data[2];
	struct cam *cam = &sd->gspca_dev.cam;
	s32 *sensor_settings = sd->sensor_priv;

	int width = cam->cam_mode[sd->gspca_dev.curr_mode].width - 1;
	int height = cam->cam_mode[sd->gspca_dev.curr_mode].height;

	for (i = 0; i < ARRAY_SIZE(start_mt9m111) && !err; i++) {
		if (start_mt9m111[i][0] == BRIDGE) {
			err = m5602_write_bridge(sd,
				start_mt9m111[i][1],
				start_mt9m111[i][2]);
		} else {
			data[0] = start_mt9m111[i][2];
			data[1] = start_mt9m111[i][3];
			err = m5602_write_sensor(sd,
				start_mt9m111[i][1], data, 2);
		}
	}
	if (err < 0)
		return err;

	err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, (height >> 8) & 0xff);
	if (err < 0)
		return err;

	err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, (height & 0xff));
	if (err < 0)
		return err;

	for (i = 0; i < 2 && !err; i++)
		err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, 0);
	if (err < 0)
		return err;

	err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 0);
	if (err < 0)
		return err;

	err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 2);
	if (err < 0)
		return err;

	for (i = 0; i < 2 && !err; i++)
		err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, 0);
	if (err < 0)
		return err;

	err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA,
				 (width >> 8) & 0xff);
	if (err < 0)
		return err;

	err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, width & 0xff);
	if (err < 0)
		return err;

	err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 0);
	if (err < 0)
		return err;

	switch (width) {
	case 640:
		PDEBUG(D_V4L2, "Configuring camera for VGA mode");
		data[0] = MT9M111_RMB_OVER_SIZED;
		data[1] = MT9M111_RMB_ROW_SKIP_2X |
			  MT9M111_RMB_COLUMN_SKIP_2X |
			  (sensor_settings[VFLIP_IDX] << 0) |
			  (sensor_settings[HFLIP_IDX] << 1);

		err = m5602_write_sensor(sd,
					 MT9M111_SC_R_MODE_CONTEXT_B, data, 2);
		break;

	case 320:
		PDEBUG(D_V4L2, "Configuring camera for QVGA mode");
		data[0] = MT9M111_RMB_OVER_SIZED;
		data[1] = MT9M111_RMB_ROW_SKIP_4X |
				MT9M111_RMB_COLUMN_SKIP_4X |
				(sensor_settings[VFLIP_IDX] << 0) |
				(sensor_settings[HFLIP_IDX] << 1);
		err = m5602_write_sensor(sd,
					 MT9M111_SC_R_MODE_CONTEXT_B, data, 2);
		break;
	}
	return err;
}

void mt9m111_disconnect(struct sd *sd)
{
	sd->sensor = NULL;
	kfree(sd->sensor_priv);
}

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

	*val = sensor_settings[VFLIP_IDX];
	PDEBUG(D_V4L2, "Read vertical flip %d", *val);

	return 0;
}

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

	PDEBUG(D_V4L2, "Set vertical flip to %d", val);

	sensor_settings[VFLIP_IDX] = val;

	/* The mt9m111 is flipped by default */
	val = !val;

	/* Set the correct page map */
	err = m5602_write_sensor(sd, MT9M111_PAGE_MAP, data, 2);
	if (err < 0)
		return err;

	err = m5602_read_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B, data, 2);
	if (err < 0)
		return err;

	data[1] = (data[1] & 0xfe) | val;
	err = m5602_write_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B,
				   data, 2);
	return err;
}

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

	*val = sensor_settings[HFLIP_IDX];
	PDEBUG(D_V4L2, "Read horizontal flip %d", *val);

	return 0;
}

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

	PDEBUG(D_V4L2, "Set horizontal flip to %d", val);

	sensor_settings[HFLIP_IDX] = val;

	/* The mt9m111 is flipped by default */
	val = !val;

	/* Set the correct page map */
	err = m5602_write_sensor(sd, MT9M111_PAGE_MAP, data, 2);
	if (err < 0)
		return err;

	err = m5602_read_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B, data, 2);
	if (err < 0)
		return err;

	data[1] = (data[1] & 0xfd) | ((val << 1) & 0x02);
	err = m5602_write_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B,
					data, 2);
	return err;
}

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

	*val = sensor_settings[GAIN_IDX];
	PDEBUG(D_V4L2, "Read gain %d", *val);

	return 0;
}

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

	err = m5602_read_sensor(sd, MT9M111_CP_OPERATING_MODE_CTL, data, 2);
	if (err < 0)
		return err;

	sensor_settings[AUTO_WHITE_BALANCE_IDX] = val & 0x01;
	data[1] = ((data[1] & 0xfd) | ((val & 0x01) << 1));

	err = m5602_write_sensor(sd, MT9M111_CP_OPERATING_MODE_CTL, data, 2);

	PDEBUG(D_V4L2, "Set auto white balance %d", val);
	return err;
}

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

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

static int mt9m111_set_gain(struct gspca_dev *gspca_dev, __s32 val)
{
	int err, tmp;
	u8 data[2] = {0x00, 0x00};
	struct sd *sd = (struct sd *) gspca_dev;
	s32 *sensor_settings = sd->sensor_priv;

	sensor_settings[GAIN_IDX] = val;

	/* Set the correct page map */
	err = m5602_write_sensor(sd, MT9M111_PAGE_MAP, data, 2);
	if (err < 0)
		return err;

	if (val >= INITIAL_MAX_GAIN * 2 * 2 * 2)
		return -EINVAL;

	if ((val >= INITIAL_MAX_GAIN * 2 * 2) &&
	    (val < (INITIAL_MAX_GAIN - 1) * 2 * 2 * 2))
		tmp = (1 << 10) | (val << 9) |
				(val << 8) | (val / 8);
	else if ((val >= INITIAL_MAX_GAIN * 2) &&
		 (val <  INITIAL_MAX_GAIN * 2 * 2))
		tmp = (1 << 9) | (1 << 8) | (val / 4);
	else if ((val >= INITIAL_MAX_GAIN) &&
		 (val < INITIAL_MAX_GAIN * 2))
		tmp = (1 << 8) | (val / 2);
	else
		tmp = val;

	data[1] = (tmp & 0xff);
	data[0] = (tmp & 0xff00) >> 8;
	PDEBUG(D_V4L2, "tmp=%d, data[1]=%d, data[0]=%d", tmp,
	       data[1], data[0]);

	err = m5602_write_sensor(sd, MT9M111_SC_GLOBAL_GAIN,
				   data, 2);

	return err;
}

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

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

	PDEBUG(D_V4L2, "Set green balance %d", val);
	err = m5602_write_sensor(sd, MT9M111_SC_GREEN_1_GAIN,
				 data, 2);
	if (err < 0)
		return err;

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

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

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

static int mt9m111_set_blue_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[BLUE_BALANCE_IDX] = val;
	data[1] = (val & 0xff);
	data[0] = (val & 0xff00) >> 8;

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

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

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

	*val = sensor_settings[BLUE_BALANCE_IDX];
	PDEBUG(D_V4L2, "Read blue balance %d", *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[1] = (val & 0xff);
	data[0] = (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};

	pr_info("Dumping the mt9m111 register state\n");

	pr_info("Dumping the mt9m111 sensor core registers\n");
	value[1] = MT9M111_SENSOR_CORE;
	m5602_write_sensor(sd, MT9M111_PAGE_MAP, value, 2);
	for (address = 0; address < 0xff; address++) {
		m5602_read_sensor(sd, address, value, 2);
		pr_info("register 0x%x contains 0x%x%x\n",
			address, value[0], value[1]);
	}

	pr_info("Dumping the mt9m111 color pipeline registers\n");
	value[1] = MT9M111_COLORPIPE;
	m5602_write_sensor(sd, MT9M111_PAGE_MAP, value, 2);
	for (address = 0; address < 0xff; address++) {
		m5602_read_sensor(sd, address, value, 2);
		pr_info("register 0x%x contains 0x%x%x\n",
			address, value[0], value[1]);
	}

	pr_info("Dumping the mt9m111 camera control registers\n");
	value[1] = MT9M111_CAMERA_CONTROL;
	m5602_write_sensor(sd, MT9M111_PAGE_MAP, value, 2);
	for (address = 0; address < 0xff; address++) {
		m5602_read_sensor(sd, address, value, 2);
		pr_info("register 0x%x contains 0x%x%x\n",
			address, value[0], value[1]);
	}

	pr_info("mt9m111 register state dump complete\n");
}
Commit	Line	Data
c109f816 EA	1	/*
	2	* Driver for the mt9m111 sensor
	3	*
0c505e68	4	* Copyright (C) 2008 Erik Andrén
c109f816 EA	5	* Copyright (C) 2007 Ilyes Gouta. Based on the m5603x Linux Driver Project.
	6	* Copyright (C) 2005 m5603x Linux Driver Project <m5602@x3ng.com.br>
	7	*
	8	* Portions of code to USB interface and ALi driver software,
	9	* Copyright (c) 2006 Willem Duinker
	10	* v4l2 interface modeled after the V4L2 driver
	11	* for SN9C10x PC Camera Controllers
	12	*
	13	* This program is free software; you can redistribute it and/or
	14	* modify it under the terms of the GNU General Public License as
	15	* published by the Free Software Foundation, version 2.
	16	*
	17	*/
	18
bdfe91f4 JP	19	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
bdfe91f4 JP	20
c109f816 EA	21	#include "m5602_mt9m111.h"
c109f816 EA	22
cf811d50 EA	23	static int mt9m111_set_vflip(struct gspca_dev *gspca_dev, __s32 val);
	24	static int mt9m111_get_vflip(struct gspca_dev gspca_dev, __s32 val);
	25	static int mt9m111_get_hflip(struct gspca_dev gspca_dev, __s32 val);
	26	static int mt9m111_set_hflip(struct gspca_dev *gspca_dev, __s32 val);
	27	static int mt9m111_get_gain(struct gspca_dev gspca_dev, __s32 val);
	28	static int mt9m111_set_gain(struct gspca_dev *gspca_dev, __s32 val);
b154044a EA	29	static int mt9m111_set_auto_white_balance(struct gspca_dev *gspca_dev,
	30	__s32 val);
	31	static int mt9m111_get_auto_white_balance(struct gspca_dev *gspca_dev,
	32	__s32 *val);
12e4ed7d EA	33	static int mt9m111_get_green_balance(struct gspca_dev gspca_dev, __s32 val);
12e4ed7d EA	34	static int mt9m111_set_green_balance(struct gspca_dev *gspca_dev, __s32 val);
74b123cf EA	35	static int mt9m111_get_blue_balance(struct gspca_dev gspca_dev, __s32 val);
74b123cf EA	36	static int mt9m111_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val);
0746673d EA	37	static int mt9m111_get_red_balance(struct gspca_dev gspca_dev, __s32 val);
0746673d EA	38	static int mt9m111_set_red_balance(struct gspca_dev *gspca_dev, __s32 val);
cf811d50	39
74cadfe1 EA	40	static struct v4l2_pix_format mt9m111_modes[] = {
	41	{
	42	640,
	43	480,
	44	V4L2_PIX_FMT_SBGGR8,
	45	V4L2_FIELD_NONE,
	46	.sizeimage = 640 * 480,
	47	.bytesperline = 640,
	48	.colorspace = V4L2_COLORSPACE_SRGB,
	49	.priv = 0
	50	}
	51	};
	52
f0ecba96	53	static const struct ctrl mt9m111_ctrls[] = {
04f15655	54	#define VFLIP_IDX 0
e17cc08c EA	55	{
	56	{
	57	.id = V4L2_CID_VFLIP,
	58	.type = V4L2_CTRL_TYPE_BOOLEAN,
	59	.name = "vertical flip",
	60	.minimum = 0,
	61	.maximum = 1,
	62	.step = 1,
c731e271	63	.default_value = 0
e17cc08c EA	64	},
	65	.set = mt9m111_set_vflip,
	66	.get = mt9m111_get_vflip
04f15655 EA	67	},
	68	#define HFLIP_IDX 1
	69	{
e17cc08c EA	70	{
	71	.id = V4L2_CID_HFLIP,
	72	.type = V4L2_CTRL_TYPE_BOOLEAN,
	73	.name = "horizontal flip",
	74	.minimum = 0,
	75	.maximum = 1,
	76	.step = 1,
c731e271	77	.default_value = 0
e17cc08c EA	78	},
	79	.set = mt9m111_set_hflip,
	80	.get = mt9m111_get_hflip
04f15655 EA	81	},
	82	#define GAIN_IDX 2
	83	{
e17cc08c EA	84	{
	85	.id = V4L2_CID_GAIN,
	86	.type = V4L2_CTRL_TYPE_INTEGER,
	87	.name = "gain",
	88	.minimum = 0,
	89	.maximum = (INITIAL_MAX_GAIN - 1) * 2 * 2 * 2,
	90	.step = 1,
72b79747	91	.default_value = MT9M111_DEFAULT_GAIN,
e17cc08c EA	92	.flags = V4L2_CTRL_FLAG_SLIDER
	93	},
	94	.set = mt9m111_set_gain,
	95	.get = mt9m111_get_gain
b154044a EA	96	},
	97	#define AUTO_WHITE_BALANCE_IDX 3
	98	{
	99	{
	100	.id = V4L2_CID_AUTO_WHITE_BALANCE,
	101	.type = V4L2_CTRL_TYPE_BOOLEAN,
	102	.name = "auto white balance",
	103	.minimum = 0,
	104	.maximum = 1,
	105	.step = 1,
	106	.default_value = 0,
	107	},
	108	.set = mt9m111_set_auto_white_balance,
	109	.get = mt9m111_get_auto_white_balance
12e4ed7d EA	110	},
	111	#define GREEN_BALANCE_IDX 4
	112	{
	113	{
780e3121 JFM	114	.id = M5602_V4L2_CID_GREEN_BALANCE,
	115	.type = V4L2_CTRL_TYPE_INTEGER,
	116	.name = "green balance",
	117	.minimum = 0x00,
	118	.maximum = 0x7ff,
	119	.step = 0x1,
	120	.default_value = MT9M111_GREEN_GAIN_DEFAULT,
	121	.flags = V4L2_CTRL_FLAG_SLIDER
12e4ed7d EA	122	},
	123	.set = mt9m111_set_green_balance,
	124	.get = mt9m111_get_green_balance
	125	},
74b123cf EA	126	#define BLUE_BALANCE_IDX 5
	127	{
	128	{
780e3121 JFM	129	.id = V4L2_CID_BLUE_BALANCE,
	130	.type = V4L2_CTRL_TYPE_INTEGER,
	131	.name = "blue balance",
	132	.minimum = 0x00,
	133	.maximum = 0x7ff,
	134	.step = 0x1,
	135	.default_value = MT9M111_BLUE_GAIN_DEFAULT,
	136	.flags = V4L2_CTRL_FLAG_SLIDER
74b123cf EA	137	},
	138	.set = mt9m111_set_blue_balance,
	139	.get = mt9m111_get_blue_balance
	140	},
0746673d EA	141	#define RED_BALANCE_IDX 5
	142	{
	143	{
780e3121 JFM	144	.id = V4L2_CID_RED_BALANCE,
	145	.type = V4L2_CTRL_TYPE_INTEGER,
	146	.name = "red balance",
	147	.minimum = 0x00,
	148	.maximum = 0x7ff,
	149	.step = 0x1,
	150	.default_value = MT9M111_RED_GAIN_DEFAULT,
	151	.flags = V4L2_CTRL_FLAG_SLIDER
0746673d EA	152	},
	153	.set = mt9m111_set_red_balance,
	154	.get = mt9m111_get_red_balance
	155	},
e17cc08c EA	156	};
e17cc08c EA	157
658efb63 EA	158	static void mt9m111_dump_registers(struct sd *sd);
658efb63 EA	159
c109f816 EA	160	int mt9m111_probe(struct sd *sd)
	161	{
	162	u8 data[2] = {0x00, 0x00};
	163	int i;
04f15655	164	s32 *sensor_settings;
c109f816 EA	165
	166	if (force_sensor) {
	167	if (force_sensor == MT9M111_SENSOR) {
bdfe91f4	168	pr_info("Forcing a %s sensor\n", mt9m111.name);
c109f816 EA	169	goto sensor_found;
	170	}
	171	/* If we want to force another sensor, don't try to probe this
	172	* one */
	173	return -ENODEV;
	174	}
	175
969cc926	176	PDEBUG(D_PROBE, "Probing for a mt9m111 sensor");
c109f816 EA	177
	178	/* Do the preinit */
	179	for (i = 0; i < ARRAY_SIZE(preinit_mt9m111); i++) {
	180	if (preinit_mt9m111[i][0] == BRIDGE) {
	181	m5602_write_bridge(sd,
	182	preinit_mt9m111[i][1],
	183	preinit_mt9m111[i][2]);
	184	} else {
	185	data[0] = preinit_mt9m111[i][2];
	186	data[1] = preinit_mt9m111[i][3];
6dc4cff0	187	m5602_write_sensor(sd,
c109f816 EA	188	preinit_mt9m111[i][1], data, 2);
	189	}
	190	}
	191
4f93c450	192	if (m5602_read_sensor(sd, MT9M111_SC_CHIPVER, data, 2))
c109f816 EA	193	return -ENODEV;
	194
	195	if ((data[0] == 0x14) && (data[1] == 0x3a)) {
bdfe91f4	196	pr_info("Detected a mt9m111 sensor\n");
c109f816 EA	197	goto sensor_found;
	198	}
	199
	200	return -ENODEV;
	201
	202	sensor_found:
cf811d50 EA	203	sensor_settings = kmalloc(ARRAY_SIZE(mt9m111_ctrls) * sizeof(s32),
cf811d50 EA	204	GFP_KERNEL);
04f15655 EA	205	if (!sensor_settings)
	206	return -ENOMEM;
	207
74cadfe1 EA	208	sd->gspca_dev.cam.cam_mode = mt9m111_modes;
74cadfe1 EA	209	sd->gspca_dev.cam.nmodes = ARRAY_SIZE(mt9m111_modes);
e17cc08c	210	sd->desc->ctrls = mt9m111_ctrls;
e4cc4fcc	211	sd->desc->nctrls = ARRAY_SIZE(mt9m111_ctrls);
04f15655 EA	212
	213	for (i = 0; i < ARRAY_SIZE(mt9m111_ctrls); i++)
	214	sensor_settings[i] = mt9m111_ctrls[i].qctrl.default_value;
	215	sd->sensor_priv = sensor_settings;
	216
c109f816 EA	217	return 0;
	218	}
	219
	220	int mt9m111_init(struct sd *sd)
	221	{
f1918fa2	222	int i, err = 0;
dd3ec398	223	s32 *sensor_settings = sd->sensor_priv;
c109f816 EA	224
c109f816 EA	225	/* Init the sensor */
8bcbc911	226	for (i = 0; i < ARRAY_SIZE(init_mt9m111) && !err; i++) {
c109f816 EA	227	u8 data[2];
	228
	229	if (init_mt9m111[i][0] == BRIDGE) {
	230	err = m5602_write_bridge(sd,
	231	init_mt9m111[i][1],
	232	init_mt9m111[i][2]);
	233	} else {
	234	data[0] = init_mt9m111[i][2];
	235	data[1] = init_mt9m111[i][3];
6dc4cff0	236	err = m5602_write_sensor(sd,
c109f816 EA	237	init_mt9m111[i][1], data, 2);
	238	}
	239	}
	240
36e756c5 EA	241	if (dump_sensor)
	242	mt9m111_dump_registers(sd);
	243
dd3ec398 EA	244	err = mt9m111_set_vflip(&sd->gspca_dev, sensor_settings[VFLIP_IDX]);
	245	if (err < 0)
	246	return err;
	247
	248	err = mt9m111_set_hflip(&sd->gspca_dev, sensor_settings[HFLIP_IDX]);
	249	if (err < 0)
	250	return err;
	251
12e4ed7d EA	252	err = mt9m111_set_green_balance(&sd->gspca_dev,
	253	sensor_settings[GREEN_BALANCE_IDX]);
	254	if (err < 0)
	255	return err;
c109f816	256
74b123cf EA	257	err = mt9m111_set_blue_balance(&sd->gspca_dev,
	258	sensor_settings[BLUE_BALANCE_IDX]);
	259	if (err < 0)
	260	return err;
	261
0746673d EA	262	err = mt9m111_set_red_balance(&sd->gspca_dev,
	263	sensor_settings[RED_BALANCE_IDX]);
	264	if (err < 0)
	265	return err;
	266
12e4ed7d	267	return mt9m111_set_gain(&sd->gspca_dev, sensor_settings[GAIN_IDX]);
c109f816 EA	268	}
c109f816 EA	269
bce0d2d4 EA	270	int mt9m111_start(struct sd *sd)
	271	{
	272	int i, err = 0;
	273	u8 data[2];
e7ae60f7	274	struct cam *cam = &sd->gspca_dev.cam;
f676bb39	275	s32 *sensor_settings = sd->sensor_priv;
e7ae60f7	276
f676bb39	277	int width = cam->cam_mode[sd->gspca_dev.curr_mode].width - 1;
e7ae60f7	278	int height = cam->cam_mode[sd->gspca_dev.curr_mode].height;
bce0d2d4 EA	279
	280	for (i = 0; i < ARRAY_SIZE(start_mt9m111) && !err; i++) {
	281	if (start_mt9m111[i][0] == BRIDGE) {
	282	err = m5602_write_bridge(sd,
	283	start_mt9m111[i][1],
	284	start_mt9m111[i][2]);
	285	} else {
	286	data[0] = start_mt9m111[i][2];
	287	data[1] = start_mt9m111[i][3];
	288	err = m5602_write_sensor(sd,
	289	start_mt9m111[i][1], data, 2);
	290	}
	291	}
e7ae60f7 EA	292	if (err < 0)
	293	return err;
	294
	295	err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, (height >> 8) & 0xff);
	296	if (err < 0)
	297	return err;
	298
	299	err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, (height & 0xff));
	300	if (err < 0)
	301	return err;
	302
	303	for (i = 0; i < 2 && !err; i++)
	304	err = m5602_write_bridge(sd, M5602_XB_VSYNC_PARA, 0);
	305	if (err < 0)
	306	return err;
	307
	308	err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 0);
	309	if (err < 0)
	310	return err;
	311
	312	err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 2);
	313	if (err < 0)
	314	return err;
	315
	316	for (i = 0; i < 2 && !err; i++)
	317	err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, 0);
	318	if (err < 0)
	319	return err;
	320
	321	err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA,
	322	(width >> 8) & 0xff);
	323	if (err < 0)
	324	return err;
	325
	326	err = m5602_write_bridge(sd, M5602_XB_HSYNC_PARA, width & 0xff);
	327	if (err < 0)
	328	return err;
	329
	330	err = m5602_write_bridge(sd, M5602_XB_SIG_INI, 0);
	331	if (err < 0)
	332	return err;
	333
	334	switch (width) {
	335	case 640:
	336	PDEBUG(D_V4L2, "Configuring camera for VGA mode");
f676bb39 EA	337	data[0] = MT9M111_RMB_OVER_SIZED;
	338	data[1] = MT9M111_RMB_ROW_SKIP_2X \|
	339	MT9M111_RMB_COLUMN_SKIP_2X \|
	340	(sensor_settings[VFLIP_IDX] << 0) \|
	341	(sensor_settings[HFLIP_IDX] << 1);
	342
1b844b53 EA	343	err = m5602_write_sensor(sd,
1b844b53 EA	344	MT9M111_SC_R_MODE_CONTEXT_B, data, 2);
e7ae60f7	345	break;
60ed6e4f EA	346
	347	case 320:
	348	PDEBUG(D_V4L2, "Configuring camera for QVGA mode");
	349	data[0] = MT9M111_RMB_OVER_SIZED;
	350	data[1] = MT9M111_RMB_ROW_SKIP_4X \|
	351	MT9M111_RMB_COLUMN_SKIP_4X \|
	352	(sensor_settings[VFLIP_IDX] << 0) \|
	353	(sensor_settings[HFLIP_IDX] << 1);
1b844b53 EA	354	err = m5602_write_sensor(sd,
1b844b53 EA	355	MT9M111_SC_R_MODE_CONTEXT_B, data, 2);
60ed6e4f	356	break;
e7ae60f7	357	}
bce0d2d4 EA	358	return err;
	359	}
	360
04f15655 EA	361	void mt9m111_disconnect(struct sd *sd)
	362	{
	363	sd->sensor = NULL;
	364	kfree(sd->sensor_priv);
	365	}
	366
cf811d50	367	static int mt9m111_get_vflip(struct gspca_dev gspca_dev, __s32 val)
c109f816	368	{
c109f816	369	struct sd sd = (struct sd ) gspca_dev;
04f15655	370	s32 *sensor_settings = sd->sensor_priv;
c109f816	371
04f15655	372	*val = sensor_settings[VFLIP_IDX];
17ea88ae	373	PDEBUG(D_V4L2, "Read vertical flip %d", *val);
c109f816	374
04f15655	375	return 0;
c109f816 EA	376	}
c109f816 EA	377
cf811d50	378	static int mt9m111_set_vflip(struct gspca_dev *gspca_dev, __s32 val)
c109f816 EA	379	{
	380	int err;
	381	u8 data[2] = {0x00, 0x00};
	382	struct sd sd = (struct sd ) gspca_dev;
04f15655	383	s32 *sensor_settings = sd->sensor_priv;
c109f816	384
17ea88ae	385	PDEBUG(D_V4L2, "Set vertical flip to %d", val);
c109f816	386
04f15655 EA	387	sensor_settings[VFLIP_IDX] = val;
04f15655 EA	388
c731e271 EA	389	/* The mt9m111 is flipped by default */
	390	val = !val;
	391
c109f816	392	/* Set the correct page map */
6dc4cff0	393	err = m5602_write_sensor(sd, MT9M111_PAGE_MAP, data, 2);
c109f816	394	if (err < 0)
051781b3	395	return err;
c109f816	396
4f93c450	397	err = m5602_read_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B, data, 2);
c109f816	398	if (err < 0)
051781b3	399	return err;
c109f816	400
5a41c9f6	401	data[1] = (data[1] & 0xfe) \| val;
6dc4cff0	402	err = m5602_write_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B,
c109f816	403	data, 2);
8bcbc911	404	return err;
c109f816 EA	405	}
c109f816 EA	406
cf811d50	407	static int mt9m111_get_hflip(struct gspca_dev gspca_dev, __s32 val)
c109f816	408	{
c109f816	409	struct sd sd = (struct sd ) gspca_dev;
04f15655	410	s32 *sensor_settings = sd->sensor_priv;
c109f816	411
04f15655	412	*val = sensor_settings[HFLIP_IDX];
17ea88ae	413	PDEBUG(D_V4L2, "Read horizontal flip %d", *val);
c109f816	414
04f15655	415	return 0;
c109f816 EA	416	}
c109f816 EA	417
cf811d50	418	static int mt9m111_set_hflip(struct gspca_dev *gspca_dev, __s32 val)
c109f816 EA	419	{
	420	int err;
	421	u8 data[2] = {0x00, 0x00};
	422	struct sd sd = (struct sd ) gspca_dev;
04f15655	423	s32 *sensor_settings = sd->sensor_priv;
c109f816	424
17ea88ae	425	PDEBUG(D_V4L2, "Set horizontal flip to %d", val);
c109f816	426
04f15655	427	sensor_settings[HFLIP_IDX] = val;
c731e271 EA	428
	429	/* The mt9m111 is flipped by default */
	430	val = !val;
	431
c109f816	432	/* Set the correct page map */
6dc4cff0	433	err = m5602_write_sensor(sd, MT9M111_PAGE_MAP, data, 2);
c109f816	434	if (err < 0)
051781b3	435	return err;
c109f816	436
4f93c450	437	err = m5602_read_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B, data, 2);
c109f816	438	if (err < 0)
051781b3	439	return err;
c109f816	440
5a41c9f6	441	data[1] = (data[1] & 0xfd) \| ((val << 1) & 0x02);
6dc4cff0	442	err = m5602_write_sensor(sd, MT9M111_SC_R_MODE_CONTEXT_B,
c109f816	443	data, 2);
8bcbc911	444	return err;
c109f816 EA	445	}
c109f816 EA	446
cf811d50	447	static int mt9m111_get_gain(struct gspca_dev gspca_dev, __s32 val)
c109f816	448	{
c109f816	449	struct sd sd = (struct sd ) gspca_dev;
04f15655	450	s32 *sensor_settings = sd->sensor_priv;
c109f816	451
04f15655	452	*val = sensor_settings[GAIN_IDX];
17ea88ae	453	PDEBUG(D_V4L2, "Read gain %d", *val);
c109f816	454
04f15655	455	return 0;
c109f816 EA	456	}
c109f816 EA	457
b154044a EA	458	static int mt9m111_set_auto_white_balance(struct gspca_dev *gspca_dev,
	459	__s32 val)
	460	{
	461	struct sd sd = (struct sd ) gspca_dev;
	462	s32 *sensor_settings = sd->sensor_priv;
	463	int err;
	464	u8 data[2];
	465
	466	err = m5602_read_sensor(sd, MT9M111_CP_OPERATING_MODE_CTL, data, 2);
	467	if (err < 0)
	468	return err;
	469
	470	sensor_settings[AUTO_WHITE_BALANCE_IDX] = val & 0x01;
5a41c9f6	471	data[1] = ((data[1] & 0xfd) \| ((val & 0x01) << 1));
b154044a EA	472
	473	err = m5602_write_sensor(sd, MT9M111_CP_OPERATING_MODE_CTL, data, 2);
	474
	475	PDEBUG(D_V4L2, "Set auto white balance %d", val);
	476	return err;
	477	}
	478
	479	static int mt9m111_get_auto_white_balance(struct gspca_dev *gspca_dev,
	480	__s32 *val) {
	481	struct sd sd = (struct sd ) gspca_dev;
	482	s32 *sensor_settings = sd->sensor_priv;
	483
	484	*val = sensor_settings[AUTO_WHITE_BALANCE_IDX];
	485	PDEBUG(D_V4L2, "Read auto white balance %d", *val);
	486	return 0;
	487	}
	488
cf811d50	489	static int mt9m111_set_gain(struct gspca_dev *gspca_dev, __s32 val)
c109f816 EA	490	{
	491	int err, tmp;
	492	u8 data[2] = {0x00, 0x00};
	493	struct sd sd = (struct sd ) gspca_dev;
04f15655 EA	494	s32 *sensor_settings = sd->sensor_priv;
	495
	496	sensor_settings[GAIN_IDX] = val;
c109f816 EA	497
c109f816 EA	498	/* Set the correct page map */
6dc4cff0	499	err = m5602_write_sensor(sd, MT9M111_PAGE_MAP, data, 2);
c109f816	500	if (err < 0)
051781b3	501	return err;
c109f816 EA	502
	503	if (val >= INITIAL_MAX_GAIN * 2 * 2 * 2)
	504	return -EINVAL;
	505
	506	if ((val >= INITIAL_MAX_GAIN * 2 * 2) &&
	507	(val < (INITIAL_MAX_GAIN - 1) * 2 * 2 * 2))
	508	tmp = (1 << 10) \| (val << 9) \|
	509	(val << 8) \| (val / 8);
	510	else if ((val >= INITIAL_MAX_GAIN * 2) &&
	511	(val < INITIAL_MAX_GAIN * 2 * 2))
	512	tmp = (1 << 9) \| (1 << 8) \| (val / 4);
	513	else if ((val >= INITIAL_MAX_GAIN) &&
	514	(val < INITIAL_MAX_GAIN * 2))
	515	tmp = (1 << 8) \| (val / 2);
	516	else
	517	tmp = val;
	518
5a41c9f6 EA	519	data[1] = (tmp & 0xff);
5a41c9f6 EA	520	data[0] = (tmp & 0xff00) >> 8;
17ea88ae	521	PDEBUG(D_V4L2, "tmp=%d, data[1]=%d, data[0]=%d", tmp,
c109f816 EA	522	data[1], data[0]);
c109f816 EA	523
6dc4cff0	524	err = m5602_write_sensor(sd, MT9M111_SC_GLOBAL_GAIN,
c109f816	525	data, 2);
051781b3	526
8bcbc911	527	return err;
c109f816 EA	528	}
c109f816 EA	529
12e4ed7d EA	530	static int mt9m111_set_green_balance(struct gspca_dev *gspca_dev, __s32 val)
	531	{
	532	int err;
	533	u8 data[2];
	534	struct sd sd = (struct sd ) gspca_dev;
	535	s32 *sensor_settings = sd->sensor_priv;
	536
	537	sensor_settings[GREEN_BALANCE_IDX] = val;
5a41c9f6 EA	538	data[1] = (val & 0xff);
5a41c9f6 EA	539	data[0] = (val & 0xff00) >> 8;
12e4ed7d EA	540
	541	PDEBUG(D_V4L2, "Set green balance %d", val);
	542	err = m5602_write_sensor(sd, MT9M111_SC_GREEN_1_GAIN,
	543	data, 2);
	544	if (err < 0)
	545	return err;
	546
	547	return m5602_write_sensor(sd, MT9M111_SC_GREEN_2_GAIN,
	548	data, 2);
	549	}
	550
	551	static int mt9m111_get_green_balance(struct gspca_dev gspca_dev, __s32 val)
	552	{
	553	struct sd sd = (struct sd ) gspca_dev;
	554	s32 *sensor_settings = sd->sensor_priv;
	555
	556	*val = sensor_settings[GREEN_BALANCE_IDX];
	557	PDEBUG(D_V4L2, "Read green balance %d", *val);
	558	return 0;
	559	}
	560
74b123cf EA	561	static int mt9m111_set_blue_balance(struct gspca_dev *gspca_dev, __s32 val)
	562	{
	563	u8 data[2];
	564	struct sd sd = (struct sd ) gspca_dev;
	565	s32 *sensor_settings = sd->sensor_priv;
	566
	567	sensor_settings[BLUE_BALANCE_IDX] = val;
5a41c9f6 EA	568	data[1] = (val & 0xff);
5a41c9f6 EA	569	data[0] = (val & 0xff00) >> 8;
74b123cf EA	570
	571	PDEBUG(D_V4L2, "Set blue balance %d", val);
	572
	573	return m5602_write_sensor(sd, MT9M111_SC_BLUE_GAIN,
	574	data, 2);
	575	}
	576
	577	static int mt9m111_get_blue_balance(struct gspca_dev gspca_dev, __s32 val)
	578	{
	579	struct sd sd = (struct sd ) gspca_dev;
	580	s32 *sensor_settings = sd->sensor_priv;
	581
	582	*val = sensor_settings[BLUE_BALANCE_IDX];
	583	PDEBUG(D_V4L2, "Read blue balance %d", *val);
	584	return 0;
	585	}
12e4ed7d	586
0746673d EA	587	static int mt9m111_set_red_balance(struct gspca_dev *gspca_dev, __s32 val)
	588	{
	589	u8 data[2];
	590	struct sd sd = (struct sd ) gspca_dev;
	591	s32 *sensor_settings = sd->sensor_priv;
	592
	593	sensor_settings[RED_BALANCE_IDX] = val;
5a41c9f6 EA	594	data[1] = (val & 0xff);
5a41c9f6 EA	595	data[0] = (val & 0xff00) >> 8;
0746673d EA	596
	597	PDEBUG(D_V4L2, "Set red balance %d", val);
	598
	599	return m5602_write_sensor(sd, MT9M111_SC_RED_GAIN,
	600	data, 2);
	601	}
	602
	603	static int mt9m111_get_red_balance(struct gspca_dev gspca_dev, __s32 val)
	604	{
	605	struct sd sd = (struct sd ) gspca_dev;
	606	s32 *sensor_settings = sd->sensor_priv;
	607
	608	*val = sensor_settings[RED_BALANCE_IDX];
	609	PDEBUG(D_V4L2, "Read red balance %d", *val);
	610	return 0;
	611	}
	612
658efb63	613	static void mt9m111_dump_registers(struct sd *sd)
c109f816 EA	614	{
	615	u8 address, value[2] = {0x00, 0x00};
	616
bdfe91f4	617	pr_info("Dumping the mt9m111 register state\n");
c109f816	618
bdfe91f4	619	pr_info("Dumping the mt9m111 sensor core registers\n");
c109f816	620	value[1] = MT9M111_SENSOR_CORE;
6dc4cff0	621	m5602_write_sensor(sd, MT9M111_PAGE_MAP, value, 2);
c109f816	622	for (address = 0; address < 0xff; address++) {
4f93c450	623	m5602_read_sensor(sd, address, value, 2);
bdfe91f4 JP	624	pr_info("register 0x%x contains 0x%x%x\n",
bdfe91f4 JP	625	address, value[0], value[1]);
c109f816 EA	626	}
c109f816 EA	627
bdfe91f4	628	pr_info("Dumping the mt9m111 color pipeline registers\n");
c109f816	629	value[1] = MT9M111_COLORPIPE;
6dc4cff0	630	m5602_write_sensor(sd, MT9M111_PAGE_MAP, value, 2);
c109f816	631	for (address = 0; address < 0xff; address++) {
4f93c450	632	m5602_read_sensor(sd, address, value, 2);
bdfe91f4 JP	633	pr_info("register 0x%x contains 0x%x%x\n",
bdfe91f4 JP	634	address, value[0], value[1]);
c109f816 EA	635	}
c109f816 EA	636
bdfe91f4	637	pr_info("Dumping the mt9m111 camera control registers\n");
c109f816	638	value[1] = MT9M111_CAMERA_CONTROL;
6dc4cff0	639	m5602_write_sensor(sd, MT9M111_PAGE_MAP, value, 2);
c109f816	640	for (address = 0; address < 0xff; address++) {
4f93c450	641	m5602_read_sensor(sd, address, value, 2);
bdfe91f4 JP	642	pr_info("register 0x%x contains 0x%x%x\n",
bdfe91f4 JP	643	address, value[0], value[1]);
c109f816 EA	644	}
c109f816 EA	645
bdfe91f4	646	pr_info("mt9m111 register state dump complete\n");
c109f816	647	}