[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,
	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 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
	},
};

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 int reg_w(struct gspca_dev *gspca_dev,
		 int len)
{
	int alen, ret;

	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);
	return 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);
}

/* 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)
{
	return 0;
}

static int sd_start(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;
	int err_code;
	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;
	err_code = reg_w(gspca_dev, 2);
	if (err_code < 0)
		return err_code;

	/*
	   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;

	err_code = reg_w(gspca_dev, 11);
	if (err_code < 0)
		return err_code;

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

	err_code = reg_w(gspca_dev, 2);
	if (err_code < 0)
		return err_code;

	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 */
	err_code = reg_w(gspca_dev, 2);
	if (err_code < 0)
		return err_code;

	/* 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;

	err_code = reg_w(gspca_dev, 6);
	if (err_code < 0)
		return err_code;

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

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

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

	/* 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 transfering enable... */
	reg_w(gspca_dev, 2);
	return 0;
}

static void sd_stopN(struct gspca_dev *gspca_dev)
{
	int result;

	gspca_dev->usb_buf[0] = 1;
	gspca_dev->usb_buf[1] = 0;
	result = reg_w(gspca_dev, 2);
	if (result < 0)
		PDEBUG(D_ERR, "Camera Stop failed");
}

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_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 __devinitdata 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,
	37	NCTRLS /* number of controls */
	38	};
	39
6a7eba24 JFM	40	/* specific webcam descriptor */
	41	struct sd {
	42	struct gspca_dev gspca_dev; /* !! must be the first item */
a0306bfa	43
e3b4d2c6 JFM	44	struct gspca_ctrl ctrls[NCTRLS];
e3b4d2c6 JFM	45
71cb2764	46	u8 quality;
77ac0baf JFM	47	#define QUALITY_MIN 40
	48	#define QUALITY_MAX 70
	49	#define QUALITY_DEF 50
71cb2764	50
9a731a32	51	u8 jpeg_hdr[JPEG_HDR_SZ];
6a7eba24 JFM	52	};
	53
	54	/* V4L2 controls supported by the driver */
e3b4d2c6 JFM	55	static void setbrightness(struct gspca_dev *gspca_dev);
	56	static void setcolors(struct gspca_dev *gspca_dev);
	57	static void setgamma(struct gspca_dev *gspca_dev);
	58	static void setsharpness(struct gspca_dev *gspca_dev);
	59
	60	static const struct ctrl sd_ctrls[NCTRLS] = {
	61	[BRIGHTNESS] = {
a0306bfa JFM	62	{
	63	.id = V4L2_CID_BRIGHTNESS,
	64	.type = V4L2_CTRL_TYPE_INTEGER,
	65	.name = "Brightness",
	66	.minimum = 0,
	67	.maximum = 30,
	68	.step = 1,
e3b4d2c6	69	.default_value = 15,
a0306bfa	70	},
e3b4d2c6	71	.set_control = setbrightness
a0306bfa	72	},
e3b4d2c6	73	[COLORS] = {
a0306bfa JFM	74	{
	75	.id = V4L2_CID_SATURATION,
	76	.type = V4L2_CTRL_TYPE_INTEGER,
	77	.name = "Color",
253bae57 JFM	78	.minimum = 1,
253bae57 JFM	79	.maximum = 255,
a0306bfa	80	.step = 1,
e3b4d2c6	81	.default_value = 200,
a0306bfa	82	},
e3b4d2c6	83	.set_control = setcolors
a0306bfa	84	},
e3b4d2c6	85	[GAMMA] = {
a0306bfa JFM	86	{
	87	.id = V4L2_CID_GAMMA,
	88	.type = V4L2_CTRL_TYPE_INTEGER,
	89	.name = "Gamma",
	90	.minimum = 0,
	91	.maximum = 3,
	92	.step = 1,
e3b4d2c6	93	.default_value = 1,
a0306bfa	94	},
e3b4d2c6	95	.set_control = setgamma
a0306bfa	96	},
e3b4d2c6	97	[SHARPNESS] = {
a0306bfa JFM	98	{
	99	.id = V4L2_CID_SHARPNESS,
	100	.type = V4L2_CTRL_TYPE_INTEGER,
	101	.name = "Sharpness",
	102	.minimum = 0,
	103	.maximum = 2,
	104	.step = 1,
e3b4d2c6	105	.default_value = 1,
a0306bfa	106	},
e3b4d2c6	107	.set_control = setsharpness
a0306bfa	108	},
6a7eba24 JFM	109	};
6a7eba24 JFM	110
cc611b8a	111	static const struct v4l2_pix_format vga_mode[] = {
c2446b3e JFM	112	{320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
c2446b3e JFM	113	.bytesperline = 320,
a0306bfa	114	.sizeimage = 320 * 240 * 3 / 8 + 590,
c2446b3e JFM	115	.colorspace = V4L2_COLORSPACE_JPEG,
	116	.priv = 2},
	117	{640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
	118	.bytesperline = 640,
	119	.sizeimage = 640 * 480 * 3 / 8 + 590,
	120	.colorspace = V4L2_COLORSPACE_JPEG,
	121	.priv = 1},
6a7eba24 JFM	122	};
6a7eba24 JFM	123
a0306bfa JFM	124	static const __u8 mi_data[0x20] = {
	125	/* 01 02 03 04 05 06 07 08 */
	126	0x48, 0x22, 0x01, 0x47, 0x10, 0x00, 0x00, 0x00,
	127	/* 09 0a 0b 0c 0d 0e 0f 10 */
	128	0x00, 0x01, 0x30, 0x01, 0x30, 0x01, 0x30, 0x01,
	129	/* 11 12 13 14 15 16 17 18 */
	130	0x30, 0x00, 0x04, 0x00, 0x06, 0x01, 0xe2, 0x02,
	131	/* 19 1a 1b 1c 1d 1e 1f 20 */
	132	0x82, 0x00, 0x20, 0x17, 0x80, 0x08, 0x0c, 0x00
6a7eba24 JFM	133	};
6a7eba24 JFM	134
a0306bfa	135	/* write <len> bytes from gspca_dev->usb_buf */
739570bb	136	static int reg_w(struct gspca_dev *gspca_dev,
a0306bfa	137	int len)
6a7eba24	138	{
a0306bfa JFM	139	int alen, ret;
	140
	141	ret = usb_bulk_msg(gspca_dev->dev,
	142	usb_sndbulkpipe(gspca_dev->dev, 4),
	143	gspca_dev->usb_buf,
	144	len,
	145	&alen,
	146	500); /* timeout in milliseconds */
	147	if (ret < 0)
0b656321	148	err("reg write [%02x] error %d",
a0306bfa JFM	149	gspca_dev->usb_buf[0], ret);
a0306bfa JFM	150	return ret;
6a7eba24 JFM	151	}
6a7eba24 JFM	152
a0306bfa JFM	153	static void mi_w(struct gspca_dev *gspca_dev,
	154	u8 addr,
	155	u8 value)
739570bb JFM	156	{
	157	gspca_dev->usb_buf[0] = 0x1f;
	158	gspca_dev->usb_buf[1] = 0; /* control byte */
a0306bfa JFM	159	gspca_dev->usb_buf[2] = addr;
a0306bfa JFM	160	gspca_dev->usb_buf[3] = value;
6a7eba24	161
a0306bfa	162	reg_w(gspca_dev, 4);
6a7eba24 JFM	163	}
6a7eba24 JFM	164
e3b4d2c6 JFM	165	static void setbrightness(struct gspca_dev *gspca_dev)
	166	{
	167	struct sd sd = (struct sd ) gspca_dev;
	168
	169	gspca_dev->usb_buf[0] = 0x61;
	170	gspca_dev->usb_buf[1] = sd->ctrls[BRIGHTNESS].val;
	171	reg_w(gspca_dev, 2);
	172	}
	173
	174	static void setcolors(struct gspca_dev *gspca_dev)
	175	{
	176	struct sd sd = (struct sd ) gspca_dev;
	177	s16 val;
	178
	179	val = sd->ctrls[COLORS].val;
	180	gspca_dev->usb_buf[0] = 0x5f;
	181	gspca_dev->usb_buf[1] = val << 3;
	182	gspca_dev->usb_buf[2] = ((val >> 2) & 0xf8) \| 0x04;
	183	reg_w(gspca_dev, 3);
	184	}
	185
	186	static void setgamma(struct gspca_dev *gspca_dev)
	187	{
	188	struct sd sd = (struct sd ) gspca_dev;
	189
	190	gspca_dev->usb_buf[0] = 0x06;
	191	gspca_dev->usb_buf[1] = sd->ctrls[GAMMA].val * 0x40;
	192	reg_w(gspca_dev, 2);
	193	}
	194
	195	static void setsharpness(struct gspca_dev *gspca_dev)
	196	{
	197	struct sd sd = (struct sd ) gspca_dev;
	198
	199	gspca_dev->usb_buf[0] = 0x67;
	200	gspca_dev->usb_buf[1] = sd->ctrls[SHARPNESS].val * 4 + 3;
	201	reg_w(gspca_dev, 2);
	202	}
	203
6a7eba24 JFM	204	/* this function is called at probe time */
	205	static int sd_config(struct gspca_dev *gspca_dev,
	206	const struct usb_device_id *id)
	207	{
a0306bfa	208	struct sd sd = (struct sd ) gspca_dev;
6a7eba24 JFM	209	struct cam *cam;
	210
	211	cam = &gspca_dev->cam;
6a7eba24	212	cam->cam_mode = vga_mode;
80297125	213	cam->nmodes = ARRAY_SIZE(vga_mode);
e3b4d2c6	214	cam->ctrls = sd->ctrls;
77ac0baf	215	sd->quality = QUALITY_DEF;
625deb3d	216	gspca_dev->nbalt = 9; /* use the altsetting 08 */
6a7eba24 JFM	217	return 0;
	218	}
	219
012d6b02 JFM	220	/* this function is called at probe and resume time */
012d6b02 JFM	221	static int sd_init(struct gspca_dev *gspca_dev)
6a7eba24 JFM	222	{
	223	return 0;
	224	}
	225
72ab97ce	226	static int sd_start(struct gspca_dev *gspca_dev)
6a7eba24	227	{
a0306bfa	228	struct sd sd = (struct sd ) gspca_dev;
6a7eba24	229	int err_code;
a0306bfa	230	u8 *data;
253bae57	231	int i;
6a7eba24	232
71cb2764	233	/* create the JPEG header */
71cb2764 JFM	234	jpeg_define(sd->jpeg_hdr, gspca_dev->height, gspca_dev->width,
	235	0x21); /* JPEG 422 */
	236	jpeg_set_qual(sd->jpeg_hdr, sd->quality);
	237
739570bb	238	data = gspca_dev->usb_buf;
a0306bfa	239
6a7eba24 JFM	240	data[0] = 0x01; /* address */
6a7eba24 JFM	241	data[1] = 0x01;
a0306bfa	242	err_code = reg_w(gspca_dev, 2);
6a7eba24	243	if (err_code < 0)
72ab97ce	244	return err_code;
6a7eba24 JFM	245
	246	/*
	247	Initialize the MR97113 chip register
	248	*/
	249	data[0] = 0x00; /* address */
	250	data[1] = 0x0c \| 0x01; /* reg 0 */
	251	data[2] = 0x01; /* reg 1 */
a0306bfa JFM	252	data[3] = gspca_dev->width / 8; /* h_size , reg 2 */
a0306bfa JFM	253	data[4] = gspca_dev->height / 8; /* v_size , reg 3 */
6a7eba24 JFM	254	data[5] = 0x30; /* reg 4, MI, PAS5101 :
6a7eba24 JFM	255	* 0x30 for 24mhz , 0x28 for 12mhz */
a0306bfa	256	data[6] = 0x02; /* reg 5, H start - was 0x04 */
e3b4d2c6	257	data[7] = sd->ctrls[GAMMA].val * 0x40; /* reg 0x06: gamma */
a0306bfa	258	data[8] = 0x01; /* reg 7, V start - was 0x03 */
739570bb	259	/* if (h_size == 320 ) */
6a7eba24 JFM	260	/* data[9]= 0x56; * reg 8, 24MHz, 2:1 scale down */
	261	/* else */
	262	data[9] = 0x52; /* reg 8, 24MHz, no scale down */
a0306bfa JFM	263	/jfm: from win trace/
a0306bfa JFM	264	data[10] = 0x18;
6a7eba24	265
a0306bfa	266	err_code = reg_w(gspca_dev, 11);
6a7eba24	267	if (err_code < 0)
72ab97ce	268	return err_code;
6a7eba24 JFM	269
	270	data[0] = 0x23; /* address */
	271	data[1] = 0x09; /* reg 35, append frame header */
	272
a0306bfa	273	err_code = reg_w(gspca_dev, 2);
739570bb	274	if (err_code < 0)
72ab97ce	275	return err_code;
6a7eba24	276
739570bb JFM	277	data[0] = 0x3c; /* address */
739570bb JFM	278	/* if (gspca_dev->width == 1280) */
6a7eba24 JFM	279	/* data[1] = 200; * reg 60, pc-cam frame size
	280	* (unit: 4KB) 800KB */
	281	/* else */
	282	data[1] = 50; /* 50 reg 60, pc-cam frame size
	283	* (unit: 4KB) 200KB */
a0306bfa	284	err_code = reg_w(gspca_dev, 2);
6a7eba24	285	if (err_code < 0)
72ab97ce	286	return err_code;
6a7eba24	287
6a7eba24 JFM	288	/* auto dark-gain */
6a7eba24 JFM	289	data[0] = 0x5e; /* address */
a0306bfa JFM	290	data[1] = 0; /* reg 94, Y Gain (auto) */
a0306bfa JFM	291	/jfm: from win trace/
253bae57 JFM	292	/* reg 0x5f/0x60 (LE) = saturation */
	293	/* h (60): xxxx x100
	294	* l (5f): xxxx x000 */
e3b4d2c6 JFM	295	data[2] = sd->ctrls[COLORS].val << 3;
	296	data[3] = ((sd->ctrls[COLORS].val >> 2) & 0xf8) \| 0x04;
	297	data[4] = sd->ctrls[BRIGHTNESS].val; /* reg 0x61 = brightness */
a0306bfa JFM	298	data[5] = 0x00;
	299
	300	err_code = reg_w(gspca_dev, 6);
6a7eba24	301	if (err_code < 0)
72ab97ce	302	return err_code;
6a7eba24 JFM	303
6a7eba24 JFM	304	data[0] = 0x67;
a0306bfa	305	/jfm: from win trace/
e3b4d2c6	306	data[1] = sd->ctrls[SHARPNESS].val * 4 + 3;
a0306bfa JFM	307	data[2] = 0x14;
a0306bfa JFM	308	err_code = reg_w(gspca_dev, 3);
6a7eba24	309	if (err_code < 0)
72ab97ce	310	return err_code;
6a7eba24	311
a0306bfa JFM	312	data[0] = 0x69;
	313	data[1] = 0x2f;
	314	data[2] = 0x28;
	315	data[3] = 0x42;
	316	err_code = reg_w(gspca_dev, 4);
	317	if (err_code < 0)
	318	return err_code;
	319
	320	data[0] = 0x63;
	321	data[1] = 0x07;
	322	err_code = reg_w(gspca_dev, 2);
	323	/jfm: win trace - many writes here to reg 0x64/
	324	if (err_code < 0)
	325	return err_code;
	326
	327	/* initialize the MI sensor */
	328	for (i = 0; i < sizeof mi_data; i++)
	329	mi_w(gspca_dev, i + 1, mi_data[i]);
6a7eba24 JFM	330
	331	data[0] = 0x00;
	332	data[1] = 0x4d; /* ISOC transfering enable... */
a0306bfa JFM	333	reg_w(gspca_dev, 2);
a0306bfa JFM	334	return 0;
6a7eba24 JFM	335	}
	336
	337	static void sd_stopN(struct gspca_dev *gspca_dev)
	338	{
	339	int result;
6a7eba24	340
739570bb JFM	341	gspca_dev->usb_buf[0] = 1;
739570bb JFM	342	gspca_dev->usb_buf[1] = 0;
a0306bfa	343	result = reg_w(gspca_dev, 2);
6a7eba24 JFM	344	if (result < 0)
	345	PDEBUG(D_ERR, "Camera Stop failed");
	346	}
	347
6a7eba24	348	static void sd_pkt_scan(struct gspca_dev *gspca_dev,
76dd272b	349	u8 data, / isoc packet */
6a7eba24 JFM	350	int len) /* iso packet length */
6a7eba24 JFM	351	{
71cb2764	352	struct sd sd = (struct sd ) gspca_dev;
6a7eba24 JFM	353	int p;
	354
	355	if (len < 6) {
	356	/* gspca_dev->last_packet_type = DISCARD_PACKET; */
	357	return;
	358	}
	359	for (p = 0; p < len - 6; p++) {
	360	if (data[0 + p] == 0xff
	361	&& data[1 + p] == 0xff
	362	&& data[2 + p] == 0x00
	363	&& data[3 + p] == 0xff
	364	&& data[4 + p] == 0x96) {
	365	if (data[5 + p] == 0x64
	366	\|\| data[5 + p] == 0x65
	367	\|\| data[5 + p] == 0x66
	368	\|\| data[5 + p] == 0x67) {
a0306bfa	369	PDEBUG(D_PACK, "sof offset: %d len: %d",
6a7eba24	370	p, len);
76dd272b JFM	371	gspca_frame_add(gspca_dev, LAST_PACKET,
76dd272b JFM	372	data, p);
6a7eba24 JFM	373
6a7eba24 JFM	374	/* put the JPEG header */
76dd272b	375	gspca_frame_add(gspca_dev, FIRST_PACKET,
71cb2764	376	sd->jpeg_hdr, JPEG_HDR_SZ);
0a32ef3f JFM	377	data += p + 16;
0a32ef3f JFM	378	len -= p + 16;
6a7eba24 JFM	379	break;
	380	}
	381	}
	382	}
76dd272b	383	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
6a7eba24 JFM	384	}
6a7eba24 JFM	385
77ac0baf JFM	386	static int sd_set_jcomp(struct gspca_dev *gspca_dev,
	387	struct v4l2_jpegcompression *jcomp)
	388	{
	389	struct sd sd = (struct sd ) gspca_dev;
	390
	391	if (jcomp->quality < QUALITY_MIN)
	392	sd->quality = QUALITY_MIN;
	393	else if (jcomp->quality > QUALITY_MAX)
	394	sd->quality = QUALITY_MAX;
	395	else
	396	sd->quality = jcomp->quality;
	397	if (gspca_dev->streaming)
	398	jpeg_set_qual(sd->jpeg_hdr, sd->quality);
	399	return 0;
	400	}
	401
	402	static int sd_get_jcomp(struct gspca_dev *gspca_dev,
	403	struct v4l2_jpegcompression *jcomp)
	404	{
	405	struct sd sd = (struct sd ) gspca_dev;
	406
	407	memset(jcomp, 0, sizeof *jcomp);
	408	jcomp->quality = sd->quality;
	409	jcomp->jpeg_markers = V4L2_JPEG_MARKER_DHT
	410	\| V4L2_JPEG_MARKER_DQT;
	411	return 0;
	412	}
	413
6a7eba24	414	/* sub-driver description */
a5ae2062	415	static const struct sd_desc sd_desc = {
6a7eba24 JFM	416	.name = MODULE_NAME,
6a7eba24 JFM	417	.ctrls = sd_ctrls,
e3b4d2c6	418	.nctrls = NCTRLS,
6a7eba24	419	.config = sd_config,
012d6b02	420	.init = sd_init,
6a7eba24 JFM	421	.start = sd_start,
6a7eba24 JFM	422	.stopN = sd_stopN,
6a7eba24	423	.pkt_scan = sd_pkt_scan,
77ac0baf JFM	424	.get_jcomp = sd_get_jcomp,
77ac0baf JFM	425	.set_jcomp = sd_set_jcomp,
6a7eba24 JFM	426	};
	427
	428	/* -- module initialisation -- */
a5ae2062	429	static const __devinitdata struct usb_device_id device_table[] = {
9d64fdb1	430	{USB_DEVICE(0x093a, 0x050f)},
6a7eba24 JFM	431	{}
	432	};
	433	MODULE_DEVICE_TABLE(usb, device_table);
	434
	435	/* -- device connect -- */
	436	static int sd_probe(struct usb_interface *intf,
	437	const struct usb_device_id *id)
	438	{
	439	return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
	440	THIS_MODULE);
	441	}
	442
	443	static struct usb_driver sd_driver = {
	444	.name = MODULE_NAME,
	445	.id_table = device_table,
	446	.probe = sd_probe,
	447	.disconnect = gspca_disconnect,
6a709749 JFM	448	#ifdef CONFIG_PM
	449	.suspend = gspca_suspend,
	450	.resume = gspca_resume,
	451	#endif
6a7eba24 JFM	452	};
	453
	454	/* -- module insert / remove -- */
	455	static int __init sd_mod_init(void)
	456	{
54826437	457	return usb_register(&sd_driver);
6a7eba24 JFM	458	}
	459	static void __exit sd_mod_exit(void)
	460	{
	461	usb_deregister(&sd_driver);
6a7eba24 JFM	462	}
	463
	464	module_init(sd_mod_init);
	465	module_exit(sd_mod_exit);