[mirror_ubuntu-artful-kernel.git] / drivers / media / video / gspca / sq905c.c

/*
 * SQ905C subdriver
 *
 * Copyright (C) 2009 Theodore Kilgore
 *
 * 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
 */

/*
 *
 * This driver uses work done in
 * libgphoto2/camlibs/digigr8, Copyright (C) Theodore Kilgore.
 *
 * This driver has also used as a base the sq905c driver
 * and may contain code fragments from it.
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#define MODULE_NAME "sq905c"

#include <linux/workqueue.h>
#include <linux/slab.h>
#include "gspca.h"

MODULE_AUTHOR("Theodore Kilgore <kilgota@auburn.edu>");
MODULE_DESCRIPTION("GSPCA/SQ905C USB Camera Driver");
MODULE_LICENSE("GPL");

/* Default timeouts, in ms */
#define SQ905C_CMD_TIMEOUT 500
#define SQ905C_DATA_TIMEOUT 1000

/* Maximum transfer size to use. */
#define SQ905C_MAX_TRANSFER 0x8000

#define FRAME_HEADER_LEN 0x50

/* Commands. These go in the "value" slot. */
#define SQ905C_CLEAR   0xa0		/* clear everything */
#define SQ905C_GET_ID  0x14f4		/* Read version number */
#define SQ905C_CAPTURE_LOW 0xa040	/* Starts capture at 160x120 */
#define SQ905C_CAPTURE_MED 0x1440	/* Starts capture at 320x240 */
#define SQ905C_CAPTURE_HI 0x2840	/* Starts capture at 320x240 */

/* For capture, this must go in the "index" slot. */
#define SQ905C_CAPTURE_INDEX 0x110f

/* Structure to hold all of our device specific stuff */
struct sd {
	struct gspca_dev gspca_dev;	/* !! must be the first item */
	const struct v4l2_pix_format *cap_mode;
	/* Driver stuff */
	struct work_struct work_struct;
	struct workqueue_struct *work_thread;
};

/*
 * Most of these cameras will do 640x480 and 320x240. 160x120 works
 * in theory but gives very poor output. Therefore, not supported.
 * The 0x2770:0x9050 cameras have max resolution of 320x240.
 */
static struct v4l2_pix_format sq905c_mode[] = {
	{ 320, 240, V4L2_PIX_FMT_SQ905C, V4L2_FIELD_NONE,
		.bytesperline = 320,
		.sizeimage = 320 * 240,
		.colorspace = V4L2_COLORSPACE_SRGB,
		.priv = 0},
	{ 640, 480, V4L2_PIX_FMT_SQ905C, V4L2_FIELD_NONE,
		.bytesperline = 640,
		.sizeimage = 640 * 480,
		.colorspace = V4L2_COLORSPACE_SRGB,
		.priv = 0}
};

/* Send a command to the camera. */
static int sq905c_command(struct gspca_dev *gspca_dev, u16 command, u16 index)
{
	int ret;

	ret = usb_control_msg(gspca_dev->dev,
			      usb_sndctrlpipe(gspca_dev->dev, 0),
			      USB_REQ_SYNCH_FRAME,                /* request */
			      USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			      command, index, NULL, 0,
			      SQ905C_CMD_TIMEOUT);
	if (ret < 0) {
		pr_err("%s: usb_control_msg failed (%d)\n", __func__, ret);
		return ret;
	}

	return 0;
}

static int sq905c_read(struct gspca_dev *gspca_dev, u16 command, u16 index,
		       int size)
{
	int ret;

	ret = usb_control_msg(gspca_dev->dev,
			      usb_rcvctrlpipe(gspca_dev->dev, 0),
			      USB_REQ_SYNCH_FRAME,		/* request */
			      USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
			      command, index, gspca_dev->usb_buf, size,
			      SQ905C_CMD_TIMEOUT);
	if (ret < 0) {
		pr_err("%s: usb_control_msg failed (%d)\n", __func__, ret);
		return ret;
	}

	return 0;
}

/* This function is called as a workqueue function and runs whenever the camera
 * is streaming data. Because it is a workqueue function it is allowed to sleep
 * so we can use synchronous USB calls. To avoid possible collisions with other
 * threads attempting to use the camera's USB interface the gspca usb_lock is
 * used when performing the one USB control operation inside the workqueue,
 * which tells the camera to close the stream. In practice the only thing
 * which needs to be protected against is the usb_set_interface call that
 * gspca makes during stream_off. Otherwise the camera doesn't provide any
 * controls that the user could try to change.
 */
static void sq905c_dostream(struct work_struct *work)
{
	struct sd *dev = container_of(work, struct sd, work_struct);
	struct gspca_dev *gspca_dev = &dev->gspca_dev;
	int bytes_left; /* bytes remaining in current frame. */
	int data_len;   /* size to use for the next read. */
	int act_len;
	int packet_type;
	int ret;
	u8 *buffer;

	buffer = kmalloc(SQ905C_MAX_TRANSFER, GFP_KERNEL | GFP_DMA);
	if (!buffer) {
		pr_err("Couldn't allocate USB buffer\n");
		goto quit_stream;
	}

	while (gspca_dev->dev && gspca_dev->streaming) {
#ifdef CONFIG_PM
		if (gspca_dev->frozen)
			break;
#endif
		/* Request the header, which tells the size to download */
		ret = usb_bulk_msg(gspca_dev->dev,
				usb_rcvbulkpipe(gspca_dev->dev, 0x81),
				buffer, FRAME_HEADER_LEN, &act_len,
				SQ905C_DATA_TIMEOUT);
		PDEBUG(D_STREAM,
			"Got %d bytes out of %d for header",
			act_len, FRAME_HEADER_LEN);
		if (ret < 0 || act_len < FRAME_HEADER_LEN)
			goto quit_stream;
		/* size is read from 4 bytes starting 0x40, little endian */
		bytes_left = buffer[0x40]|(buffer[0x41]<<8)|(buffer[0x42]<<16)
					|(buffer[0x43]<<24);
		PDEBUG(D_STREAM, "bytes_left = 0x%x", bytes_left);
		/* We keep the header. It has other information, too. */
		packet_type = FIRST_PACKET;
		gspca_frame_add(gspca_dev, packet_type,
				buffer, FRAME_HEADER_LEN);
		while (bytes_left > 0 && gspca_dev->dev) {
			data_len = bytes_left > SQ905C_MAX_TRANSFER ?
				SQ905C_MAX_TRANSFER : bytes_left;
			ret = usb_bulk_msg(gspca_dev->dev,
				usb_rcvbulkpipe(gspca_dev->dev, 0x81),
				buffer, data_len, &act_len,
				SQ905C_DATA_TIMEOUT);
			if (ret < 0 || act_len < data_len)
				goto quit_stream;
			PDEBUG(D_STREAM,
				"Got %d bytes out of %d for frame",
				data_len, bytes_left);
			bytes_left -= data_len;
			if (bytes_left == 0)
				packet_type = LAST_PACKET;
			else
				packet_type = INTER_PACKET;
			gspca_frame_add(gspca_dev, packet_type,
					buffer, data_len);
		}
	}
quit_stream:
	if (gspca_dev->dev) {
		mutex_lock(&gspca_dev->usb_lock);
		sq905c_command(gspca_dev, SQ905C_CLEAR, 0);
		mutex_unlock(&gspca_dev->usb_lock);
	}
	kfree(buffer);
}

/* This function is called at probe time just before sd_init */
static int sd_config(struct gspca_dev *gspca_dev,
		const struct usb_device_id *id)
{
	struct cam *cam = &gspca_dev->cam;
	struct sd *dev = (struct sd *) gspca_dev;
	int ret;

	PDEBUG(D_PROBE,
		"SQ9050 camera detected"
		" (vid/pid 0x%04X:0x%04X)", id->idVendor, id->idProduct);

	ret = sq905c_command(gspca_dev, SQ905C_GET_ID, 0);
	if (ret < 0) {
		PDEBUG(D_ERR, "Get version command failed");
		return ret;
	}

	ret = sq905c_read(gspca_dev, 0xf5, 0, 20);
	if (ret < 0) {
		PDEBUG(D_ERR, "Reading version command failed");
		return ret;
	}
	/* Note we leave out the usb id and the manufacturing date */
	PDEBUG(D_PROBE,
	       "SQ9050 ID string: %02x - %*ph",
		gspca_dev->usb_buf[3], 6, gspca_dev->usb_buf + 14);

	cam->cam_mode = sq905c_mode;
	cam->nmodes = 2;
	if (gspca_dev->usb_buf[15] == 0)
		cam->nmodes = 1;
	/* We don't use the buffer gspca allocates so make it small. */
	cam->bulk_size = 32;
	cam->bulk = 1;
	INIT_WORK(&dev->work_struct, sq905c_dostream);
	return 0;
}

/* called on streamoff with alt==0 and on disconnect */
/* the usb_lock is held at entry - restore on exit */
static void sd_stop0(struct gspca_dev *gspca_dev)
{
	struct sd *dev = (struct sd *) gspca_dev;

	/* wait for the work queue to terminate */
	mutex_unlock(&gspca_dev->usb_lock);
	/* This waits for sq905c_dostream to finish */
	destroy_workqueue(dev->work_thread);
	dev->work_thread = NULL;
	mutex_lock(&gspca_dev->usb_lock);
}

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

	/* connect to the camera and reset it. */
	ret = sq905c_command(gspca_dev, SQ905C_CLEAR, 0);
	return ret;
}

/* Set up for getting frames. */
static int sd_start(struct gspca_dev *gspca_dev)
{
	struct sd *dev = (struct sd *) gspca_dev;
	int ret;

	dev->cap_mode = gspca_dev->cam.cam_mode;
	/* "Open the shutter" and set size, to start capture */
	switch (gspca_dev->width) {
	case 640:
		PDEBUG(D_STREAM, "Start streaming at high resolution");
		dev->cap_mode++;
		ret = sq905c_command(gspca_dev, SQ905C_CAPTURE_HI,
						SQ905C_CAPTURE_INDEX);
		break;
	default: /* 320 */
	PDEBUG(D_STREAM, "Start streaming at medium resolution");
		ret = sq905c_command(gspca_dev, SQ905C_CAPTURE_MED,
						SQ905C_CAPTURE_INDEX);
	}

	if (ret < 0) {
		PDEBUG(D_ERR, "Start streaming command failed");
		return ret;
	}
	/* Start the workqueue function to do the streaming */
	dev->work_thread = create_singlethread_workqueue(MODULE_NAME);
	queue_work(dev->work_thread, &dev->work_struct);

	return 0;
}

/* Table of supported USB devices */
static const struct usb_device_id device_table[] = {
	{USB_DEVICE(0x2770, 0x905c)},
	{USB_DEVICE(0x2770, 0x9050)},
	{USB_DEVICE(0x2770, 0x9051)},
	{USB_DEVICE(0x2770, 0x9052)},
	{USB_DEVICE(0x2770, 0x913d)},
	{}
};

MODULE_DEVICE_TABLE(usb, device_table);

/* sub-driver description */
static const struct sd_desc sd_desc = {
	.name   = MODULE_NAME,
	.config = sd_config,
	.init   = sd_init,
	.start  = sd_start,
	.stop0  = sd_stop0,
};

/* -- 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
14a19c0a TK	1	/*
	2	* SQ905C subdriver
	3	*
	4	* Copyright (C) 2009 Theodore Kilgore
	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
	19	*/
	20
	21	/*
	22	*
	23	* This driver uses work done in
	24	* libgphoto2/camlibs/digigr8, Copyright (C) Theodore Kilgore.
	25	*
	26	* This driver has also used as a base the sq905c driver
	27	* and may contain code fragments from it.
	28	*/
	29
133a9fe9 JP	30	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
133a9fe9 JP	31
14a19c0a TK	32	#define MODULE_NAME "sq905c"
	33
	34	#include <linux/workqueue.h>
5a0e3ad6	35	#include <linux/slab.h>
14a19c0a TK	36	#include "gspca.h"
	37
	38	MODULE_AUTHOR("Theodore Kilgore <kilgota@auburn.edu>");
	39	MODULE_DESCRIPTION("GSPCA/SQ905C USB Camera Driver");
	40	MODULE_LICENSE("GPL");
	41
	42	/* Default timeouts, in ms */
	43	#define SQ905C_CMD_TIMEOUT 500
	44	#define SQ905C_DATA_TIMEOUT 1000
	45
	46	/* Maximum transfer size to use. */
	47	#define SQ905C_MAX_TRANSFER 0x8000
	48
	49	#define FRAME_HEADER_LEN 0x50
	50
	51	/* Commands. These go in the "value" slot. */
	52	#define SQ905C_CLEAR 0xa0 /* clear everything */
ed9885aa	53	#define SQ905C_GET_ID 0x14f4 /* Read version number */
14a19c0a TK	54	#define SQ905C_CAPTURE_LOW 0xa040 /* Starts capture at 160x120 */
	55	#define SQ905C_CAPTURE_MED 0x1440 /* Starts capture at 320x240 */
	56	#define SQ905C_CAPTURE_HI 0x2840 /* Starts capture at 320x240 */
	57
	58	/* For capture, this must go in the "index" slot. */
	59	#define SQ905C_CAPTURE_INDEX 0x110f
	60
	61	/* Structure to hold all of our device specific stuff */
	62	struct sd {
	63	struct gspca_dev gspca_dev; /* !! must be the first item */
	64	const struct v4l2_pix_format *cap_mode;
	65	/* Driver stuff */
	66	struct work_struct work_struct;
	67	struct workqueue_struct *work_thread;
	68	};
	69
	70	/*
	71	* Most of these cameras will do 640x480 and 320x240. 160x120 works
	72	* in theory but gives very poor output. Therefore, not supported.
	73	* The 0x2770:0x9050 cameras have max resolution of 320x240.
	74	*/
	75	static struct v4l2_pix_format sq905c_mode[] = {
	76	{ 320, 240, V4L2_PIX_FMT_SQ905C, V4L2_FIELD_NONE,
	77	.bytesperline = 320,
	78	.sizeimage = 320 * 240,
	79	.colorspace = V4L2_COLORSPACE_SRGB,
	80	.priv = 0},
	81	{ 640, 480, V4L2_PIX_FMT_SQ905C, V4L2_FIELD_NONE,
	82	.bytesperline = 640,
	83	.sizeimage = 640 * 480,
	84	.colorspace = V4L2_COLORSPACE_SRGB,
	85	.priv = 0}
	86	};
	87
	88	/* Send a command to the camera. */
	89	static int sq905c_command(struct gspca_dev *gspca_dev, u16 command, u16 index)
	90	{
	91	int ret;
	92
	93	ret = usb_control_msg(gspca_dev->dev,
	94	usb_sndctrlpipe(gspca_dev->dev, 0),
	95	USB_REQ_SYNCH_FRAME, /* request */
	96	USB_DIR_OUT \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	97	command, index, NULL, 0,
	98	SQ905C_CMD_TIMEOUT);
	99	if (ret < 0) {
133a9fe9	100	pr_err("%s: usb_control_msg failed (%d)\n", __func__, ret);
14a19c0a TK	101	return ret;
	102	}
	103
	104	return 0;
	105	}
	106
ed9885aa TK	107	static int sq905c_read(struct gspca_dev *gspca_dev, u16 command, u16 index,
	108	int size)
	109	{
	110	int ret;
	111
	112	ret = usb_control_msg(gspca_dev->dev,
	113	usb_rcvctrlpipe(gspca_dev->dev, 0),
	114	USB_REQ_SYNCH_FRAME, /* request */
	115	USB_DIR_IN \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	116	command, index, gspca_dev->usb_buf, size,
	117	SQ905C_CMD_TIMEOUT);
	118	if (ret < 0) {
133a9fe9	119	pr_err("%s: usb_control_msg failed (%d)\n", __func__, ret);
ed9885aa TK	120	return ret;
	121	}
	122
	123	return 0;
	124	}
	125
14a19c0a TK	126	/* This function is called as a workqueue function and runs whenever the camera
	127	* is streaming data. Because it is a workqueue function it is allowed to sleep
	128	* so we can use synchronous USB calls. To avoid possible collisions with other
	129	* threads attempting to use the camera's USB interface the gspca usb_lock is
	130	* used when performing the one USB control operation inside the workqueue,
	131	* which tells the camera to close the stream. In practice the only thing
	132	* which needs to be protected against is the usb_set_interface call that
	133	* gspca makes during stream_off. Otherwise the camera doesn't provide any
	134	* controls that the user could try to change.
	135	*/
	136	static void sq905c_dostream(struct work_struct *work)
	137	{
	138	struct sd *dev = container_of(work, struct sd, work_struct);
	139	struct gspca_dev *gspca_dev = &dev->gspca_dev;
14a19c0a TK	140	int bytes_left; /* bytes remaining in current frame. */
	141	int data_len; /* size to use for the next read. */
	142	int act_len;
14a19c0a TK	143	int packet_type;
	144	int ret;
	145	u8 *buffer;
	146
	147	buffer = kmalloc(SQ905C_MAX_TRANSFER, GFP_KERNEL \| GFP_DMA);
	148	if (!buffer) {
133a9fe9	149	pr_err("Couldn't allocate USB buffer\n");
14a19c0a TK	150	goto quit_stream;
	151	}
	152
4ad34da0 HV	153	while (gspca_dev->dev && gspca_dev->streaming) {
	154	#ifdef CONFIG_PM
	155	if (gspca_dev->frozen)
	156	break;
	157	#endif
14a19c0a TK	158	/* Request the header, which tells the size to download */
	159	ret = usb_bulk_msg(gspca_dev->dev,
	160	usb_rcvbulkpipe(gspca_dev->dev, 0x81),
	161	buffer, FRAME_HEADER_LEN, &act_len,
	162	SQ905C_DATA_TIMEOUT);
	163	PDEBUG(D_STREAM,
	164	"Got %d bytes out of %d for header",
	165	act_len, FRAME_HEADER_LEN);
	166	if (ret < 0 \|\| act_len < FRAME_HEADER_LEN)
	167	goto quit_stream;
	168	/* size is read from 4 bytes starting 0x40, little endian */
	169	bytes_left = buffer[0x40]\|(buffer[0x41]<<8)\|(buffer[0x42]<<16)
	170	\|(buffer[0x43]<<24);
	171	PDEBUG(D_STREAM, "bytes_left = 0x%x", bytes_left);
	172	/* We keep the header. It has other information, too. */
	173	packet_type = FIRST_PACKET;
76dd272b JFM	174	gspca_frame_add(gspca_dev, packet_type,
76dd272b JFM	175	buffer, FRAME_HEADER_LEN);
254902b0	176	while (bytes_left > 0 && gspca_dev->dev) {
14a19c0a TK	177	data_len = bytes_left > SQ905C_MAX_TRANSFER ?
14a19c0a TK	178	SQ905C_MAX_TRANSFER : bytes_left;
14a19c0a TK	179	ret = usb_bulk_msg(gspca_dev->dev,
	180	usb_rcvbulkpipe(gspca_dev->dev, 0x81),
	181	buffer, data_len, &act_len,
	182	SQ905C_DATA_TIMEOUT);
	183	if (ret < 0 \|\| act_len < data_len)
	184	goto quit_stream;
	185	PDEBUG(D_STREAM,
	186	"Got %d bytes out of %d for frame",
	187	data_len, bytes_left);
	188	bytes_left -= data_len;
	189	if (bytes_left == 0)
	190	packet_type = LAST_PACKET;
	191	else
	192	packet_type = INTER_PACKET;
76dd272b JFM	193	gspca_frame_add(gspca_dev, packet_type,
76dd272b JFM	194	buffer, data_len);
14a19c0a TK	195	}
	196	}
	197	quit_stream:
254902b0	198	if (gspca_dev->dev) {
20526010	199	mutex_lock(&gspca_dev->usb_lock);
14a19c0a	200	sq905c_command(gspca_dev, SQ905C_CLEAR, 0);
20526010 HG	201	mutex_unlock(&gspca_dev->usb_lock);
20526010 HG	202	}
14a19c0a TK	203	kfree(buffer);
	204	}
	205
	206	/* This function is called at probe time just before sd_init */
	207	static int sd_config(struct gspca_dev *gspca_dev,
	208	const struct usb_device_id *id)
	209	{
	210	struct cam *cam = &gspca_dev->cam;
	211	struct sd dev = (struct sd ) gspca_dev;
914e8713	212	int ret;
14a19c0a TK	213
	214	PDEBUG(D_PROBE,
	215	"SQ9050 camera detected"
	216	" (vid/pid 0x%04X:0x%04X)", id->idVendor, id->idProduct);
ed9885aa TK	217
	218	ret = sq905c_command(gspca_dev, SQ905C_GET_ID, 0);
	219	if (ret < 0) {
	220	PDEBUG(D_ERR, "Get version command failed");
	221	return ret;
	222	}
	223
	224	ret = sq905c_read(gspca_dev, 0xf5, 0, 20);
	225	if (ret < 0) {
	226	PDEBUG(D_ERR, "Reading version command failed");
	227	return ret;
	228	}
	229	/* Note we leave out the usb id and the manufacturing date */
	230	PDEBUG(D_PROBE,
70aa3456 AS	231	"SQ9050 ID string: %02x - %*ph",
70aa3456 AS	232	gspca_dev->usb_buf[3], 6, gspca_dev->usb_buf + 14);
ed9885aa	233
14a19c0a TK	234	cam->cam_mode = sq905c_mode;
14a19c0a TK	235	cam->nmodes = 2;
ed9885aa	236	if (gspca_dev->usb_buf[15] == 0)
14a19c0a TK	237	cam->nmodes = 1;
	238	/* We don't use the buffer gspca allocates so make it small. */
	239	cam->bulk_size = 32;
6929dc6b	240	cam->bulk = 1;
14a19c0a TK	241	INIT_WORK(&dev->work_struct, sq905c_dostream);
	242	return 0;
	243	}
	244
	245	/* called on streamoff with alt==0 and on disconnect */
	246	/* the usb_lock is held at entry - restore on exit */
	247	static void sd_stop0(struct gspca_dev *gspca_dev)
	248	{
	249	struct sd dev = (struct sd ) gspca_dev;
	250
	251	/* wait for the work queue to terminate */
	252	mutex_unlock(&gspca_dev->usb_lock);
	253	/* This waits for sq905c_dostream to finish */
	254	destroy_workqueue(dev->work_thread);
	255	dev->work_thread = NULL;
	256	mutex_lock(&gspca_dev->usb_lock);
	257	}
	258
	259	/* this function is called at probe and resume time */
	260	static int sd_init(struct gspca_dev *gspca_dev)
	261	{
	262	int ret;
	263
	264	/* connect to the camera and reset it. */
	265	ret = sq905c_command(gspca_dev, SQ905C_CLEAR, 0);
	266	return ret;
	267	}
	268
	269	/* Set up for getting frames. */
	270	static int sd_start(struct gspca_dev *gspca_dev)
	271	{
	272	struct sd dev = (struct sd ) gspca_dev;
	273	int ret;
	274
	275	dev->cap_mode = gspca_dev->cam.cam_mode;
	276	/* "Open the shutter" and set size, to start capture */
	277	switch (gspca_dev->width) {
	278	case 640:
	279	PDEBUG(D_STREAM, "Start streaming at high resolution");
	280	dev->cap_mode++;
	281	ret = sq905c_command(gspca_dev, SQ905C_CAPTURE_HI,
	282	SQ905C_CAPTURE_INDEX);
	283	break;
	284	default: /* 320 */
	285	PDEBUG(D_STREAM, "Start streaming at medium resolution");
	286	ret = sq905c_command(gspca_dev, SQ905C_CAPTURE_MED,
	287	SQ905C_CAPTURE_INDEX);
	288	}
	289
	290	if (ret < 0) {
	291	PDEBUG(D_ERR, "Start streaming command failed");
	292	return ret;
	293	}
	294	/* Start the workqueue function to do the streaming */
	295	dev->work_thread = create_singlethread_workqueue(MODULE_NAME);
	296	queue_work(dev->work_thread, &dev->work_struct);
	297
	298	return 0;
	299	}
	300
	301	/* Table of supported USB devices */
95c967c1	302	static const struct usb_device_id device_table[] = {
14a19c0a TK	303	{USB_DEVICE(0x2770, 0x905c)},
14a19c0a TK	304	{USB_DEVICE(0x2770, 0x9050)},
634b4770	305	{USB_DEVICE(0x2770, 0x9051)},
eb900690	306	{USB_DEVICE(0x2770, 0x9052)},
14a19c0a TK	307	{USB_DEVICE(0x2770, 0x913d)},
	308	{}
	309	};
	310
	311	MODULE_DEVICE_TABLE(usb, device_table);
	312
	313	/* sub-driver description */
	314	static const struct sd_desc sd_desc = {
	315	.name = MODULE_NAME,
	316	.config = sd_config,
	317	.init = sd_init,
	318	.start = sd_start,
	319	.stop0 = sd_stop0,
	320	};
	321
	322	/* -- device connect -- */
	323	static int sd_probe(struct usb_interface *intf,
	324	const struct usb_device_id *id)
	325	{
	326	return gspca_dev_probe(intf, id,
	327	&sd_desc,
	328	sizeof(struct sd),
	329	THIS_MODULE);
	330	}
	331
	332	static struct usb_driver sd_driver = {
	333	.name = MODULE_NAME,
	334	.id_table = device_table,
	335	.probe = sd_probe,
	336	.disconnect = gspca_disconnect,
	337	#ifdef CONFIG_PM
	338	.suspend = gspca_suspend,
	339	.resume = gspca_resume,
8bb58964	340	.reset_resume = gspca_resume,
14a19c0a TK	341	#endif
	342	};
	343
ecb3b2b3	344	module_usb_driver(sd_driver);