[mirror_ubuntu-artful-kernel.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.
 */

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