[deliverable/linux.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 (m5602_read_sensor(sd, 0x00, &prod_id, 1))
		return -ENODEV;

	if (m5602_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_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;
	m5602_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;
			m5602_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;

			m5602_read_sensor(sd, address, &old_val, 1);
			m5602_write_sensor(sd, address, &test_val, 1);
			m5602_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 = m5602_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 = m5602_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 = m5602_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 = m5602_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 = m5602_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 = m5602_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 = m5602_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 */
6b9c0a2a	54	if (m5602_read_sensor(sd, 0x00, &prod_id, 1))
c109f816 EA	55	return -ENODEV;
c109f816 EA	56
6b9c0a2a	57	if (m5602_read_sensor(sd, 0x01, &ver_id, 1))
c109f816 EA	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
c109f816 EA	73	int s5k83a_init(struct sd *sd)
	74	{
	75	int i, err = 0;
	76
	77	for (i = 0; i < ARRAY_SIZE(init_s5k83a) && !err; i++) {
	78	u8 data[2] = {0x00, 0x00};
	79
	80	switch (init_s5k83a[i][0]) {
	81	case BRIDGE:
	82	err = m5602_write_bridge(sd,
	83	init_s5k83a[i][1],
	84	init_s5k83a[i][2]);
	85	break;
	86
	87	case SENSOR:
	88	data[0] = init_s5k83a[i][2];
6dc4cff0	89	err = m5602_write_sensor(sd,
c109f816 EA	90	init_s5k83a[i][1], data, 1);
	91	break;
	92
	93	case SENSOR_LONG:
	94	data[0] = init_s5k83a[i][2];
	95	data[1] = init_s5k83a[i][3];
6dc4cff0	96	err = m5602_write_sensor(sd,
c109f816 EA	97	init_s5k83a[i][1], data, 2);
	98	break;
	99	default:
	100	info("Invalid stream command, exiting init");
	101	return -EINVAL;
	102	}
	103	}
	104
	105	if (dump_sensor)
	106	s5k83a_dump_registers(sd);
	107
	108	return (err < 0) ? err : 0;
	109	}
	110
	111	int s5k83a_power_down(struct sd *sd)
	112	{
	113	return 0;
	114	}
	115
	116	void s5k83a_dump_registers(struct sd *sd)
	117	{
	118	int address;
	119	u8 page, old_page;
6b9c0a2a	120	m5602_read_sensor(sd, S5K83A_PAGE_MAP, &old_page, 1);
c109f816 EA	121
c109f816 EA	122	for (page = 0; page < 16; page++) {
6dc4cff0	123	m5602_write_sensor(sd, S5K83A_PAGE_MAP, &page, 1);
c109f816 EA	124	info("Dumping the s5k83a register state for page 0x%x", page);
	125	for (address = 0; address <= 0xff; address++) {
	126	u8 val = 0;
6b9c0a2a	127	m5602_read_sensor(sd, address, &val, 1);
c109f816 EA	128	info("register 0x%x contains 0x%x",
	129	address, val);
	130	}
	131	}
	132	info("s5k83a register state dump complete");
	133
	134	for (page = 0; page < 16; page++) {
6dc4cff0	135	m5602_write_sensor(sd, S5K83A_PAGE_MAP, &page, 1);
c109f816 EA	136	info("Probing for which registers that are read/write "
	137	"for page 0x%x", page);
	138	for (address = 0; address <= 0xff; address++) {
	139	u8 old_val, ctrl_val, test_val = 0xff;
	140
6b9c0a2a	141	m5602_read_sensor(sd, address, &old_val, 1);
6dc4cff0	142	m5602_write_sensor(sd, address, &test_val, 1);
6b9c0a2a	143	m5602_read_sensor(sd, address, &ctrl_val, 1);
c109f816 EA	144
	145	if (ctrl_val == test_val)
	146	info("register 0x%x is writeable", address);
	147	else
	148	info("register 0x%x is read only", address);
	149
	150	/* Restore original val */
6dc4cff0	151	m5602_write_sensor(sd, address, &old_val, 1);
c109f816 EA	152	}
	153	}
	154	info("Read/write register probing complete");
6dc4cff0	155	m5602_write_sensor(sd, S5K83A_PAGE_MAP, &old_page, 1);
c109f816 EA	156	}
	157
	158	int s5k83a_get_brightness(struct gspca_dev gspca_dev, __s32 val)
	159	{
	160	int err;
	161	u8 data[2];
	162	struct sd sd = (struct sd ) gspca_dev;
	163
6b9c0a2a	164	err = m5602_read_sensor(sd, S5K83A_BRIGHTNESS, data, 2);
7b2cd079 EA	165	if (err < 0)
	166	goto out;
	167
c109f816 EA	168	data[1] = data[1] << 1;
	169	*val = data[1];
	170
7b2cd079 EA	171	out:
7b2cd079 EA	172	return err;
c109f816 EA	173	}
	174
	175	int s5k83a_set_brightness(struct gspca_dev *gspca_dev, __s32 val)
	176	{
	177	int err;
	178	u8 data[2];
	179	struct sd sd = (struct sd ) gspca_dev;
	180
	181	data[0] = 0x00;
	182	data[1] = 0x20;
6dc4cff0	183	err = m5602_write_sensor(sd, 0x14, data, 2);
c109f816	184	if (err < 0)
7b2cd079	185	goto out;
c109f816 EA	186
	187	data[0] = 0x01;
	188	data[1] = 0x00;
6dc4cff0	189	err = m5602_write_sensor(sd, 0x0d, data, 2);
c109f816	190	if (err < 0)
7b2cd079	191	goto out;
c109f816 EA	192
	193	/* FIXME: This is not sane, we need to figure out the composition
	194	of these registers */
	195	data[0] = val >> 3; /* brightness, high 5 bits */
	196	data[1] = val >> 1; /* brightness, high 7 bits */
6dc4cff0	197	err = m5602_write_sensor(sd, S5K83A_BRIGHTNESS, data, 2);
c109f816	198
7b2cd079 EA	199	out:
7b2cd079 EA	200	return err;
c109f816 EA	201	}
	202
	203	int s5k83a_get_whiteness(struct gspca_dev gspca_dev, __s32 val)
	204	{
	205	int err;
	206	u8 data;
	207	struct sd sd = (struct sd ) gspca_dev;
	208
6b9c0a2a	209	err = m5602_read_sensor(sd, S5K83A_WHITENESS, &data, 1);
7b2cd079 EA	210	if (err < 0)
7b2cd079 EA	211	goto out;
c109f816 EA	212
c109f816 EA	213	*val = data;
7b2cd079 EA	214
	215	out:
	216	return err;
c109f816 EA	217	}
	218
	219	int s5k83a_set_whiteness(struct gspca_dev *gspca_dev, __s32 val)
	220	{
	221	int err;
	222	u8 data[1];
	223	struct sd sd = (struct sd ) gspca_dev;
	224
	225	data[0] = val;
6dc4cff0	226	err = m5602_write_sensor(sd, S5K83A_WHITENESS, data, 1);
c109f816	227
7b2cd079	228	return err;
c109f816 EA	229	}
	230
	231	int s5k83a_get_gain(struct gspca_dev gspca_dev, __s32 val)
	232	{
	233	int err;
	234	u8 data[2];
	235	struct sd sd = (struct sd ) gspca_dev;
	236
6b9c0a2a	237	err = m5602_read_sensor(sd, S5K83A_GAIN, data, 2);
7b2cd079 EA	238	if (err < 0)
7b2cd079 EA	239	goto out;
c109f816 EA	240
	241	data[1] = data[1] & 0x3f;
	242	if (data[1] > S5K83A_MAXIMUM_GAIN)
	243	data[1] = S5K83A_MAXIMUM_GAIN;
	244
	245	*val = data[1];
	246
7b2cd079 EA	247	out:
7b2cd079 EA	248	return err;
c109f816 EA	249	}
	250
	251	int s5k83a_set_gain(struct gspca_dev *gspca_dev, __s32 val)
	252	{
18f8fae1	253	int err;
c109f816 EA	254	u8 data[2];
	255	struct sd sd = (struct sd ) gspca_dev;
	256
	257	data[0] = 0;
	258	data[1] = val;
6dc4cff0	259	err = m5602_write_sensor(sd, S5K83A_GAIN, data, 2);
7b2cd079	260	return err;
c109f816	261	}
18f8fae1 EA	262
	263	int s5k83a_get_vflip(struct gspca_dev gspca_dev, __s32 val)
	264	{
	265	int err;
	266	u8 data[1];
	267	struct sd sd = (struct sd ) gspca_dev;
	268
	269	data[0] = 0x05;
6dc4cff0	270	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
18f8fae1	271	if (err < 0)
7b2cd079	272	goto out;
18f8fae1	273
6b9c0a2a	274	err = m5602_read_sensor(sd, S5K83A_FLIP, data, 1);
18f8fae1 EA	275	*val = (data[0] \| 0x40) ? 1 : 0;
18f8fae1 EA	276
7b2cd079 EA	277	out:
7b2cd079 EA	278	return err;
18f8fae1 EA	279	}
	280
	281	int s5k83a_set_vflip(struct gspca_dev *gspca_dev, __s32 val)
	282	{
	283	int err;
	284	u8 data[1];
	285	struct sd sd = (struct sd ) gspca_dev;
	286
	287	data[0] = 0x05;
6dc4cff0	288	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
18f8fae1	289	if (err < 0)
7b2cd079	290	goto out;
18f8fae1	291
6b9c0a2a	292	err = m5602_read_sensor(sd, S5K83A_FLIP, data, 1);
18f8fae1	293	if (err < 0)
7b2cd079	294	goto out;
18f8fae1 EA	295
	296	/* set or zero six bit, seven is hflip */
	297	data[0] = (val) ? (data[0] & 0x80) \| 0x40 \| S5K83A_FLIP_MASK
	298	: (data[0] & 0x80) \| S5K83A_FLIP_MASK;
6dc4cff0	299	err = m5602_write_sensor(sd, S5K83A_FLIP, data, 1);
18f8fae1	300	if (err < 0)
7b2cd079	301	goto out;
18f8fae1 EA	302
18f8fae1 EA	303	data[0] = (val) ? 0x0b : 0x0a;
6dc4cff0	304	err = m5602_write_sensor(sd, S5K83A_VFLIP_TUNE, data, 1);
18f8fae1	305
7b2cd079 EA	306	out:
7b2cd079 EA	307	return err;
18f8fae1 EA	308	}
	309
	310	int s5k83a_get_hflip(struct gspca_dev gspca_dev, __s32 val)
	311	{
	312	int err;
	313	u8 data[1];
	314	struct sd sd = (struct sd ) gspca_dev;
	315
	316	data[0] = 0x05;
6dc4cff0	317	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
18f8fae1	318	if (err < 0)
7b2cd079	319	goto out;
18f8fae1	320
6b9c0a2a	321	err = m5602_read_sensor(sd, S5K83A_FLIP, data, 1);
18f8fae1 EA	322	*val = (data[0] \| 0x80) ? 1 : 0;
18f8fae1 EA	323
7b2cd079 EA	324	out:
7b2cd079 EA	325	return err;
18f8fae1 EA	326	}
	327
	328	int s5k83a_set_hflip(struct gspca_dev *gspca_dev, __s32 val)
	329	{
	330	int err;
	331	u8 data[1];
	332	struct sd sd = (struct sd ) gspca_dev;
	333
	334	data[0] = 0x05;
6dc4cff0	335	err = m5602_write_sensor(sd, S5K83A_PAGE_MAP, data, 1);
18f8fae1	336	if (err < 0)
7b2cd079	337	goto out;
18f8fae1	338
6b9c0a2a	339	err = m5602_read_sensor(sd, S5K83A_FLIP, data, 1);
18f8fae1	340	if (err < 0)
7b2cd079	341	goto out;
18f8fae1 EA	342
	343	/* set or zero seven bit, six is vflip */
	344	data[0] = (val) ? (data[0] & 0x40) \| 0x80 \| S5K83A_FLIP_MASK
	345	: (data[0] & 0x40) \| S5K83A_FLIP_MASK;
6dc4cff0	346	err = m5602_write_sensor(sd, S5K83A_FLIP, data, 1);
18f8fae1	347	if (err < 0)
7b2cd079	348	goto out;
18f8fae1 EA	349
18f8fae1 EA	350	data[0] = (val) ? 0x0a : 0x0b;
6dc4cff0	351	err = m5602_write_sensor(sd, S5K83A_HFLIP_TUNE, data, 1);
7b2cd079 EA	352	out:
7b2cd079 EA	353	return err;
18f8fae1	354	}