[mirror_ubuntu-jammy-kernel.git] / drivers / media / video / gspca / m5602 / m5602_s5k83a.c

/*
 * Driver for the s5k83a 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.
 *
 */

#include "m5602_s5k83a.h"

static void s5k83a_dump_registers(struct sd *sd);

int s5k83a_probe(struct sd *sd)
{
	u8 prod_id = 0, ver_id = 0;
	int i, err = 0;

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

	info("Probing for a s5k83a sensor");

	/* Preinit the sensor */
	for (i = 0; i < ARRAY_SIZE(preinit_s5k83a) && !err; i++) {
		u8 data[2] = {preinit_s5k83a[i][2], preinit_s5k83a[i][3]};
		if (preinit_s5k83a[i][0] == SENSOR)
			err = m5602_write_sensor(sd, preinit_s5k83a[i][1],
				data, 2);
		else
			err = m5602_write_bridge(sd, preinit_s5k83a[i][1],
				data[0]);
	}

	/* We don't know what register (if any) that contain the product id
	 * Just pick the first addresses that seem to produce the same results
	 * on multiple machines */
	if (s5k83a_read_sensor(sd, 0x00, &prod_id, 1))
		return -ENODEV;

	if (s5k83a_read_sensor(sd, 0x01, &ver_id, 1))
		return -ENODEV;

	if ((prod_id == 0xff) || (ver_id == 0xff))
		return -ENODEV;
	else
		info("Detected a s5k83a sensor");

sensor_found:
	sd->gspca_dev.cam.cam_mode = s5k83a.modes;
	sd->gspca_dev.cam.nmodes = s5k83a.nmodes;
	sd->desc->ctrls = s5k83a.ctrls;
	sd->desc->nctrls = s5k83a.nctrls;
	return 0;
}

int s5k83a_read_sensor(struct sd *sd, const u8 address,
		       u8 *i2c_data, const u8 len)
{
	int err, i;

	do {
		err = m5602_read_bridge(sd, M5602_XB_I2C_STATUS, i2c_data);
	} while ((*i2c_data & I2C_BUSY) && !err);
	if (err < 0)
		goto out;

	err = m5602_write_bridge(sd, M5602_XB_I2C_DEV_ADDR,
				 sd->sensor->i2c_slave_id);
	if (err < 0)
		goto out;

	err = m5602_write_bridge(sd, M5602_XB_I2C_REG_ADDR, address);
	if (err < 0)
		goto out;

	err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 0x18 + len);

	do {
		err = m5602_read_bridge(sd, M5602_XB_I2C_STATUS, i2c_data);
	} while ((*i2c_data & I2C_BUSY) && !err);

	for (i = 0; i < len && !len; i++) {
		err = m5602_read_bridge(sd, M5602_XB_I2C_DATA, &(i2c_data[i]));

		PDEBUG(D_CONF, "Reading sensor register "
				  "0x%x containing 0x%x ", address, *i2c_data);
	}

out:
	return err;
}

int s5k83a_init(struct sd *sd)
{
	int i, err = 0;

	for (i = 0; i < ARRAY_SIZE(init_s5k83a) && !err; i++) {
		u8 data[2] = {0x00, 0x00};

		switch (init_s5k83a[i][0]) {
		case BRIDGE:
			err = m5602_write_bridge(sd,
					init_s5k83a[i][1],
					init_s5k83a[i][2]);
			break;

		case SENSOR:
			data[0] = init_s5k83a[i][2];
			err = m5602_write_sensor(sd,
				init_s5k83a[i][1], data, 1);
			break;

		case SENSOR_LONG:
			data[0] = init_s5k83a[i][2];
			data[1] = init_s5k83a[i][3];
			err = m5602_write_sensor(sd,
				init_s5k83a[i][1], data, 2);
			break;
		default:
			info("Invalid stream command, exiting init");
			return -EINVAL;
		}
	}

	if (dump_sensor)
		s5k83a_dump_registers(sd);

	return (err < 0) ? err : 0;
}

int s5k83a_power_down(struct sd *sd)
{
	return 0;
}

void s5k83a_dump_registers(struct sd *sd)
{
	int address;
	u8 page, old_page;
	s5k83a_read_sensor(sd, S5K83A_PAGE_MAP, &old_page, 1);

	for (page = 0; page < 16; page++) {
		m5602_write_sensor(sd, S5K83A_PAGE_MAP, &page, 1);
		info("Dumping the s5k83a register state for page 0x%x", page);
		for (address = 0; address <= 0xff; address++) {
			u8 val = 0;
			s5k83a_read_sensor(sd, address, &val, 1);
			info("register 0x%x contains 0x%x",
			     address, val);
		}
	}
	info("s5k83a register state dump complete");

	for (page = 0; page < 16; page++) {
		m5602_write_sensor(sd, S5K83A_PAGE_MAP, &page, 1);
		info("Probing for which registers that are read/write "
		      "for page 0x%x", page);
		for (address = 0; address <= 0xff; address++) {
			u8 old_val, ctrl_val, test_val = 0xff;

			s5k83a_read_sensor(sd, address, &old_val, 1);
			m5602_write_sensor(sd, address, &test_val, 1);
			s5k83a_read_sensor(sd, address, &ctrl_val, 1);

			if (ctrl_val == test_val)
				info("register 0x%x is writeable", address);
			else
				info("register 0x%x is read only", address);

			/* Restore original val */
			m5602_write_sensor(sd, address, &old_val, 1);
		}
	}
	info("Read/write register probing complete");
	m5602_write_sensor(sd, S5K83A_PAGE_MAP, &old_page, 1);
}

int s5k83a_get_brightness(struct gspca_dev *gspca_dev, __s32 *val)
{
	int err;
	u8 data[2];
	struct sd *sd = (struct sd *) gspca_dev;

	err = s5k83a_read_sensor(sd, S5K83A_BRIGHTNESS, data, 2);
	if (err < 0)
		goto out;

	data[1] = data[1] << 1;
	*val = data[1];

out:
	return err;
}

int s5k83a_set_brightness(struct gspca_dev *gspca_dev, __s32 val)
{
	int err;
	u8 data[2];
	struct sd *sd = (struct sd *) gspca_dev;

	data[0] = 0x00;
	data[1] = 0x20;
	err = m5602_write_sensor(sd, 0x14, data, 2);
	if (err < 0)
		goto out;

	data[0] = 0x01;
	data[1] = 0x00;
	err = m5602_write_sensor(sd, 0x0d, data, 2);
	if (err < 0)
		goto out;

	/* FIXME: This is not sane, we need to figure out the composition
		  of these registers */
	data[0] = val >> 3; /* brightness, high 5 bits */
	data[1] = val >> 1; /* brightness, high 7 bits */
	err = m5602_write_sensor(sd, S5K83A_BRIGHTNESS, data, 2);

out:
	return err;
}

int s5k83a_get_whiteness(struct gspca_dev *gspca_dev, __s32 *val)
{
	int err;
	u8 data;
	struct sd *sd = (struct sd *) gspca_dev;

	err = s5k83a_read_sensor(sd, S5K83A_WHITENESS, &data, 1);
	if (err < 0)
		goto out;

	*val = data;

out:
	return err;
}

int s5k83a_set_whiteness(struct gspca_dev *gspca_dev, __s32 val)
{
	int err;
	u8 data[1];
	struct sd *sd = (struct sd *) gspca_dev;

	data[0] = val;
	err = m5602_write_sensor(sd, S5K83A_WHITENESS, data, 1);

	return err;
}

int s5k83a_get_gain(struct gspca_dev *gspca_dev, __s32 *val)
{
	int err;
	u8 data[2];
	struct sd *sd = (struct sd *) gspca_dev;

	err = s5k83a_read_sensor(sd, S5K83A_GAIN, data, 2);
	if (err < 0)
		goto out;

	data[1] = data[1] & 0x3f;
	if (data[1] > S5K83A_MAXIMUM_GAIN)
		data[1] = S5K83A_MAXIMUM_GAIN;

	*val = data[1];

out:
	return err;
}

int s5k83a_set_gain(struct gspca_dev *gspca_dev, __s32 val)
{
	int err;
	u8 data[2];
	struct sd *sd = (struct sd *) gspca_dev;

	data[0] = 0;
	data[1] = val;
	err = m5602_write_sensor(sd, S5K83A_GAIN, data, 2);
	return err;
}

int s5k83a_get_vflip(struct gspca_dev *gspca_dev, __s32 *val)
{
	int err;
	u8 data[1];
	struct sd *sd = (struct sd *) gspca_dev;

	data[0] = 0x05;
	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
	if (err < 0)
		goto out;

	err = s5k83a_read_sensor(sd, S5K83A_FLIP, data, 1);
	*val = (data[0] | 0x40) ? 1 : 0;

out:
	return err;
}

int s5k83a_set_vflip(struct gspca_dev *gspca_dev, __s32 val)
{
	int err;
	u8 data[1];
	struct sd *sd = (struct sd *) gspca_dev;

	data[0] = 0x05;
	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
	if (err < 0)
		goto out;

	err = s5k83a_read_sensor(sd, S5K83A_FLIP, data, 1);
	if (err < 0)
		goto out;

	/* set or zero six bit, seven is hflip */
	data[0] = (val) ? (data[0] & 0x80) | 0x40 | S5K83A_FLIP_MASK
			: (data[0] & 0x80) | S5K83A_FLIP_MASK;
	err = m5602_write_sensor(sd, S5K83A_FLIP, data, 1);
	if (err < 0)
		goto out;

	data[0] = (val) ? 0x0b : 0x0a;
	err = m5602_write_sensor(sd, S5K83A_VFLIP_TUNE, data, 1);

out:
	return err;
}

int s5k83a_get_hflip(struct gspca_dev *gspca_dev, __s32 *val)
{
	int err;
	u8 data[1];
	struct sd *sd = (struct sd *) gspca_dev;

	data[0] = 0x05;
	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
	if (err < 0)
		goto out;

	err = s5k83a_read_sensor(sd, S5K83A_FLIP, data, 1);
	*val = (data[0] | 0x80) ? 1 : 0;

out:
	return err;
}

int s5k83a_set_hflip(struct gspca_dev *gspca_dev, __s32 val)
{
	int err;
	u8 data[1];
	struct sd *sd = (struct sd *) gspca_dev;

	data[0] = 0x05;
	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
	if (err < 0)
		goto out;

	err = s5k83a_read_sensor(sd, S5K83A_FLIP, data, 1);
	if (err < 0)
		goto out;

	/* set or zero seven bit, six is vflip */
	data[0] = (val) ? (data[0] & 0x40) | 0x80 | S5K83A_FLIP_MASK
			: (data[0] & 0x40) | S5K83A_FLIP_MASK;
	err = m5602_write_sensor(sd, S5K83A_FLIP, data, 1);
	if (err < 0)
		goto out;

	data[0] = (val) ? 0x0a : 0x0b;
	err = m5602_write_sensor(sd, S5K83A_HFLIP_TUNE, data, 1);
out:
	return err;
}
Commit	Line	Data
c109f816 EA	1	/*
	2	* Driver for the s5k83a 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
	19	#include "m5602_s5k83a.h"
	20
658efb63 EA	21	static void s5k83a_dump_registers(struct sd *sd);
658efb63 EA	22
c109f816 EA	23	int s5k83a_probe(struct sd *sd)
	24	{
	25	u8 prod_id = 0, ver_id = 0;
	26	int i, err = 0;
	27
	28	if (force_sensor) {
	29	if (force_sensor == S5K83A_SENSOR) {
	30	info("Forcing a %s sensor", s5k83a.name);
	31	goto sensor_found;
	32	}
	33	/* If we want to force another sensor, don't try to probe this
	34	* one */
	35	return -ENODEV;
	36	}
	37
	38	info("Probing for a s5k83a sensor");
	39
	40	/* Preinit the sensor */
	41	for (i = 0; i < ARRAY_SIZE(preinit_s5k83a) && !err; i++) {
	42	u8 data[2] = {preinit_s5k83a[i][2], preinit_s5k83a[i][3]};
	43	if (preinit_s5k83a[i][0] == SENSOR)
6dc4cff0	44	err = m5602_write_sensor(sd, preinit_s5k83a[i][1],
c109f816 EA	45	data, 2);
	46	else
	47	err = m5602_write_bridge(sd, preinit_s5k83a[i][1],
	48	data[0]);
	49	}
	50
	51	/* We don't know what register (if any) that contain the product id
	52	* Just pick the first addresses that seem to produce the same results
	53	* on multiple machines */
	54	if (s5k83a_read_sensor(sd, 0x00, &prod_id, 1))
	55	return -ENODEV;
	56
	57	if (s5k83a_read_sensor(sd, 0x01, &ver_id, 1))
	58	return -ENODEV;
	59
	60	if ((prod_id == 0xff) \|\| (ver_id == 0xff))
	61	return -ENODEV;
	62	else
	63	info("Detected a s5k83a sensor");
	64
	65	sensor_found:
	66	sd->gspca_dev.cam.cam_mode = s5k83a.modes;
	67	sd->gspca_dev.cam.nmodes = s5k83a.nmodes;
d2d7e9ae EA	68	sd->desc->ctrls = s5k83a.ctrls;
d2d7e9ae EA	69	sd->desc->nctrls = s5k83a.nctrls;
c109f816 EA	70	return 0;
	71	}
	72
	73	int s5k83a_read_sensor(struct sd *sd, const u8 address,
bac79f37	74	u8 *i2c_data, const u8 len)
c109f816 EA	75	{
	76	int err, i;
	77
	78	do {
	79	err = m5602_read_bridge(sd, M5602_XB_I2C_STATUS, i2c_data);
	80	} while ((*i2c_data & I2C_BUSY) && !err);
	81	if (err < 0)
	82	goto out;
	83
	84	err = m5602_write_bridge(sd, M5602_XB_I2C_DEV_ADDR,
	85	sd->sensor->i2c_slave_id);
	86	if (err < 0)
	87	goto out;
	88
	89	err = m5602_write_bridge(sd, M5602_XB_I2C_REG_ADDR, address);
	90	if (err < 0)
	91	goto out;
	92
	93	err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 0x18 + len);
c109f816 EA	94
	95	do {
	96	err = m5602_read_bridge(sd, M5602_XB_I2C_STATUS, i2c_data);
	97	} while ((*i2c_data & I2C_BUSY) && !err);
	98
c109f816 EA	99	for (i = 0; i < len && !len; i++) {
	100	err = m5602_read_bridge(sd, M5602_XB_I2C_DATA, &(i2c_data[i]));
	101
17ea88ae	102	PDEBUG(D_CONF, "Reading sensor register "
c109f816 EA	103	"0x%x containing 0x%x ", address, *i2c_data);
	104	}
	105
	106	out:
bac79f37	107	return err;
c109f816 EA	108	}
c109f816 EA	109
c109f816 EA	110	int s5k83a_init(struct sd *sd)
	111	{
	112	int i, err = 0;
	113
	114	for (i = 0; i < ARRAY_SIZE(init_s5k83a) && !err; i++) {
	115	u8 data[2] = {0x00, 0x00};
	116
	117	switch (init_s5k83a[i][0]) {
	118	case BRIDGE:
	119	err = m5602_write_bridge(sd,
	120	init_s5k83a[i][1],
	121	init_s5k83a[i][2]);
	122	break;
	123
	124	case SENSOR:
	125	data[0] = init_s5k83a[i][2];
6dc4cff0	126	err = m5602_write_sensor(sd,
c109f816 EA	127	init_s5k83a[i][1], data, 1);
	128	break;
	129
	130	case SENSOR_LONG:
	131	data[0] = init_s5k83a[i][2];
	132	data[1] = init_s5k83a[i][3];
6dc4cff0	133	err = m5602_write_sensor(sd,
c109f816 EA	134	init_s5k83a[i][1], data, 2);
	135	break;
	136	default:
	137	info("Invalid stream command, exiting init");
	138	return -EINVAL;
	139	}
	140	}
	141
	142	if (dump_sensor)
	143	s5k83a_dump_registers(sd);
	144
	145	return (err < 0) ? err : 0;
	146	}
	147
	148	int s5k83a_power_down(struct sd *sd)
	149	{
	150	return 0;
	151	}
	152
	153	void s5k83a_dump_registers(struct sd *sd)
	154	{
	155	int address;
	156	u8 page, old_page;
	157	s5k83a_read_sensor(sd, S5K83A_PAGE_MAP, &old_page, 1);
	158
	159	for (page = 0; page < 16; page++) {
6dc4cff0	160	m5602_write_sensor(sd, S5K83A_PAGE_MAP, &page, 1);
c109f816 EA	161	info("Dumping the s5k83a register state for page 0x%x", page);
	162	for (address = 0; address <= 0xff; address++) {
	163	u8 val = 0;
	164	s5k83a_read_sensor(sd, address, &val, 1);
	165	info("register 0x%x contains 0x%x",
	166	address, val);
	167	}
	168	}
	169	info("s5k83a register state dump complete");
	170
	171	for (page = 0; page < 16; page++) {
6dc4cff0	172	m5602_write_sensor(sd, S5K83A_PAGE_MAP, &page, 1);
c109f816 EA	173	info("Probing for which registers that are read/write "
	174	"for page 0x%x", page);
	175	for (address = 0; address <= 0xff; address++) {
	176	u8 old_val, ctrl_val, test_val = 0xff;
	177
	178	s5k83a_read_sensor(sd, address, &old_val, 1);
6dc4cff0	179	m5602_write_sensor(sd, address, &test_val, 1);
c109f816 EA	180	s5k83a_read_sensor(sd, address, &ctrl_val, 1);
	181
	182	if (ctrl_val == test_val)
	183	info("register 0x%x is writeable", address);
	184	else
	185	info("register 0x%x is read only", address);
	186
	187	/* Restore original val */
6dc4cff0	188	m5602_write_sensor(sd, address, &old_val, 1);
c109f816 EA	189	}
	190	}
	191	info("Read/write register probing complete");
6dc4cff0	192	m5602_write_sensor(sd, S5K83A_PAGE_MAP, &old_page, 1);
c109f816 EA	193	}
	194
	195	int s5k83a_get_brightness(struct gspca_dev gspca_dev, __s32 val)
	196	{
	197	int err;
	198	u8 data[2];
	199	struct sd sd = (struct sd ) gspca_dev;
	200
	201	err = s5k83a_read_sensor(sd, S5K83A_BRIGHTNESS, data, 2);
7b2cd079 EA	202	if (err < 0)
	203	goto out;
	204
c109f816 EA	205	data[1] = data[1] << 1;
	206	*val = data[1];
	207
7b2cd079 EA	208	out:
7b2cd079 EA	209	return err;
c109f816 EA	210	}
	211
	212	int s5k83a_set_brightness(struct gspca_dev *gspca_dev, __s32 val)
	213	{
	214	int err;
	215	u8 data[2];
	216	struct sd sd = (struct sd ) gspca_dev;
	217
	218	data[0] = 0x00;
	219	data[1] = 0x20;
6dc4cff0	220	err = m5602_write_sensor(sd, 0x14, data, 2);
c109f816	221	if (err < 0)
7b2cd079	222	goto out;
c109f816 EA	223
	224	data[0] = 0x01;
	225	data[1] = 0x00;
6dc4cff0	226	err = m5602_write_sensor(sd, 0x0d, data, 2);
c109f816	227	if (err < 0)
7b2cd079	228	goto out;
c109f816 EA	229
	230	/* FIXME: This is not sane, we need to figure out the composition
	231	of these registers */
	232	data[0] = val >> 3; /* brightness, high 5 bits */
	233	data[1] = val >> 1; /* brightness, high 7 bits */
6dc4cff0	234	err = m5602_write_sensor(sd, S5K83A_BRIGHTNESS, data, 2);
c109f816	235
7b2cd079 EA	236	out:
7b2cd079 EA	237	return err;
c109f816 EA	238	}
	239
	240	int s5k83a_get_whiteness(struct gspca_dev gspca_dev, __s32 val)
	241	{
	242	int err;
	243	u8 data;
	244	struct sd sd = (struct sd ) gspca_dev;
	245
	246	err = s5k83a_read_sensor(sd, S5K83A_WHITENESS, &data, 1);
7b2cd079 EA	247	if (err < 0)
7b2cd079 EA	248	goto out;
c109f816 EA	249
c109f816 EA	250	*val = data;
7b2cd079 EA	251
	252	out:
	253	return err;
c109f816 EA	254	}
	255
	256	int s5k83a_set_whiteness(struct gspca_dev *gspca_dev, __s32 val)
	257	{
	258	int err;
	259	u8 data[1];
	260	struct sd sd = (struct sd ) gspca_dev;
	261
	262	data[0] = val;
6dc4cff0	263	err = m5602_write_sensor(sd, S5K83A_WHITENESS, data, 1);
c109f816	264
7b2cd079	265	return err;
c109f816 EA	266	}
	267
	268	int s5k83a_get_gain(struct gspca_dev gspca_dev, __s32 val)
	269	{
	270	int err;
	271	u8 data[2];
	272	struct sd sd = (struct sd ) gspca_dev;
	273
	274	err = s5k83a_read_sensor(sd, S5K83A_GAIN, data, 2);
7b2cd079 EA	275	if (err < 0)
7b2cd079 EA	276	goto out;
c109f816 EA	277
	278	data[1] = data[1] & 0x3f;
	279	if (data[1] > S5K83A_MAXIMUM_GAIN)
	280	data[1] = S5K83A_MAXIMUM_GAIN;
	281
	282	*val = data[1];
	283
7b2cd079 EA	284	out:
7b2cd079 EA	285	return err;
c109f816 EA	286	}
	287
	288	int s5k83a_set_gain(struct gspca_dev *gspca_dev, __s32 val)
	289	{
18f8fae1	290	int err;
c109f816 EA	291	u8 data[2];
	292	struct sd sd = (struct sd ) gspca_dev;
	293
	294	data[0] = 0;
	295	data[1] = val;
6dc4cff0	296	err = m5602_write_sensor(sd, S5K83A_GAIN, data, 2);
7b2cd079	297	return err;
c109f816	298	}
18f8fae1 EA	299
	300	int s5k83a_get_vflip(struct gspca_dev gspca_dev, __s32 val)
	301	{
	302	int err;
	303	u8 data[1];
	304	struct sd sd = (struct sd ) gspca_dev;
	305
	306	data[0] = 0x05;
6dc4cff0	307	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
18f8fae1	308	if (err < 0)
7b2cd079	309	goto out;
18f8fae1 EA	310
	311	err = s5k83a_read_sensor(sd, S5K83A_FLIP, data, 1);
	312	*val = (data[0] \| 0x40) ? 1 : 0;
	313
7b2cd079 EA	314	out:
7b2cd079 EA	315	return err;
18f8fae1 EA	316	}
	317
	318	int s5k83a_set_vflip(struct gspca_dev *gspca_dev, __s32 val)
	319	{
	320	int err;
	321	u8 data[1];
	322	struct sd sd = (struct sd ) gspca_dev;
	323
	324	data[0] = 0x05;
6dc4cff0	325	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
18f8fae1	326	if (err < 0)
7b2cd079	327	goto out;
18f8fae1 EA	328
	329	err = s5k83a_read_sensor(sd, S5K83A_FLIP, data, 1);
	330	if (err < 0)
7b2cd079	331	goto out;
18f8fae1 EA	332
	333	/* set or zero six bit, seven is hflip */
	334	data[0] = (val) ? (data[0] & 0x80) \| 0x40 \| S5K83A_FLIP_MASK
	335	: (data[0] & 0x80) \| S5K83A_FLIP_MASK;
6dc4cff0	336	err = m5602_write_sensor(sd, S5K83A_FLIP, data, 1);
18f8fae1	337	if (err < 0)
7b2cd079	338	goto out;
18f8fae1 EA	339
18f8fae1 EA	340	data[0] = (val) ? 0x0b : 0x0a;
6dc4cff0	341	err = m5602_write_sensor(sd, S5K83A_VFLIP_TUNE, data, 1);
18f8fae1	342
7b2cd079 EA	343	out:
7b2cd079 EA	344	return err;
18f8fae1 EA	345	}
	346
	347	int s5k83a_get_hflip(struct gspca_dev gspca_dev, __s32 val)
	348	{
	349	int err;
	350	u8 data[1];
	351	struct sd sd = (struct sd ) gspca_dev;
	352
	353	data[0] = 0x05;
6dc4cff0	354	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
18f8fae1	355	if (err < 0)
7b2cd079	356	goto out;
18f8fae1 EA	357
	358	err = s5k83a_read_sensor(sd, S5K83A_FLIP, data, 1);
	359	*val = (data[0] \| 0x80) ? 1 : 0;
	360
7b2cd079 EA	361	out:
7b2cd079 EA	362	return err;
18f8fae1 EA	363	}
	364
	365	int s5k83a_set_hflip(struct gspca_dev *gspca_dev, __s32 val)
	366	{
	367	int err;
	368	u8 data[1];
	369	struct sd sd = (struct sd ) gspca_dev;
	370
	371	data[0] = 0x05;
6dc4cff0	372	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
18f8fae1	373	if (err < 0)
7b2cd079	374	goto out;
18f8fae1 EA	375
	376	err = s5k83a_read_sensor(sd, S5K83A_FLIP, data, 1);
	377	if (err < 0)
7b2cd079	378	goto out;
18f8fae1 EA	379
	380	/* set or zero seven bit, six is vflip */
	381	data[0] = (val) ? (data[0] & 0x40) \| 0x80 \| S5K83A_FLIP_MASK
	382	: (data[0] & 0x40) \| S5K83A_FLIP_MASK;
6dc4cff0	383	err = m5602_write_sensor(sd, S5K83A_FLIP, data, 1);
18f8fae1	384	if (err < 0)
7b2cd079	385	goto out;
18f8fae1 EA	386
18f8fae1 EA	387	data[0] = (val) ? 0x0a : 0x0b;
6dc4cff0	388	err = m5602_write_sensor(sd, S5K83A_HFLIP_TUNE, data, 1);
7b2cd079 EA	389	out:
7b2cd079 EA	390	return err;
18f8fae1	391	}