[deliverable/linux.git] / drivers / media / usb / gspca / stk014.c

/*
 * Syntek DV4000 (STK014) subdriver
 *
 * Copyright (C) 2008 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 "stk014"

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

MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>");
MODULE_DESCRIPTION("Syntek DV4000 (STK014) USB Camera Driver");
MODULE_LICENSE("GPL");

#define QUALITY 50

/* specific webcam descriptor */
struct sd {
	struct gspca_dev gspca_dev;	/* !! must be the first item */
	u8 jpeg_hdr[JPEG_HDR_SZ];
};

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 = 1},
	{640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
		.bytesperline = 640,
		.sizeimage = 640 * 480 * 3 / 8 + 590,
		.colorspace = V4L2_COLORSPACE_JPEG,
		.priv = 0},
};

/* -- read a register -- */
static u8 reg_r(struct gspca_dev *gspca_dev,
			__u16 index)
{
	struct usb_device *dev = gspca_dev->dev;
	int ret;

	if (gspca_dev->usb_err < 0)
		return 0;
	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
			0x00,
			USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			0x00,
			index,
			gspca_dev->usb_buf, 1,
			500);
	if (ret < 0) {
		pr_err("reg_r err %d\n", ret);
		gspca_dev->usb_err = ret;
		return 0;
	}
	return gspca_dev->usb_buf[0];
}

/* -- write a register -- */
static void reg_w(struct gspca_dev *gspca_dev,
			__u16 index, __u16 value)
{
	struct usb_device *dev = gspca_dev->dev;
	int ret;

	if (gspca_dev->usb_err < 0)
		return;
	ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
			0x01,
			USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			value,
			index,
			NULL,
			0,
			500);
	if (ret < 0) {
		pr_err("reg_w err %d\n", ret);
		gspca_dev->usb_err = ret;
	}
}

/* -- get a bulk value (4 bytes) -- */
static void rcv_val(struct gspca_dev *gspca_dev,
			int ads)
{
	struct usb_device *dev = gspca_dev->dev;
	int alen, ret;

	reg_w(gspca_dev, 0x634, (ads >> 16) & 0xff);
	reg_w(gspca_dev, 0x635, (ads >> 8) & 0xff);
	reg_w(gspca_dev, 0x636, ads & 0xff);
	reg_w(gspca_dev, 0x637, 0);
	reg_w(gspca_dev, 0x638, 4);	/* len & 0xff */
	reg_w(gspca_dev, 0x639, 0);	/* len >> 8 */
	reg_w(gspca_dev, 0x63a, 0);
	reg_w(gspca_dev, 0x63b, 0);
	reg_w(gspca_dev, 0x630, 5);
	if (gspca_dev->usb_err < 0)
		return;
	ret = usb_bulk_msg(dev,
			usb_rcvbulkpipe(dev, 0x05),
			gspca_dev->usb_buf,
			4,		/* length */
			&alen,
			500);		/* timeout in milliseconds */
	if (ret < 0) {
		pr_err("rcv_val err %d\n", ret);
		gspca_dev->usb_err = ret;
	}
}

/* -- send a bulk value -- */
static void snd_val(struct gspca_dev *gspca_dev,
			int ads,
			unsigned int val)
{
	struct usb_device *dev = gspca_dev->dev;
	int alen, ret;
	__u8 seq = 0;

	if (ads == 0x003f08) {
		reg_r(gspca_dev, 0x0704);
		seq = reg_r(gspca_dev, 0x0705);
		reg_r(gspca_dev, 0x0650);
		reg_w(gspca_dev, 0x654, seq);
	} else {
		reg_w(gspca_dev, 0x654, (ads >> 16) & 0xff);
	}
	reg_w(gspca_dev, 0x655, (ads >> 8) & 0xff);
	reg_w(gspca_dev, 0x656, ads & 0xff);
	reg_w(gspca_dev, 0x657, 0);
	reg_w(gspca_dev, 0x658, 0x04);	/* size */
	reg_w(gspca_dev, 0x659, 0);
	reg_w(gspca_dev, 0x65a, 0);
	reg_w(gspca_dev, 0x65b, 0);
	reg_w(gspca_dev, 0x650, 5);
	if (gspca_dev->usb_err < 0)
		return;
	gspca_dev->usb_buf[0] = val >> 24;
	gspca_dev->usb_buf[1] = val >> 16;
	gspca_dev->usb_buf[2] = val >> 8;
	gspca_dev->usb_buf[3] = val;
	ret = usb_bulk_msg(dev,
			usb_sndbulkpipe(dev, 6),
			gspca_dev->usb_buf,
			4,
			&alen,
			500);	/* timeout in milliseconds */
	if (ret < 0) {
		pr_err("snd_val err %d\n", ret);
		gspca_dev->usb_err = ret;
	} else {
		if (ads == 0x003f08) {
			seq += 4;
			seq &= 0x3f;
			reg_w(gspca_dev, 0x705, seq);
		}
	}
}

/* set a camera parameter */
static void set_par(struct gspca_dev *gspca_dev,
		   int parval)
{
	snd_val(gspca_dev, 0x003f08, parval);
}

static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
{
	int parval;

	parval = 0x06000000		/* whiteness */
		+ (val << 16);
	set_par(gspca_dev, parval);
}

static void setcontrast(struct gspca_dev *gspca_dev, s32 val)
{
	int parval;

	parval = 0x07000000		/* contrast */
		+ (val << 16);
	set_par(gspca_dev, parval);
}

static void setcolors(struct gspca_dev *gspca_dev, s32 val)
{
	int parval;

	parval = 0x08000000		/* saturation */
		+ (val << 16);
	set_par(gspca_dev, parval);
}

static void setlightfreq(struct gspca_dev *gspca_dev, s32 val)
{
	set_par(gspca_dev, val == 1
			? 0x33640000		/* 50 Hz */
			: 0x33780000);		/* 60 Hz */
}

/* this function is called at probe time */
static int sd_config(struct gspca_dev *gspca_dev,
			const struct usb_device_id *id)
{
	gspca_dev->cam.cam_mode = vga_mode;
	gspca_dev->cam.nmodes = ARRAY_SIZE(vga_mode);
	return 0;
}

/* this function is called at probe and resume time */
static int sd_init(struct gspca_dev *gspca_dev)
{
	u8 ret;

	/* check if the device responds */
	usb_set_interface(gspca_dev->dev, gspca_dev->iface, 1);
	ret = reg_r(gspca_dev, 0x0740);
	if (gspca_dev->usb_err >= 0) {
		if (ret != 0xff) {
			pr_err("init reg: 0x%02x\n", ret);
			gspca_dev->usb_err = -EIO;
		}
	}
	return gspca_dev->usb_err;
}

/* -- start the camera -- */
static int sd_start(struct gspca_dev *gspca_dev)
{
	struct sd *sd = (struct sd *) gspca_dev;
	int ret, value;

	/* create the JPEG header */
	jpeg_define(sd->jpeg_hdr, gspca_dev->pixfmt.height,
			gspca_dev->pixfmt.width,
			0x22);		/* JPEG 411 */
	jpeg_set_qual(sd->jpeg_hdr, QUALITY);

	/* work on alternate 1 */
	usb_set_interface(gspca_dev->dev, gspca_dev->iface, 1);

	set_par(gspca_dev, 0x10000000);
	set_par(gspca_dev, 0x00000000);
	set_par(gspca_dev, 0x8002e001);
	set_par(gspca_dev, 0x14000000);
	if (gspca_dev->pixfmt.width > 320)
		value = 0x8002e001;		/* 640x480 */
	else
		value = 0x4001f000;		/* 320x240 */
	set_par(gspca_dev, value);
	ret = usb_set_interface(gspca_dev->dev,
					gspca_dev->iface,
					gspca_dev->alt);
	if (ret < 0) {
		pr_err("set intf %d %d failed\n",
		       gspca_dev->iface, gspca_dev->alt);
		gspca_dev->usb_err = ret;
		goto out;
	}
	reg_r(gspca_dev, 0x0630);
	rcv_val(gspca_dev, 0x000020);	/* << (value ff ff ff ff) */
	reg_r(gspca_dev, 0x0650);
	snd_val(gspca_dev, 0x000020, 0xffffffff);
	reg_w(gspca_dev, 0x0620, 0);
	reg_w(gspca_dev, 0x0630, 0);
	reg_w(gspca_dev, 0x0640, 0);
	reg_w(gspca_dev, 0x0650, 0);
	reg_w(gspca_dev, 0x0660, 0);
	set_par(gspca_dev, 0x09800000);		/* Red ? */
	set_par(gspca_dev, 0x0a800000);		/* Green ? */
	set_par(gspca_dev, 0x0b800000);		/* Blue ? */
	set_par(gspca_dev, 0x0d030000);		/* Gamma ? */

	/* start the video flow */
	set_par(gspca_dev, 0x01000000);
	set_par(gspca_dev, 0x01000000);
	if (gspca_dev->usb_err >= 0)
		PDEBUG(D_STREAM, "camera started alt: 0x%02x",
				gspca_dev->alt);
out:
	return gspca_dev->usb_err;
}

static void sd_stopN(struct gspca_dev *gspca_dev)
{
	struct usb_device *dev = gspca_dev->dev;

	set_par(gspca_dev, 0x02000000);
	set_par(gspca_dev, 0x02000000);
	usb_set_interface(dev, gspca_dev->iface, 1);
	reg_r(gspca_dev, 0x0630);
	rcv_val(gspca_dev, 0x000020);	/* << (value ff ff ff ff) */
	reg_r(gspca_dev, 0x0650);
	snd_val(gspca_dev, 0x000020, 0xffffffff);
	reg_w(gspca_dev, 0x0620, 0);
	reg_w(gspca_dev, 0x0630, 0);
	reg_w(gspca_dev, 0x0640, 0);
	reg_w(gspca_dev, 0x0650, 0);
	reg_w(gspca_dev, 0x0660, 0);
	PDEBUG(D_STREAM, "camera stopped");
}

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;
	static unsigned char ffd9[] = {0xff, 0xd9};

	/* a frame starts with:
	 *	- 0xff 0xfe
	 *	- 0x08 0x00	- length (little endian ?!)
	 *	- 4 bytes = size of whole frame (BE - including header)
	 *	- 0x00 0x0c
	 *	- 0xff 0xd8
	 *	- ..	JPEG image with escape sequences (ff 00)
	 *		(without ending - ff d9)
	 */
	if (data[0] == 0xff && data[1] == 0xfe) {
		gspca_frame_add(gspca_dev, LAST_PACKET,
				ffd9, 2);

		/* put the JPEG 411 header */
		gspca_frame_add(gspca_dev, FIRST_PACKET,
			sd->jpeg_hdr, JPEG_HDR_SZ);

		/* beginning of the frame */
#define STKHDRSZ 12
		data += STKHDRSZ;
		len -= STKHDRSZ;
	}
	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
}

static int sd_s_ctrl(struct v4l2_ctrl *ctrl)
{
	struct gspca_dev *gspca_dev =
		container_of(ctrl->handler, struct gspca_dev, ctrl_handler);

	gspca_dev->usb_err = 0;

	if (!gspca_dev->streaming)
		return 0;

	switch (ctrl->id) {
	case V4L2_CID_BRIGHTNESS:
		setbrightness(gspca_dev, ctrl->val);
		break;
	case V4L2_CID_CONTRAST:
		setcontrast(gspca_dev, ctrl->val);
		break;
	case V4L2_CID_SATURATION:
		setcolors(gspca_dev, ctrl->val);
		break;
	case V4L2_CID_POWER_LINE_FREQUENCY:
		setlightfreq(gspca_dev, ctrl->val);
		break;
	}
	return gspca_dev->usb_err;
}

static const struct v4l2_ctrl_ops sd_ctrl_ops = {
	.s_ctrl = sd_s_ctrl,
};

static int sd_init_controls(struct gspca_dev *gspca_dev)
{
	struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;

	gspca_dev->vdev.ctrl_handler = hdl;
	v4l2_ctrl_handler_init(hdl, 4);
	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
			V4L2_CID_BRIGHTNESS, 0, 255, 1, 127);
	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
			V4L2_CID_CONTRAST, 0, 255, 1, 127);
	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
			V4L2_CID_SATURATION, 0, 255, 1, 127);
	v4l2_ctrl_new_std_menu(hdl, &sd_ctrl_ops,
			V4L2_CID_POWER_LINE_FREQUENCY,
			V4L2_CID_POWER_LINE_FREQUENCY_60HZ, 1,
			V4L2_CID_POWER_LINE_FREQUENCY_50HZ);

	if (hdl->error) {
		pr_err("Could not initialize controls\n");
		return hdl->error;
	}
	return 0;
}

/* sub-driver description */
static const struct sd_desc sd_desc = {
	.name = MODULE_NAME,
	.config = sd_config,
	.init = sd_init,
	.init_controls = sd_init_controls,
	.start = sd_start,
	.stopN = sd_stopN,
	.pkt_scan = sd_pkt_scan,
};

/* -- module initialisation -- */
static const struct usb_device_id device_table[] = {
	{USB_DEVICE(0x05e1, 0x0893)},
	{}
};
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,
	.reset_resume = gspca_resume,
#endif
};

module_usb_driver(sd_driver);
Commit	Line	Data
63eb9546 JFM	1	/*
	2	* Syntek DV4000 (STK014) subdriver
	3	*
d43fa32f	4	* Copyright (C) 2008 Jean-Francois Moine (http://moinejf.free.fr)
63eb9546 JFM	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation; either version 2 of the License, or
	9	* any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License
	17	* along with this program; if not, write to the Free Software
	18	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
63eb9546 JFM	19	*/
63eb9546 JFM	20
133a9fe9 JP	21	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
133a9fe9 JP	22
63eb9546 JFM	23	#define MODULE_NAME "stk014"
	24
	25	#include "gspca.h"
	26	#include "jpeg.h"
	27
63eb9546 JFM	28	MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>");
	29	MODULE_DESCRIPTION("Syntek DV4000 (STK014) USB Camera Driver");
	30	MODULE_LICENSE("GPL");
	31
b56ab4ca HG	32	#define QUALITY 50
b56ab4ca HG	33
63eb9546 JFM	34	/* specific webcam descriptor */
	35	struct sd {
	36	struct gspca_dev gspca_dev; /* !! must be the first item */
9a731a32	37	u8 jpeg_hdr[JPEG_HDR_SZ];
63eb9546 JFM	38	};
63eb9546 JFM	39
cc611b8a	40	static const struct v4l2_pix_format vga_mode[] = {
c2446b3e JFM	41	{320, 240, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
	42	.bytesperline = 320,
	43	.sizeimage = 320 * 240 * 3 / 8 + 590,
	44	.colorspace = V4L2_COLORSPACE_JPEG,
	45	.priv = 1},
	46	{640, 480, V4L2_PIX_FMT_JPEG, V4L2_FIELD_NONE,
	47	.bytesperline = 640,
	48	.sizeimage = 640 * 480 * 3 / 8 + 590,
	49	.colorspace = V4L2_COLORSPACE_JPEG,
	50	.priv = 0},
63eb9546 JFM	51	};
	52
	53	/* -- read a register -- */
ecb77686	54	static u8 reg_r(struct gspca_dev *gspca_dev,
739570bb	55	__u16 index)
63eb9546	56	{
63eb9546	57	struct usb_device *dev = gspca_dev->dev;
6a7eba24	58	int ret;
63eb9546	59
ecb77686 JFM	60	if (gspca_dev->usb_err < 0)
ecb77686 JFM	61	return 0;
63eb9546 JFM	62	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
	63	0x00,
	64	USB_DIR_IN \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	65	0x00,
	66	index,
739570bb	67	gspca_dev->usb_buf, 1,
63eb9546	68	500);
739570bb	69	if (ret < 0) {
133a9fe9	70	pr_err("reg_r err %d\n", ret);
ecb77686 JFM	71	gspca_dev->usb_err = ret;
ecb77686 JFM	72	return 0;
739570bb JFM	73	}
739570bb JFM	74	return gspca_dev->usb_buf[0];
63eb9546 JFM	75	}
	76
	77	/* -- write a register -- */
ecb77686	78	static void reg_w(struct gspca_dev *gspca_dev,
63eb9546 JFM	79	__u16 index, __u16 value)
	80	{
	81	struct usb_device *dev = gspca_dev->dev;
	82	int ret;
	83
ecb77686 JFM	84	if (gspca_dev->usb_err < 0)
ecb77686 JFM	85	return;
63eb9546 JFM	86	ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
	87	0x01,
	88	USB_DIR_OUT \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	89	value,
	90	index,
	91	NULL,
	92	0,
	93	500);
ecb77686	94	if (ret < 0) {
133a9fe9	95	pr_err("reg_w err %d\n", ret);
ecb77686 JFM	96	gspca_dev->usb_err = ret;
ecb77686 JFM	97	}
63eb9546 JFM	98	}
63eb9546 JFM	99
739570bb	100	/* -- get a bulk value (4 bytes) -- */
ecb77686	101	static void rcv_val(struct gspca_dev *gspca_dev,
739570bb	102	int ads)
63eb9546 JFM	103	{
	104	struct usb_device *dev = gspca_dev->dev;
	105	int alen, ret;
63eb9546	106
6a7eba24 JFM	107	reg_w(gspca_dev, 0x634, (ads >> 16) & 0xff);
	108	reg_w(gspca_dev, 0x635, (ads >> 8) & 0xff);
	109	reg_w(gspca_dev, 0x636, ads & 0xff);
	110	reg_w(gspca_dev, 0x637, 0);
739570bb JFM	111	reg_w(gspca_dev, 0x638, 4); /* len & 0xff */
739570bb JFM	112	reg_w(gspca_dev, 0x639, 0); /* len >> 8 */
6a7eba24 JFM	113	reg_w(gspca_dev, 0x63a, 0);
	114	reg_w(gspca_dev, 0x63b, 0);
	115	reg_w(gspca_dev, 0x630, 5);
ecb77686 JFM	116	if (gspca_dev->usb_err < 0)
ecb77686 JFM	117	return;
63eb9546	118	ret = usb_bulk_msg(dev,
50e06dee	119	usb_rcvbulkpipe(dev, 0x05),
739570bb JFM	120	gspca_dev->usb_buf,
739570bb JFM	121	4, /* length */
63eb9546	122	&alen,
739570bb	123	500); /* timeout in milliseconds */
ecb77686	124	if (ret < 0) {
133a9fe9	125	pr_err("rcv_val err %d\n", ret);
ecb77686 JFM	126	gspca_dev->usb_err = ret;
ecb77686 JFM	127	}
63eb9546 JFM	128	}
63eb9546 JFM	129
739570bb	130	/* -- send a bulk value -- */
ecb77686	131	static void snd_val(struct gspca_dev *gspca_dev,
63eb9546 JFM	132	int ads,
	133	unsigned int val)
	134	{
	135	struct usb_device *dev = gspca_dev->dev;
	136	int alen, ret;
739570bb	137	__u8 seq = 0;
63eb9546 JFM	138
63eb9546 JFM	139	if (ads == 0x003f08) {
ecb77686 JFM	140	reg_r(gspca_dev, 0x0704);
	141	seq = reg_r(gspca_dev, 0x0705);
	142	reg_r(gspca_dev, 0x0650);
6a7eba24	143	reg_w(gspca_dev, 0x654, seq);
739570bb	144	} else {
6a7eba24	145	reg_w(gspca_dev, 0x654, (ads >> 16) & 0xff);
739570bb	146	}
6a7eba24 JFM	147	reg_w(gspca_dev, 0x655, (ads >> 8) & 0xff);
	148	reg_w(gspca_dev, 0x656, ads & 0xff);
	149	reg_w(gspca_dev, 0x657, 0);
	150	reg_w(gspca_dev, 0x658, 0x04); /* size */
	151	reg_w(gspca_dev, 0x659, 0);
	152	reg_w(gspca_dev, 0x65a, 0);
	153	reg_w(gspca_dev, 0x65b, 0);
	154	reg_w(gspca_dev, 0x650, 5);
ecb77686 JFM	155	if (gspca_dev->usb_err < 0)
ecb77686 JFM	156	return;
739570bb JFM	157	gspca_dev->usb_buf[0] = val >> 24;
	158	gspca_dev->usb_buf[1] = val >> 16;
	159	gspca_dev->usb_buf[2] = val >> 8;
	160	gspca_dev->usb_buf[3] = val;
63eb9546 JFM	161	ret = usb_bulk_msg(dev,
63eb9546 JFM	162	usb_sndbulkpipe(dev, 6),
739570bb	163	gspca_dev->usb_buf,
63eb9546 JFM	164	4,
	165	&alen,
	166	500); /* timeout in milliseconds */
ecb77686	167	if (ret < 0) {
133a9fe9	168	pr_err("snd_val err %d\n", ret);
ecb77686 JFM	169	gspca_dev->usb_err = ret;
	170	} else {
	171	if (ads == 0x003f08) {
	172	seq += 4;
	173	seq &= 0x3f;
	174	reg_w(gspca_dev, 0x705, seq);
	175	}
63eb9546	176	}
63eb9546 JFM	177	}
	178
	179	/* set a camera parameter */
ecb77686	180	static void set_par(struct gspca_dev *gspca_dev,
63eb9546 JFM	181	int parval)
63eb9546 JFM	182	{
ecb77686	183	snd_val(gspca_dev, 0x003f08, parval);
63eb9546 JFM	184	}
63eb9546 JFM	185
74dec797	186	static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
63eb9546	187	{
63eb9546 JFM	188	int parval;
63eb9546 JFM	189
63eb9546	190	parval = 0x06000000 /* whiteness */
74dec797	191	+ (val << 16);
63eb9546 JFM	192	set_par(gspca_dev, parval);
	193	}
	194
74dec797	195	static void setcontrast(struct gspca_dev *gspca_dev, s32 val)
63eb9546	196	{
63eb9546 JFM	197	int parval;
63eb9546 JFM	198
63eb9546	199	parval = 0x07000000 /* contrast */
74dec797	200	+ (val << 16);
63eb9546 JFM	201	set_par(gspca_dev, parval);
	202	}
	203
74dec797	204	static void setcolors(struct gspca_dev *gspca_dev, s32 val)
63eb9546	205	{
63eb9546 JFM	206	int parval;
63eb9546 JFM	207
63eb9546	208	parval = 0x08000000 /* saturation */
74dec797	209	+ (val << 16);
63eb9546 JFM	210	set_par(gspca_dev, parval);
	211	}
	212
74dec797	213	static void setlightfreq(struct gspca_dev *gspca_dev, s32 val)
6a7eba24	214	{
74dec797	215	set_par(gspca_dev, val == 1
6a7eba24 JFM	216	? 0x33640000 /* 50 Hz */
	217	: 0x33780000); /* 60 Hz */
	218	}
	219
63eb9546 JFM	220	/* this function is called at probe time */
	221	static int sd_config(struct gspca_dev *gspca_dev,
	222	const struct usb_device_id *id)
	223	{
63eb9546	224	gspca_dev->cam.cam_mode = vga_mode;
739570bb	225	gspca_dev->cam.nmodes = ARRAY_SIZE(vga_mode);
63eb9546 JFM	226	return 0;
	227	}
	228
012d6b02 JFM	229	/* this function is called at probe and resume time */
012d6b02 JFM	230	static int sd_init(struct gspca_dev *gspca_dev)
63eb9546	231	{
ecb77686	232	u8 ret;
63eb9546 JFM	233
	234	/* check if the device responds */
	235	usb_set_interface(gspca_dev->dev, gspca_dev->iface, 1);
739570bb	236	ret = reg_r(gspca_dev, 0x0740);
ecb77686 JFM	237	if (gspca_dev->usb_err >= 0) {
ecb77686 JFM	238	if (ret != 0xff) {
133a9fe9	239	pr_err("init reg: 0x%02x\n", ret);
ecb77686 JFM	240	gspca_dev->usb_err = -EIO;
ecb77686 JFM	241	}
63eb9546	242	}
ecb77686	243	return gspca_dev->usb_err;
63eb9546 JFM	244	}
	245
	246	/* -- start the camera -- */
72ab97ce	247	static int sd_start(struct gspca_dev *gspca_dev)
63eb9546	248	{
71cb2764	249	struct sd sd = (struct sd ) gspca_dev;
63eb9546 JFM	250	int ret, value;
63eb9546 JFM	251
71cb2764	252	/* create the JPEG header */
1966bc2a OZ	253	jpeg_define(sd->jpeg_hdr, gspca_dev->pixfmt.height,
1966bc2a OZ	254	gspca_dev->pixfmt.width,
71cb2764	255	0x22); /* JPEG 411 */
b56ab4ca	256	jpeg_set_qual(sd->jpeg_hdr, QUALITY);
71cb2764	257
63eb9546 JFM	258	/* work on alternate 1 */
	259	usb_set_interface(gspca_dev->dev, gspca_dev->iface, 1);
	260
	261	set_par(gspca_dev, 0x10000000);
	262	set_par(gspca_dev, 0x00000000);
	263	set_par(gspca_dev, 0x8002e001);
	264	set_par(gspca_dev, 0x14000000);
1966bc2a	265	if (gspca_dev->pixfmt.width > 320)
63eb9546 JFM	266	value = 0x8002e001; /* 640x480 */
	267	else
	268	value = 0x4001f000; /* 320x240 */
	269	set_par(gspca_dev, value);
	270	ret = usb_set_interface(gspca_dev->dev,
	271	gspca_dev->iface,
	272	gspca_dev->alt);
6a7eba24	273	if (ret < 0) {
133a9fe9 JP	274	pr_err("set intf %d %d failed\n",
133a9fe9 JP	275	gspca_dev->iface, gspca_dev->alt);
ecb77686	276	gspca_dev->usb_err = ret;
63eb9546	277	goto out;
6a7eba24	278	}
e2f233d9	279	reg_r(gspca_dev, 0x0630);
739570bb	280	rcv_val(gspca_dev, 0x000020); /* << (value ff ff ff ff) */
ecb77686	281	reg_r(gspca_dev, 0x0650);
63eb9546	282	snd_val(gspca_dev, 0x000020, 0xffffffff);
6a7eba24 JFM	283	reg_w(gspca_dev, 0x0620, 0);
	284	reg_w(gspca_dev, 0x0630, 0);
	285	reg_w(gspca_dev, 0x0640, 0);
	286	reg_w(gspca_dev, 0x0650, 0);
	287	reg_w(gspca_dev, 0x0660, 0);
63eb9546 JFM	288	set_par(gspca_dev, 0x09800000); /* Red ? */
	289	set_par(gspca_dev, 0x0a800000); /* Green ? */
	290	set_par(gspca_dev, 0x0b800000); /* Blue ? */
	291	set_par(gspca_dev, 0x0d030000); /* Gamma ? */
63eb9546 JFM	292
	293	/* start the video flow */
	294	set_par(gspca_dev, 0x01000000);
	295	set_par(gspca_dev, 0x01000000);
ecb77686 JFM	296	if (gspca_dev->usb_err >= 0)
	297	PDEBUG(D_STREAM, "camera started alt: 0x%02x",
	298	gspca_dev->alt);
63eb9546	299	out:
ecb77686	300	return gspca_dev->usb_err;
63eb9546 JFM	301	}
	302
	303	static void sd_stopN(struct gspca_dev *gspca_dev)
	304	{
	305	struct usb_device *dev = gspca_dev->dev;
63eb9546 JFM	306
	307	set_par(gspca_dev, 0x02000000);
	308	set_par(gspca_dev, 0x02000000);
	309	usb_set_interface(dev, gspca_dev->iface, 1);
739570bb JFM	310	reg_r(gspca_dev, 0x0630);
	311	rcv_val(gspca_dev, 0x000020); /* << (value ff ff ff ff) */
	312	reg_r(gspca_dev, 0x0650);
63eb9546	313	snd_val(gspca_dev, 0x000020, 0xffffffff);
6a7eba24 JFM	314	reg_w(gspca_dev, 0x0620, 0);
	315	reg_w(gspca_dev, 0x0630, 0);
	316	reg_w(gspca_dev, 0x0640, 0);
	317	reg_w(gspca_dev, 0x0650, 0);
	318	reg_w(gspca_dev, 0x0660, 0);
63eb9546 JFM	319	PDEBUG(D_STREAM, "camera stopped");
	320	}
	321
63eb9546	322	static void sd_pkt_scan(struct gspca_dev *gspca_dev,
76dd272b	323	u8 data, / isoc packet */
63eb9546 JFM	324	int len) /* iso packet length */
63eb9546 JFM	325	{
71cb2764	326	struct sd sd = (struct sd ) gspca_dev;
4aa0d037	327	static unsigned char ffd9[] = {0xff, 0xd9};
63eb9546 JFM	328
	329	/* a frame starts with:
	330	* - 0xff 0xfe
d43fa32f JFM	331	* - 0x08 0x00 - length (little endian ?!)
d43fa32f JFM	332	* - 4 bytes = size of whole frame (BE - including header)
63eb9546 JFM	333	* - 0x00 0x0c
	334	* - 0xff 0xd8
	335	* - .. JPEG image with escape sequences (ff 00)
d43fa32f	336	* (without ending - ff d9)
63eb9546 JFM	337	*/
63eb9546 JFM	338	if (data[0] == 0xff && data[1] == 0xfe) {
76dd272b JFM	339	gspca_frame_add(gspca_dev, LAST_PACKET,
76dd272b JFM	340	ffd9, 2);
63eb9546	341
d43fa32f	342	/* put the JPEG 411 header */
76dd272b	343	gspca_frame_add(gspca_dev, FIRST_PACKET,
71cb2764	344	sd->jpeg_hdr, JPEG_HDR_SZ);
63eb9546 JFM	345
	346	/* beginning of the frame */
	347	#define STKHDRSZ 12
8843765e JFM	348	data += STKHDRSZ;
8843765e JFM	349	len -= STKHDRSZ;
63eb9546	350	}
76dd272b	351	gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
63eb9546 JFM	352	}
63eb9546 JFM	353
74dec797 HV	354	static int sd_s_ctrl(struct v4l2_ctrl *ctrl)
	355	{
	356	struct gspca_dev *gspca_dev =
	357	container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
74dec797 HV	358
	359	gspca_dev->usb_err = 0;
	360
	361	if (!gspca_dev->streaming)
	362	return 0;
	363
	364	switch (ctrl->id) {
	365	case V4L2_CID_BRIGHTNESS:
	366	setbrightness(gspca_dev, ctrl->val);
	367	break;
	368	case V4L2_CID_CONTRAST:
	369	setcontrast(gspca_dev, ctrl->val);
	370	break;
	371	case V4L2_CID_SATURATION:
	372	setcolors(gspca_dev, ctrl->val);
	373	break;
	374	case V4L2_CID_POWER_LINE_FREQUENCY:
	375	setlightfreq(gspca_dev, ctrl->val);
	376	break;
74dec797 HV	377	}
	378	return gspca_dev->usb_err;
	379	}
	380
	381	static const struct v4l2_ctrl_ops sd_ctrl_ops = {
	382	.s_ctrl = sd_s_ctrl,
	383	};
	384
	385	static int sd_init_controls(struct gspca_dev *gspca_dev)
	386	{
74dec797 HV	387	struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
	388
	389	gspca_dev->vdev.ctrl_handler = hdl;
b56ab4ca	390	v4l2_ctrl_handler_init(hdl, 4);
74dec797 HV	391	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
	392	V4L2_CID_BRIGHTNESS, 0, 255, 1, 127);
	393	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
	394	V4L2_CID_CONTRAST, 0, 255, 1, 127);
	395	v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
	396	V4L2_CID_SATURATION, 0, 255, 1, 127);
	397	v4l2_ctrl_new_std_menu(hdl, &sd_ctrl_ops,
	398	V4L2_CID_POWER_LINE_FREQUENCY,
	399	V4L2_CID_POWER_LINE_FREQUENCY_60HZ, 1,
	400	V4L2_CID_POWER_LINE_FREQUENCY_50HZ);
74dec797 HV	401
	402	if (hdl->error) {
	403	pr_err("Could not initialize controls\n");
	404	return hdl->error;
	405	}
	406	return 0;
	407	}
	408
63eb9546	409	/* sub-driver description */
739570bb	410	static const struct sd_desc sd_desc = {
63eb9546	411	.name = MODULE_NAME,
63eb9546	412	.config = sd_config,
012d6b02	413	.init = sd_init,
74dec797	414	.init_controls = sd_init_controls,
63eb9546 JFM	415	.start = sd_start,
63eb9546 JFM	416	.stopN = sd_stopN,
63eb9546 JFM	417	.pkt_scan = sd_pkt_scan,
	418	};
	419
	420	/* -- module initialisation -- */
95c967c1	421	static const struct usb_device_id device_table[] = {
9d64fdb1	422	{USB_DEVICE(0x05e1, 0x0893)},
63eb9546 JFM	423	{}
	424	};
	425	MODULE_DEVICE_TABLE(usb, device_table);
	426
	427	/* -- device connect -- */
	428	static int sd_probe(struct usb_interface *intf,
	429	const struct usb_device_id *id)
	430	{
d43fa32f JFM	431	return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
d43fa32f JFM	432	THIS_MODULE);
63eb9546 JFM	433	}
	434
	435	static struct usb_driver sd_driver = {
	436	.name = MODULE_NAME,
	437	.id_table = device_table,
	438	.probe = sd_probe,
	439	.disconnect = gspca_disconnect,
6a709749 JFM	440	#ifdef CONFIG_PM
	441	.suspend = gspca_suspend,
	442	.resume = gspca_resume,
8bb58964	443	.reset_resume = gspca_resume,
6a709749	444	#endif
63eb9546 JFM	445	};
63eb9546 JFM	446
ecb3b2b3	447	module_usb_driver(sd_driver);