[deliverable/linux.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 pr_fmt(fmt) KBUILD_MODNAME ": " fmt

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