[mirror_ubuntu-zesty-kernel.git] / drivers / media / video / gspca / mars.c

/*
 *		Mars-Semi MR97311A library
 *		Copyright (C) 2005 <bradlch@hotmail.com>
 *
 * V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
 *
 * 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; either version 2 of the License, or
 * any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
 */

#define MODULE_NAME "mars"

#include "gspca.h"
#include "jpeg.h"

MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
MODULE_DESCRIPTION("GSPCA/Mars USB Camera Driver");
MODULE_LICENSE("GPL");

/* controls */
enum e_ctrl {
	BRIGHTNESS,
	COLORS,
	GAMMA,
	SHARPNESS,
	ILLUM_TOP,
	ILLUM_BOT,
	NCTRLS		/* number of controls */
};

/* specific webcam descriptor */
struct sd {
	struct gspca_dev gspca_dev;	/* !! must be the first item */

	struct gspca_ctrl ctrls[NCTRLS];

	u8 quality;
#define QUALITY_MIN 40
#define QUALITY_MAX 70
#define QUALITY_DEF 50

	u8 jpeg_hdr[JPEG_HDR_SZ];
};

/* V4L2 controls supported by the driver */
static void setbrightness(struct gspca_dev *gspca_dev);
static void setcolors(struct gspca_dev *gspca_dev);
static void setgamma(struct gspca_dev *gspca_dev);
static void setsharpness(struct gspca_dev *gspca_dev);
static int sd_setilluminator1(struct gspca_dev *gspca_dev, __s32 val);
static int sd_setilluminator2(struct gspca_dev *gspca_dev, __s32 val);

static const struct ctrl sd_ctrls[NCTRLS] = {
[BRIGHTNESS] = {
	    {
		.id      = V4L2_CID_BRIGHTNESS,
		.type    = V4L2_CTRL_TYPE_INTEGER,
		.name    = "Brightness",
		.minimum = 0,
		.maximum = 30,
		.step    = 1,
		.default_value = 15,
	    },
	    .set_control = setbrightness
	},
[COLORS] = {
	    {
		.id      = V4L2_CID_SATURATION,
		.type    = V4L2_CTRL_TYPE_INTEGER,
		.name    = "Color",
		.minimum = 1,
		.maximum = 255,
		.step    = 1,
		.default_value = 200,
	    },
	    .set_control = setcolors
	},
[GAMMA] = {
	    {
		.id      = V4L2_CID_GAMMA,
		.type    = V4L2_CTRL_TYPE_INTEGER,
		.name    = "Gamma",
		.minimum = 0,
		.maximum = 3,
		.step    = 1,
		.default_value = 1,
	    },
	    .set_control = setgamma
	},
[SHARPNESS] = {
	    {
		.id	 = V4L2_CID_SHARPNESS,
		.type    = V4L2_CTRL_TYPE_INTEGER,
		.name    = "Sharpness",
		.minimum = 0,
		.maximum = 2,
		.step    = 1,
		.default_value = 1,
	    },
	    .set_control = setsharpness
	},
[ILLUM_TOP] = {
	    {
		.id	 = V4L2_CID_ILLUMINATORS_1,
		.type    = V4L2_CTRL_TYPE_BOOLEAN,
		.name    = "Top illuminator",
		.minimum = 0,
		.maximum = 1,
		.step    = 1,
		.default_value = 0,
		.flags = V4L2_CTRL_FLAG_UPDATE,
	    },
	    .set = sd_setilluminator1
	},
[ILLUM_BOT] = {
	    {
		.id	 = V4L2_CID_ILLUMINATORS_2,
		.type    = V4L2_CTRL_TYPE_BOOLEAN,
		.name    = "Bottom illuminator",
		.minimum = 0,
		.maximum = 1,
		.step    = 1,
		.default_value = 0,
		.flags = V4L2_CTRL_FLAG_UPDATE,
	    },
	    .set = sd_setilluminator2
	},
};

static const struct v4l2_pix_format vga_mode[] = {
	{320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
		.bytesperline = 320,
		.sizeimage = 320 * 240 * 3 / 8 + 590,
		.colorspace = V4L2_COLORSPACE_JPEG,
		.priv = 2},
	{640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
		.bytesperline = 640,
		.sizeimage = 640 * 480 * 3 / 8 + 590,
		.colorspace = V4L2_COLORSPACE_JPEG,
		.priv = 1},
};

static const __u8 mi_data[0x20] = {
/*	 01    02   03     04    05    06    07    08 */
	0x48, 0x22, 0x01, 0x47, 0x10, 0x00, 0x00, 0x00,
/*	 09    0a   0b     0c    0d    0e    0f    10 */
	0x00, 0x01, 0x30, 0x01, 0x30, 0x01, 0x30, 0x01,
/*	 11    12   13     14    15    16    17    18 */
	0x30, 0x00, 0x04, 0x00, 0x06, 0x01, 0xe2, 0x02,
/*	 19    1a   1b     1c    1d    1e    1f    20 */
	0x82, 0x00, 0x20, 0x17, 0x80, 0x08, 0x0c, 0x00
};

/* write <len> bytes from gspca_dev->usb_buf */
static void reg_w(struct gspca_dev *gspca_dev,
		 int len)
{
	int alen, ret;

	if (gspca_dev->usb_err < 0)
		return;

	ret = usb_bulk_msg(gspca_dev->dev,
			usb_sndbulkpipe(gspca_dev->dev, 4),
			gspca_dev->usb_buf,
			len,
			&alen,
			500);	/* timeout in milliseconds */
	if (ret < 0) {
		err("reg write [%02x] error %d",
			gspca_dev->usb_buf[0], ret);
		gspca_dev->usb_err = ret;
	}
}

static void mi_w(struct gspca_dev *gspca_dev,
		 u8 addr,
		 u8 value)
{
	gspca_dev->usb_buf[0] = 0x1f;
	gspca_dev->usb_buf[1] = 0;			/* control byte */
	gspca_dev->usb_buf[2] = addr;
	gspca_dev->usb_buf[3] = value;

	reg_w(gspca_dev, 4);
}

static void setbrightness(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;

	gspca_dev->usb_buf[0] = 0x61;
	gspca_dev->usb_buf[1] = sd->ctrls[BRIGHTNESS].val;
	reg_w(gspca_dev, 2);
}

static void setcolors(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;
	s16 val;

	val = sd->ctrls[COLORS].val;
	gspca_dev->usb_buf[0] = 0x5f;
	gspca_dev->usb_buf[1] = val << 3;
	gspca_dev->usb_buf[2] = ((val >> 2) & 0xf8) | 0x04;
	reg_w(gspca_dev, 3);
}

static void setgamma(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;

	gspca_dev->usb_buf[0] = 0x06;
	gspca_dev->usb_buf[1] = sd->ctrls[GAMMA].val * 0x40;
	reg_w(gspca_dev, 2);
}

static void setsharpness(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;

	gspca_dev->usb_buf[0] = 0x67;
	gspca_dev->usb_buf[1] = sd->ctrls[SHARPNESS].val * 4 + 3;
	reg_w(gspca_dev, 2);
}

static void setilluminators(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;

	gspca_dev->usb_buf[0] = 0x22;
	if (sd->ctrls[ILLUM_TOP].val)
		gspca_dev->usb_buf[1] = 0x76;
	else if (sd->ctrls[ILLUM_BOT].val)
		gspca_dev->usb_buf[1] = 0x7a;
	else
		gspca_dev->usb_buf[1] = 0x7e;
	reg_w(gspca_dev, 2);
}

/* this function is called at probe time */
static int sd_config(struct gspca_dev *gspca_dev,
			const struct usb_device_id *id)
{
	struct sd *sd = (struct sd *) gspca_dev;
	struct cam *cam;

	cam = &gspca_dev->cam;
	cam->cam_mode = vga_mode;
	cam->nmodes = ARRAY_SIZE(vga_mode);
	cam->ctrls = sd->ctrls;
	sd->quality = QUALITY_DEF;
	gspca_dev->nbalt = 9;		/* use the altsetting 08 */
	return 0;
}

/* this function is called at probe and resume time */
static int sd_init(struct gspca_dev *gspca_dev)
{
	gspca_dev->ctrl_inac = (1 << ILLUM_TOP) | (1 << ILLUM_BOT);
	return 0;
}

static int sd_start(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;
	u8 *data;
	int i;

	/* create the JPEG header */
	jpeg_define(sd->jpeg_hdr, gspca_dev->height, gspca_dev->width,
			0x21);		/* JPEG 422 */
	jpeg_set_qual(sd->jpeg_hdr, sd->quality);

	data = gspca_dev->usb_buf;

	data[0] = 0x01;		/* address */
	data[1] = 0x01;
	reg_w(gspca_dev, 2);

	/*
	   Initialize the MR97113 chip register
	 */
	data[0] = 0x00;		/* address */
	data[1] = 0x0c | 0x01;	/* reg 0 */
	data[2] = 0x01;		/* reg 1 */
	data[3] = gspca_dev->width / 8;		/* h_size , reg 2 */
	data[4] = gspca_dev->height / 8;	/* v_size , reg 3 */
	data[5] = 0x30;		/* reg 4, MI, PAS5101 :
				 *	0x30 for 24mhz , 0x28 for 12mhz */
	data[6] = 0x02;		/* reg 5, H start - was 0x04 */
	data[7] = sd->ctrls[GAMMA].val * 0x40;	/* reg 0x06: gamma */
	data[8] = 0x01;		/* reg 7, V start - was 0x03 */
/*	if (h_size == 320 ) */
/*		data[9]= 0x56;	 * reg 8, 24MHz, 2:1 scale down */
/*	else */
	data[9] = 0x52;		/* reg 8, 24MHz, no scale down */
/*jfm: from win trace*/
	data[10] = 0x18;

	reg_w(gspca_dev, 11);

	data[0] = 0x23;		/* address */
	data[1] = 0x09;		/* reg 35, append frame header */

	reg_w(gspca_dev, 2);

	data[0] = 0x3c;		/* address */
/*	if (gspca_dev->width == 1280) */
/*		data[1] = 200;	 * reg 60, pc-cam frame size
				 *	(unit: 4KB) 800KB */
/*	else */
	data[1] = 50;		/* 50 reg 60, pc-cam frame size
				 *	(unit: 4KB) 200KB */
	reg_w(gspca_dev, 2);

	/* auto dark-gain */
	data[0] = 0x5e;		/* address */
	data[1] = 0;		/* reg 94, Y Gain (auto) */
/*jfm: from win trace*/
				/* reg 0x5f/0x60 (LE) = saturation */
				/* h (60): xxxx x100
				 * l (5f): xxxx x000 */
	data[2] = sd->ctrls[COLORS].val << 3;
	data[3] = ((sd->ctrls[COLORS].val >> 2) & 0xf8) | 0x04;
	data[4] = sd->ctrls[BRIGHTNESS].val; /* reg 0x61 = brightness */
	data[5] = 0x00;

	reg_w(gspca_dev, 6);

	data[0] = 0x67;
/*jfm: from win trace*/
	data[1] = sd->ctrls[SHARPNESS].val * 4 + 3;
	data[2] = 0x14;
	reg_w(gspca_dev, 3);

	data[0] = 0x69;
	data[1] = 0x2f;
	data[2] = 0x28;
	data[3] = 0x42;
	reg_w(gspca_dev, 4);

	data[0] = 0x63;
	data[1] = 0x07;
	reg_w(gspca_dev, 2);
/*jfm: win trace - many writes here to reg 0x64*/

	/* initialize the MI sensor */
	for (i = 0; i < sizeof mi_data; i++)
		mi_w(gspca_dev, i + 1, mi_data[i]);

	data[0] = 0x00;
	data[1] = 0x4d;		/* ISOC transferring enable... */
	reg_w(gspca_dev, 2);

	gspca_dev->ctrl_inac = 0; /* activate the illuminator controls */
	return gspca_dev->usb_err;
}

static void sd_stopN(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;

	gspca_dev->ctrl_inac = (1 << ILLUM_TOP) | (1 << ILLUM_BOT);
	if (sd->ctrls[ILLUM_TOP].val || sd->ctrls[ILLUM_BOT].val) {
		sd->ctrls[ILLUM_TOP].val = 0;
		sd->ctrls[ILLUM_BOT].val = 0;
		setilluminators(gspca_dev);
		msleep(20);
	}

	gspca_dev->usb_buf[0] = 1;
	gspca_dev->usb_buf[1] = 0;
	reg_w(gspca_dev, 2);
}

static void sd_pkt_scan(struct gspca_dev *gspca_dev,
			u8 *data,			/* isoc packet */
			int len)			/* iso packet length */
{
	struct sd *sd = (struct sd *) gspca_dev;
	int p;

	if (len < 6) {
/*		gspca_dev->last_packet_type = DISCARD_PACKET; */
		return;
	}
	for (p = 0; p < len - 6; p++) {
		if (data[0 + p] == 0xff
		    && data[1 + p] == 0xff
		    && data[2 + p] == 0x00
		    && data[3 + p] == 0xff
		    && data[4 + p] == 0x96) {
			if (data[5 + p] == 0x64
			    || data[5 + p] == 0x65
			    || data[5 + p] == 0x66
			    || data[5 + p] == 0x67) {
				PDEBUG(D_PACK, "sof offset: %d len: %d",
					p, len);
				gspca_frame_add(gspca_dev, LAST_PACKET,
						data, p);

				/* put the JPEG header */
				gspca_frame_add(gspca_dev, FIRST_PACKET,
					sd->jpeg_hdr, JPEG_HDR_SZ);
				data += p + 16;
				len -= p + 16;
				break;
			}
		}
	}
	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
}

static int sd_setilluminator1(struct gspca_dev *gspca_dev, __s32 val)
{
	struct sd *sd = (struct sd *) gspca_dev;

	/* only one illuminator may be on */
	sd->ctrls[ILLUM_TOP].val = val;
	if (val)
		sd->ctrls[ILLUM_BOT].val = 0;
	setilluminators(gspca_dev);
	return gspca_dev->usb_err;
}

static int sd_setilluminator2(struct gspca_dev *gspca_dev, __s32 val)
{
	struct sd *sd = (struct sd *) gspca_dev;

	/* only one illuminator may be on */
	sd->ctrls[ILLUM_BOT].val = val;
	if (val)
		sd->ctrls[ILLUM_TOP].val = 0;
	setilluminators(gspca_dev);
	return gspca_dev->usb_err;
}

static int sd_set_jcomp(struct gspca_dev *gspca_dev,
			struct v4l2_jpegcompression *jcomp)
{
	struct sd *sd = (struct sd *) gspca_dev;

	if (jcomp->quality < QUALITY_MIN)
		sd->quality = QUALITY_MIN;
	else if (jcomp->quality > QUALITY_MAX)
		sd->quality = QUALITY_MAX;
	else
		sd->quality = jcomp->quality;
	if (gspca_dev->streaming)
		jpeg_set_qual(sd->jpeg_hdr, sd->quality);
	return 0;
}

static int sd_get_jcomp(struct gspca_dev *gspca_dev,
			struct v4l2_jpegcompression *jcomp)
{
	struct sd *sd = (struct sd *) gspca_dev;

	memset(jcomp, 0, sizeof *jcomp);
	jcomp->quality = sd->quality;
	jcomp->jpeg_markers = V4L2_JPEG_MARKER_DHT
			| V4L2_JPEG_MARKER_DQT;
	return 0;
}

/* sub-driver description */
static const struct sd_desc sd_desc = {
	.name = MODULE_NAME,
	.ctrls = sd_ctrls,
	.nctrls = NCTRLS,
	.config = sd_config,
	.init = sd_init,
	.start = sd_start,
	.stopN = sd_stopN,
	.pkt_scan = sd_pkt_scan,
	.get_jcomp = sd_get_jcomp,
	.set_jcomp = sd_set_jcomp,
};

/* -- module initialisation -- */
static const struct usb_device_id device_table[] = {
	{USB_DEVICE(0x093a, 0x050f)},
	{}
};
MODULE_DEVICE_TABLE(usb, device_table);

/* -- device connect -- */
static int sd_probe(struct usb_interface *intf,
			const struct usb_device_id *id)
{
	return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
				THIS_MODULE);
}

static struct usb_driver sd_driver = {
	.name = MODULE_NAME,
	.id_table = device_table,
	.probe = sd_probe,
	.disconnect = gspca_disconnect,
#ifdef CONFIG_PM
	.suspend = gspca_suspend,
	.resume = gspca_resume,
#endif
};

/* -- module insert / remove -- */
static int __init sd_mod_init(void)
{
	return usb_register(&sd_driver);
}
static void __exit sd_mod_exit(void)
{
	usb_deregister(&sd_driver);
}

module_init(sd_mod_init);
module_exit(sd_mod_exit);
Commit	Line	Data
6a7eba24 JFM	1	/*
	2	* Mars-Semi MR97311A library
	3	* Copyright (C) 2005 <bradlch@hotmail.com>
	4	*
	5	* V4L2 by Jean-Francois Moine <http://moinejf.free.fr>
	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License as published by
	9	* the Free Software Foundation; either version 2 of the License, or
	10	* any later version.
	11	*
	12	* This program is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	* GNU General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU General Public License
	18	* along with this program; if not, write to the Free Software
	19	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	20	*/
	21
	22	#define MODULE_NAME "mars"
	23
	24	#include "gspca.h"
	25	#include "jpeg.h"
	26
6a7eba24 JFM	27	MODULE_AUTHOR("Michel Xhaard <mxhaard@users.sourceforge.net>");
	28	MODULE_DESCRIPTION("GSPCA/Mars USB Camera Driver");
	29	MODULE_LICENSE("GPL");
	30
e3b4d2c6 JFM	31	/* controls */
	32	enum e_ctrl {
	33	BRIGHTNESS,
	34	COLORS,
	35	GAMMA,
	36	SHARPNESS,
fba39807 JFM	37	ILLUM_TOP,
fba39807 JFM	38	ILLUM_BOT,
e3b4d2c6 JFM	39	NCTRLS /* number of controls */
	40	};
	41
6a7eba24 JFM	42	/* specific webcam descriptor */
	43	struct sd {
	44	struct gspca_dev gspca_dev; /* !! must be the first item */
a0306bfa	45
e3b4d2c6 JFM	46	struct gspca_ctrl ctrls[NCTRLS];
e3b4d2c6 JFM	47
71cb2764	48	u8 quality;
77ac0baf JFM	49	#define QUALITY_MIN 40
	50	#define QUALITY_MAX 70
	51	#define QUALITY_DEF 50
71cb2764	52
9a731a32	53	u8 jpeg_hdr[JPEG_HDR_SZ];
6a7eba24 JFM	54	};
	55
	56	/* V4L2 controls supported by the driver */
e3b4d2c6 JFM	57	static void setbrightness(struct gspca_dev *gspca_dev);
	58	static void setcolors(struct gspca_dev *gspca_dev);
	59	static void setgamma(struct gspca_dev *gspca_dev);
	60	static void setsharpness(struct gspca_dev *gspca_dev);
fba39807 JFM	61	static int sd_setilluminator1(struct gspca_dev *gspca_dev, __s32 val);
fba39807 JFM	62	static int sd_setilluminator2(struct gspca_dev *gspca_dev, __s32 val);
e3b4d2c6 JFM	63
	64	static const struct ctrl sd_ctrls[NCTRLS] = {
	65	[BRIGHTNESS] = {
a0306bfa JFM	66	{
	67	.id = V4L2_CID_BRIGHTNESS,
	68	.type = V4L2_CTRL_TYPE_INTEGER,
	69	.name = "Brightness",
	70	.minimum = 0,
	71	.maximum = 30,
	72	.step = 1,
e3b4d2c6	73	.default_value = 15,
a0306bfa	74	},
e3b4d2c6	75	.set_control = setbrightness
a0306bfa	76	},
e3b4d2c6	77	[COLORS] = {
a0306bfa JFM	78	{
	79	.id = V4L2_CID_SATURATION,
	80	.type = V4L2_CTRL_TYPE_INTEGER,
	81	.name = "Color",
253bae57 JFM	82	.minimum = 1,
253bae57 JFM	83	.maximum = 255,
a0306bfa	84	.step = 1,
e3b4d2c6	85	.default_value = 200,
a0306bfa	86	},
e3b4d2c6	87	.set_control = setcolors
a0306bfa	88	},
e3b4d2c6	89	[GAMMA] = {
a0306bfa JFM	90	{
	91	.id = V4L2_CID_GAMMA,
	92	.type = V4L2_CTRL_TYPE_INTEGER,
	93	.name = "Gamma",
	94	.minimum = 0,
	95	.maximum = 3,
	96	.step = 1,
e3b4d2c6	97	.default_value = 1,
a0306bfa	98	},
e3b4d2c6	99	.set_control = setgamma
a0306bfa	100	},
e3b4d2c6	101	[SHARPNESS] = {
a0306bfa JFM	102	{
	103	.id = V4L2_CID_SHARPNESS,
	104	.type = V4L2_CTRL_TYPE_INTEGER,
	105	.name = "Sharpness",
	106	.minimum = 0,
	107	.maximum = 2,
	108	.step = 1,
e3b4d2c6	109	.default_value = 1,
a0306bfa	110	},
e3b4d2c6	111	.set_control = setsharpness
a0306bfa	112	},
fba39807 JFM	113	[ILLUM_TOP] = {
	114	{
	115	.id = V4L2_CID_ILLUMINATORS_1,
	116	.type = V4L2_CTRL_TYPE_BOOLEAN,
	117	.name = "Top illuminator",
	118	.minimum = 0,
	119	.maximum = 1,
	120	.step = 1,
	121	.default_value = 0,
	122	.flags = V4L2_CTRL_FLAG_UPDATE,
	123	},
	124	.set = sd_setilluminator1
	125	},
	126	[ILLUM_BOT] = {
	127	{
	128	.id = V4L2_CID_ILLUMINATORS_2,
	129	.type = V4L2_CTRL_TYPE_BOOLEAN,
	130	.name = "Bottom illuminator",
	131	.minimum = 0,
	132	.maximum = 1,
	133	.step = 1,
	134	.default_value = 0,
	135	.flags = V4L2_CTRL_FLAG_UPDATE,
	136	},
	137	.set = sd_setilluminator2
	138	},
6a7eba24 JFM	139	};
6a7eba24 JFM	140
cc611b8a	141	static const struct v4l2_pix_format vga_mode[] = {
c2446b3e JFM	142	{320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
c2446b3e JFM	143	.bytesperline = 320,
a0306bfa	144	.sizeimage = 320 * 240 * 3 / 8 + 590,
c2446b3e JFM	145	.colorspace = V4L2_COLORSPACE_JPEG,
	146	.priv = 2},
	147	{640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
	148	.bytesperline = 640,
	149	.sizeimage = 640 * 480 * 3 / 8 + 590,
	150	.colorspace = V4L2_COLORSPACE_JPEG,
	151	.priv = 1},
6a7eba24 JFM	152	};
6a7eba24 JFM	153
a0306bfa JFM	154	static const __u8 mi_data[0x20] = {
	155	/* 01 02 03 04 05 06 07 08 */
	156	0x48, 0x22, 0x01, 0x47, 0x10, 0x00, 0x00, 0x00,
	157	/* 09 0a 0b 0c 0d 0e 0f 10 */
	158	0x00, 0x01, 0x30, 0x01, 0x30, 0x01, 0x30, 0x01,
	159	/* 11 12 13 14 15 16 17 18 */
	160	0x30, 0x00, 0x04, 0x00, 0x06, 0x01, 0xe2, 0x02,
	161	/* 19 1a 1b 1c 1d 1e 1f 20 */
	162	0x82, 0x00, 0x20, 0x17, 0x80, 0x08, 0x0c, 0x00
6a7eba24 JFM	163	};
6a7eba24 JFM	164
a0306bfa	165	/* write <len> bytes from gspca_dev->usb_buf */
d4015493	166	static void reg_w(struct gspca_dev *gspca_dev,
a0306bfa	167	int len)
6a7eba24	168	{
a0306bfa JFM	169	int alen, ret;
a0306bfa JFM	170
d4015493 JFM	171	if (gspca_dev->usb_err < 0)
	172	return;
	173
a0306bfa JFM	174	ret = usb_bulk_msg(gspca_dev->dev,
	175	usb_sndbulkpipe(gspca_dev->dev, 4),
	176	gspca_dev->usb_buf,
	177	len,
	178	&alen,
	179	500); /* timeout in milliseconds */
d4015493	180	if (ret < 0) {
0b656321	181	err("reg write [%02x] error %d",
a0306bfa	182	gspca_dev->usb_buf[0], ret);
d4015493 JFM	183	gspca_dev->usb_err = ret;
d4015493 JFM	184	}
6a7eba24 JFM	185	}
6a7eba24 JFM	186
a0306bfa JFM	187	static void mi_w(struct gspca_dev *gspca_dev,
	188	u8 addr,
	189	u8 value)
739570bb JFM	190	{
	191	gspca_dev->usb_buf[0] = 0x1f;
	192	gspca_dev->usb_buf[1] = 0; /* control byte */
a0306bfa JFM	193	gspca_dev->usb_buf[2] = addr;
a0306bfa JFM	194	gspca_dev->usb_buf[3] = value;
6a7eba24	195
a0306bfa	196	reg_w(gspca_dev, 4);
6a7eba24 JFM	197	}
6a7eba24 JFM	198
e3b4d2c6 JFM	199	static void setbrightness(struct gspca_dev *gspca_dev)
	200	{
	201	struct sd sd = (struct sd ) gspca_dev;
	202
	203	gspca_dev->usb_buf[0] = 0x61;
	204	gspca_dev->usb_buf[1] = sd->ctrls[BRIGHTNESS].val;
	205	reg_w(gspca_dev, 2);
	206	}
	207
	208	static void setcolors(struct gspca_dev *gspca_dev)
	209	{
	210	struct sd sd = (struct sd ) gspca_dev;
	211	s16 val;
	212
	213	val = sd->ctrls[COLORS].val;
	214	gspca_dev->usb_buf[0] = 0x5f;
	215	gspca_dev->usb_buf[1] = val << 3;
	216	gspca_dev->usb_buf[2] = ((val >> 2) & 0xf8) \| 0x04;
	217	reg_w(gspca_dev, 3);
	218	}
	219
	220	static void setgamma(struct gspca_dev *gspca_dev)
	221	{
	222	struct sd sd = (struct sd ) gspca_dev;
	223
	224	gspca_dev->usb_buf[0] = 0x06;
	225	gspca_dev->usb_buf[1] = sd->ctrls[GAMMA].val * 0x40;
	226	reg_w(gspca_dev, 2);
	227	}
	228
	229	static void setsharpness(struct gspca_dev *gspca_dev)
	230	{
	231	struct sd sd = (struct sd ) gspca_dev;
	232
	233	gspca_dev->usb_buf[0] = 0x67;
	234	gspca_dev->usb_buf[1] = sd->ctrls[SHARPNESS].val * 4 + 3;
	235	reg_w(gspca_dev, 2);
	236	}
	237
fba39807 JFM	238	static void setilluminators(struct gspca_dev *gspca_dev)
	239	{
	240	struct sd sd = (struct sd ) gspca_dev;
	241
	242	gspca_dev->usb_buf[0] = 0x22;
	243	if (sd->ctrls[ILLUM_TOP].val)
	244	gspca_dev->usb_buf[1] = 0x76;
	245	else if (sd->ctrls[ILLUM_BOT].val)
	246	gspca_dev->usb_buf[1] = 0x7a;
	247	else
	248	gspca_dev->usb_buf[1] = 0x7e;
	249	reg_w(gspca_dev, 2);
	250	}
	251
6a7eba24 JFM	252	/* this function is called at probe time */
	253	static int sd_config(struct gspca_dev *gspca_dev,
	254	const struct usb_device_id *id)
	255	{
a0306bfa	256	struct sd sd = (struct sd ) gspca_dev;
6a7eba24 JFM	257	struct cam *cam;
	258
	259	cam = &gspca_dev->cam;
6a7eba24	260	cam->cam_mode = vga_mode;
80297125	261	cam->nmodes = ARRAY_SIZE(vga_mode);
e3b4d2c6	262	cam->ctrls = sd->ctrls;
77ac0baf	263	sd->quality = QUALITY_DEF;
625deb3d	264	gspca_dev->nbalt = 9; /* use the altsetting 08 */
6a7eba24 JFM	265	return 0;
	266	}
	267
012d6b02 JFM	268	/* this function is called at probe and resume time */
012d6b02 JFM	269	static int sd_init(struct gspca_dev *gspca_dev)
6a7eba24	270	{
fba39807	271	gspca_dev->ctrl_inac = (1 << ILLUM_TOP) \| (1 << ILLUM_BOT);
6a7eba24 JFM	272	return 0;
	273	}
	274
72ab97ce	275	static int sd_start(struct gspca_dev *gspca_dev)
6a7eba24	276	{
a0306bfa	277	struct sd sd = (struct sd ) gspca_dev;
a0306bfa	278	u8 *data;
253bae57	279	int i;
6a7eba24	280
71cb2764	281	/* create the JPEG header */
71cb2764 JFM	282	jpeg_define(sd->jpeg_hdr, gspca_dev->height, gspca_dev->width,
	283	0x21); /* JPEG 422 */
	284	jpeg_set_qual(sd->jpeg_hdr, sd->quality);
	285
739570bb	286	data = gspca_dev->usb_buf;
a0306bfa	287
6a7eba24 JFM	288	data[0] = 0x01; /* address */
6a7eba24 JFM	289	data[1] = 0x01;
d4015493	290	reg_w(gspca_dev, 2);
6a7eba24 JFM	291
	292	/*
	293	Initialize the MR97113 chip register
	294	*/
	295	data[0] = 0x00; /* address */
	296	data[1] = 0x0c \| 0x01; /* reg 0 */
	297	data[2] = 0x01; /* reg 1 */
a0306bfa JFM	298	data[3] = gspca_dev->width / 8; /* h_size , reg 2 */
a0306bfa JFM	299	data[4] = gspca_dev->height / 8; /* v_size , reg 3 */
6a7eba24 JFM	300	data[5] = 0x30; /* reg 4, MI, PAS5101 :
6a7eba24 JFM	301	* 0x30 for 24mhz , 0x28 for 12mhz */
a0306bfa	302	data[6] = 0x02; /* reg 5, H start - was 0x04 */
e3b4d2c6	303	data[7] = sd->ctrls[GAMMA].val * 0x40; /* reg 0x06: gamma */
a0306bfa	304	data[8] = 0x01; /* reg 7, V start - was 0x03 */
739570bb	305	/* if (h_size == 320 ) */
6a7eba24 JFM	306	/* data[9]= 0x56; * reg 8, 24MHz, 2:1 scale down */
	307	/* else */
	308	data[9] = 0x52; /* reg 8, 24MHz, no scale down */
a0306bfa JFM	309	/jfm: from win trace/
a0306bfa JFM	310	data[10] = 0x18;
6a7eba24	311
d4015493	312	reg_w(gspca_dev, 11);
6a7eba24 JFM	313
	314	data[0] = 0x23; /* address */
	315	data[1] = 0x09; /* reg 35, append frame header */
	316
d4015493	317	reg_w(gspca_dev, 2);
6a7eba24	318
739570bb JFM	319	data[0] = 0x3c; /* address */
739570bb JFM	320	/* if (gspca_dev->width == 1280) */
6a7eba24 JFM	321	/* data[1] = 200; * reg 60, pc-cam frame size
	322	* (unit: 4KB) 800KB */
	323	/* else */
	324	data[1] = 50; /* 50 reg 60, pc-cam frame size
	325	* (unit: 4KB) 200KB */
d4015493	326	reg_w(gspca_dev, 2);
6a7eba24	327
6a7eba24 JFM	328	/* auto dark-gain */
6a7eba24 JFM	329	data[0] = 0x5e; /* address */
a0306bfa JFM	330	data[1] = 0; /* reg 94, Y Gain (auto) */
a0306bfa JFM	331	/jfm: from win trace/
253bae57 JFM	332	/* reg 0x5f/0x60 (LE) = saturation */
	333	/* h (60): xxxx x100
	334	* l (5f): xxxx x000 */
e3b4d2c6 JFM	335	data[2] = sd->ctrls[COLORS].val << 3;
	336	data[3] = ((sd->ctrls[COLORS].val >> 2) & 0xf8) \| 0x04;
	337	data[4] = sd->ctrls[BRIGHTNESS].val; /* reg 0x61 = brightness */
a0306bfa JFM	338	data[5] = 0x00;
a0306bfa JFM	339
d4015493	340	reg_w(gspca_dev, 6);
6a7eba24 JFM	341
6a7eba24 JFM	342	data[0] = 0x67;
a0306bfa	343	/jfm: from win trace/
e3b4d2c6	344	data[1] = sd->ctrls[SHARPNESS].val * 4 + 3;
a0306bfa	345	data[2] = 0x14;
d4015493	346	reg_w(gspca_dev, 3);
6a7eba24	347
a0306bfa JFM	348	data[0] = 0x69;
	349	data[1] = 0x2f;
	350	data[2] = 0x28;
	351	data[3] = 0x42;
d4015493	352	reg_w(gspca_dev, 4);
a0306bfa JFM	353
	354	data[0] = 0x63;
	355	data[1] = 0x07;
d4015493	356	reg_w(gspca_dev, 2);
a0306bfa	357	/jfm: win trace - many writes here to reg 0x64/
a0306bfa JFM	358
	359	/* initialize the MI sensor */
	360	for (i = 0; i < sizeof mi_data; i++)
	361	mi_w(gspca_dev, i + 1, mi_data[i]);
6a7eba24 JFM	362
6a7eba24 JFM	363	data[0] = 0x00;
25985edc	364	data[1] = 0x4d; /* ISOC transferring enable... */
a0306bfa	365	reg_w(gspca_dev, 2);
d4015493	366
fba39807	367	gspca_dev->ctrl_inac = 0; /* activate the illuminator controls */
d4015493	368	return gspca_dev->usb_err;
6a7eba24 JFM	369	}
	370
	371	static void sd_stopN(struct gspca_dev *gspca_dev)
	372	{
fba39807 JFM	373	struct sd sd = (struct sd ) gspca_dev;
	374
	375	gspca_dev->ctrl_inac = (1 << ILLUM_TOP) \| (1 << ILLUM_BOT);
	376	if (sd->ctrls[ILLUM_TOP].val \|\| sd->ctrls[ILLUM_BOT].val) {
	377	sd->ctrls[ILLUM_TOP].val = 0;
	378	sd->ctrls[ILLUM_BOT].val = 0;
	379	setilluminators(gspca_dev);
	380	msleep(20);
	381	}
	382
739570bb JFM	383	gspca_dev->usb_buf[0] = 1;
739570bb JFM	384	gspca_dev->usb_buf[1] = 0;
d4015493	385	reg_w(gspca_dev, 2);
6a7eba24 JFM	386	}
6a7eba24 JFM	387
6a7eba24	388	static void sd_pkt_scan(struct gspca_dev *gspca_dev,
76dd272b	389	u8 data, / isoc packet */
6a7eba24 JFM	390	int len) /* iso packet length */
6a7eba24 JFM	391	{
71cb2764	392	struct sd sd = (struct sd ) gspca_dev;
6a7eba24 JFM	393	int p;
	394
	395	if (len < 6) {
	396	/* gspca_dev->last_packet_type = DISCARD_PACKET; */
	397	return;
	398	}
	399	for (p = 0; p < len - 6; p++) {
	400	if (data[0 + p] == 0xff
	401	&& data[1 + p] == 0xff
	402	&& data[2 + p] == 0x00
	403	&& data[3 + p] == 0xff
	404	&& data[4 + p] == 0x96) {
	405	if (data[5 + p] == 0x64
	406	\|\| data[5 + p] == 0x65
	407	\|\| data[5 + p] == 0x66
	408	\|\| data[5 + p] == 0x67) {
a0306bfa	409	PDEBUG(D_PACK, "sof offset: %d len: %d",
6a7eba24	410	p, len);
76dd272b JFM	411	gspca_frame_add(gspca_dev, LAST_PACKET,
76dd272b JFM	412	data, p);
6a7eba24 JFM	413
6a7eba24 JFM	414	/* put the JPEG header */
76dd272b	415	gspca_frame_add(gspca_dev, FIRST_PACKET,
71cb2764	416	sd->jpeg_hdr, JPEG_HDR_SZ);
0a32ef3f JFM	417	data += p + 16;
0a32ef3f JFM	418	len -= p + 16;
6a7eba24 JFM	419	break;
	420	}
	421	}
	422	}
76dd272b	423	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
6a7eba24 JFM	424	}
6a7eba24 JFM	425
fba39807 JFM	426	static int sd_setilluminator1(struct gspca_dev *gspca_dev, __s32 val)
	427	{
	428	struct sd sd = (struct sd ) gspca_dev;
	429
	430	/* only one illuminator may be on */
	431	sd->ctrls[ILLUM_TOP].val = val;
	432	if (val)
	433	sd->ctrls[ILLUM_BOT].val = 0;
	434	setilluminators(gspca_dev);
	435	return gspca_dev->usb_err;
	436	}
	437
	438	static int sd_setilluminator2(struct gspca_dev *gspca_dev, __s32 val)
	439	{
	440	struct sd sd = (struct sd ) gspca_dev;
	441
	442	/* only one illuminator may be on */
	443	sd->ctrls[ILLUM_BOT].val = val;
	444	if (val)
	445	sd->ctrls[ILLUM_TOP].val = 0;
	446	setilluminators(gspca_dev);
	447	return gspca_dev->usb_err;
	448	}
	449
77ac0baf JFM	450	static int sd_set_jcomp(struct gspca_dev *gspca_dev,
	451	struct v4l2_jpegcompression *jcomp)
	452	{
	453	struct sd sd = (struct sd ) gspca_dev;
	454
	455	if (jcomp->quality < QUALITY_MIN)
	456	sd->quality = QUALITY_MIN;
	457	else if (jcomp->quality > QUALITY_MAX)
	458	sd->quality = QUALITY_MAX;
	459	else
	460	sd->quality = jcomp->quality;
	461	if (gspca_dev->streaming)
	462	jpeg_set_qual(sd->jpeg_hdr, sd->quality);
	463	return 0;
	464	}
	465
	466	static int sd_get_jcomp(struct gspca_dev *gspca_dev,
	467	struct v4l2_jpegcompression *jcomp)
	468	{
	469	struct sd sd = (struct sd ) gspca_dev;
	470
	471	memset(jcomp, 0, sizeof *jcomp);
	472	jcomp->quality = sd->quality;
	473	jcomp->jpeg_markers = V4L2_JPEG_MARKER_DHT
	474	\| V4L2_JPEG_MARKER_DQT;
	475	return 0;
	476	}
	477
6a7eba24	478	/* sub-driver description */
a5ae2062	479	static const struct sd_desc sd_desc = {
6a7eba24 JFM	480	.name = MODULE_NAME,
6a7eba24 JFM	481	.ctrls = sd_ctrls,
e3b4d2c6	482	.nctrls = NCTRLS,
6a7eba24	483	.config = sd_config,
012d6b02	484	.init = sd_init,
6a7eba24 JFM	485	.start = sd_start,
6a7eba24 JFM	486	.stopN = sd_stopN,
6a7eba24	487	.pkt_scan = sd_pkt_scan,
77ac0baf JFM	488	.get_jcomp = sd_get_jcomp,
77ac0baf JFM	489	.set_jcomp = sd_set_jcomp,
6a7eba24 JFM	490	};
	491
	492	/* -- module initialisation -- */
95c967c1	493	static const struct usb_device_id device_table[] = {
9d64fdb1	494	{USB_DEVICE(0x093a, 0x050f)},
6a7eba24 JFM	495	{}
	496	};
	497	MODULE_DEVICE_TABLE(usb, device_table);
	498
	499	/* -- device connect -- */
	500	static int sd_probe(struct usb_interface *intf,
	501	const struct usb_device_id *id)
	502	{
	503	return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
	504	THIS_MODULE);
	505	}
	506
	507	static struct usb_driver sd_driver = {
	508	.name = MODULE_NAME,
	509	.id_table = device_table,
	510	.probe = sd_probe,
	511	.disconnect = gspca_disconnect,
6a709749 JFM	512	#ifdef CONFIG_PM
	513	.suspend = gspca_suspend,
	514	.resume = gspca_resume,
	515	#endif
6a7eba24 JFM	516	};
	517
	518	/* -- module insert / remove -- */
	519	static int __init sd_mod_init(void)
	520	{
54826437	521	return usb_register(&sd_driver);
6a7eba24 JFM	522	}
	523	static void __exit sd_mod_exit(void)
	524	{
	525	usb_deregister(&sd_driver);
6a7eba24 JFM	526	}
	527
	528	module_init(sd_mod_init);
	529	module_exit(sd_mod_exit);