mirror of
				https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
				synced 2025-10-30 23:58:51 +01:00 
			
		
		
		
	Fixed MTP to work with TWRP
This commit is contained in:
		
						commit
						f6dfaef42e
					
				
					 50820 changed files with 20846062 additions and 0 deletions
				
			
		
							
								
								
									
										735
									
								
								drivers/media/usb/gspca/sn9c2028.c
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										735
									
								
								drivers/media/usb/gspca/sn9c2028.c
									
										
									
									
									
										Normal file
									
								
							|  | @ -0,0 +1,735 @@ | |||
| /*
 | ||||
|  * SN9C2028 library | ||||
|  * | ||||
|  * Copyright (C) 2009 Theodore Kilgore <kilgota@auburn.edu> | ||||
|  * | ||||
|  * 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 "sn9c2028" | ||||
| 
 | ||||
| #include "gspca.h" | ||||
| 
 | ||||
| MODULE_AUTHOR("Theodore Kilgore"); | ||||
| MODULE_DESCRIPTION("Sonix SN9C2028 USB Camera Driver"); | ||||
| MODULE_LICENSE("GPL"); | ||||
| 
 | ||||
| /* specific webcam descriptor */ | ||||
| struct sd { | ||||
| 	struct gspca_dev gspca_dev;  /* !! must be the first item */ | ||||
| 	u8 sof_read; | ||||
| 	u16 model; | ||||
| }; | ||||
| 
 | ||||
| struct init_command { | ||||
| 	unsigned char instruction[6]; | ||||
| 	unsigned char to_read; /* length to read. 0 means no reply requested */ | ||||
| }; | ||||
| 
 | ||||
| /* How to change the resolution of any of the VGA cams is unknown */ | ||||
| static const struct v4l2_pix_format vga_mode[] = { | ||||
| 	{640, 480, V4L2_PIX_FMT_SN9C2028, V4L2_FIELD_NONE, | ||||
| 		.bytesperline = 640, | ||||
| 		.sizeimage = 640 * 480 * 3 / 4, | ||||
| 		.colorspace = V4L2_COLORSPACE_SRGB, | ||||
| 		.priv = 0}, | ||||
| }; | ||||
| 
 | ||||
| /* No way to change the resolution of the CIF cams is known */ | ||||
| static const struct v4l2_pix_format cif_mode[] = { | ||||
| 	{352, 288, V4L2_PIX_FMT_SN9C2028, V4L2_FIELD_NONE, | ||||
| 		.bytesperline = 352, | ||||
| 		.sizeimage = 352 * 288 * 3 / 4, | ||||
| 		.colorspace = V4L2_COLORSPACE_SRGB, | ||||
| 		.priv = 0}, | ||||
| }; | ||||
| 
 | ||||
| /* the bytes to write are in gspca_dev->usb_buf */ | ||||
| static int sn9c2028_command(struct gspca_dev *gspca_dev, u8 *command) | ||||
| { | ||||
| 	int rc; | ||||
| 
 | ||||
| 	PDEBUG(D_USBO, "sending command %02x%02x%02x%02x%02x%02x", command[0], | ||||
| 	       command[1], command[2], command[3], command[4], command[5]); | ||||
| 
 | ||||
| 	memcpy(gspca_dev->usb_buf, command, 6); | ||||
| 	rc = usb_control_msg(gspca_dev->dev, | ||||
| 			usb_sndctrlpipe(gspca_dev->dev, 0), | ||||
| 			USB_REQ_GET_CONFIGURATION, | ||||
| 			USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_INTERFACE, | ||||
| 			2, 0, gspca_dev->usb_buf, 6, 500); | ||||
| 	if (rc < 0) { | ||||
| 		pr_err("command write [%02x] error %d\n", | ||||
| 		       gspca_dev->usb_buf[0], rc); | ||||
| 		return rc; | ||||
| 	} | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| static int sn9c2028_read1(struct gspca_dev *gspca_dev) | ||||
| { | ||||
| 	int rc; | ||||
| 
 | ||||
| 	rc = usb_control_msg(gspca_dev->dev, | ||||
| 			usb_rcvctrlpipe(gspca_dev->dev, 0), | ||||
| 			USB_REQ_GET_STATUS, | ||||
| 			USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_INTERFACE, | ||||
| 			1, 0, gspca_dev->usb_buf, 1, 500); | ||||
| 	if (rc != 1) { | ||||
| 		pr_err("read1 error %d\n", rc); | ||||
| 		return (rc < 0) ? rc : -EIO; | ||||
| 	} | ||||
| 	PDEBUG(D_USBI, "read1 response %02x", gspca_dev->usb_buf[0]); | ||||
| 	return gspca_dev->usb_buf[0]; | ||||
| } | ||||
| 
 | ||||
| static int sn9c2028_read4(struct gspca_dev *gspca_dev, u8 *reading) | ||||
| { | ||||
| 	int rc; | ||||
| 	rc = usb_control_msg(gspca_dev->dev, | ||||
| 			usb_rcvctrlpipe(gspca_dev->dev, 0), | ||||
| 			USB_REQ_GET_STATUS, | ||||
| 			USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_INTERFACE, | ||||
| 			4, 0, gspca_dev->usb_buf, 4, 500); | ||||
| 	if (rc != 4) { | ||||
| 		pr_err("read4 error %d\n", rc); | ||||
| 		return (rc < 0) ? rc : -EIO; | ||||
| 	} | ||||
| 	memcpy(reading, gspca_dev->usb_buf, 4); | ||||
| 	PDEBUG(D_USBI, "read4 response %02x%02x%02x%02x", reading[0], | ||||
| 	       reading[1], reading[2], reading[3]); | ||||
| 	return rc; | ||||
| } | ||||
| 
 | ||||
| static int sn9c2028_long_command(struct gspca_dev *gspca_dev, u8 *command) | ||||
| { | ||||
| 	int i, status; | ||||
| 	__u8 reading[4]; | ||||
| 
 | ||||
| 	status = sn9c2028_command(gspca_dev, command); | ||||
| 	if (status < 0) | ||||
| 		return status; | ||||
| 
 | ||||
| 	status = -1; | ||||
| 	for (i = 0; i < 256 && status < 2; i++) | ||||
| 		status = sn9c2028_read1(gspca_dev); | ||||
| 	if (status != 2) { | ||||
| 		pr_err("long command status read error %d\n", status); | ||||
| 		return (status < 0) ? status : -EIO; | ||||
| 	} | ||||
| 
 | ||||
| 	memset(reading, 0, 4); | ||||
| 	status = sn9c2028_read4(gspca_dev, reading); | ||||
| 	if (status < 0) | ||||
| 		return status; | ||||
| 
 | ||||
| 	/* in general, the first byte of the response is the first byte of
 | ||||
| 	 * the command, or'ed with 8 */ | ||||
| 	status = sn9c2028_read1(gspca_dev); | ||||
| 	if (status < 0) | ||||
| 		return status; | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| static int sn9c2028_short_command(struct gspca_dev *gspca_dev, u8 *command) | ||||
| { | ||||
| 	int err_code; | ||||
| 
 | ||||
| 	err_code = sn9c2028_command(gspca_dev, command); | ||||
| 	if (err_code < 0) | ||||
| 		return err_code; | ||||
| 
 | ||||
| 	err_code = sn9c2028_read1(gspca_dev); | ||||
| 	if (err_code < 0) | ||||
| 		return err_code; | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| /* 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 = &gspca_dev->cam; | ||||
| 
 | ||||
| 	PDEBUG(D_PROBE, "SN9C2028 camera detected (vid/pid 0x%04X:0x%04X)", | ||||
| 	       id->idVendor, id->idProduct); | ||||
| 
 | ||||
| 	sd->model = id->idProduct; | ||||
| 
 | ||||
| 	switch (sd->model) { | ||||
| 	case 0x7005: | ||||
| 		PDEBUG(D_PROBE, "Genius Smart 300 camera"); | ||||
| 		break; | ||||
| 	case 0x8000: | ||||
| 		PDEBUG(D_PROBE, "DC31VC"); | ||||
| 		break; | ||||
| 	case 0x8001: | ||||
| 		PDEBUG(D_PROBE, "Spy camera"); | ||||
| 		break; | ||||
| 	case 0x8003: | ||||
| 		PDEBUG(D_PROBE, "CIF camera"); | ||||
| 		break; | ||||
| 	case 0x8008: | ||||
| 		PDEBUG(D_PROBE, "Mini-Shotz ms-350 camera"); | ||||
| 		break; | ||||
| 	case 0x800a: | ||||
| 		PDEBUG(D_PROBE, "Vivitar 3350b type camera"); | ||||
| 		cam->input_flags = V4L2_IN_ST_VFLIP | V4L2_IN_ST_HFLIP; | ||||
| 		break; | ||||
| 	} | ||||
| 
 | ||||
| 	switch (sd->model) { | ||||
| 	case 0x8000: | ||||
| 	case 0x8001: | ||||
| 	case 0x8003: | ||||
| 		cam->cam_mode = cif_mode; | ||||
| 		cam->nmodes = ARRAY_SIZE(cif_mode); | ||||
| 		break; | ||||
| 	default: | ||||
| 		cam->cam_mode = vga_mode; | ||||
| 		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) | ||||
| { | ||||
| 	int status = -1; | ||||
| 
 | ||||
| 	sn9c2028_read1(gspca_dev); | ||||
| 	sn9c2028_read1(gspca_dev); | ||||
| 	status = sn9c2028_read1(gspca_dev); | ||||
| 
 | ||||
| 	return (status < 0) ? status : 0; | ||||
| } | ||||
| 
 | ||||
| static int run_start_commands(struct gspca_dev *gspca_dev, | ||||
| 			      struct init_command *cam_commands, int n) | ||||
| { | ||||
| 	int i, err_code = -1; | ||||
| 
 | ||||
| 	for (i = 0; i < n; i++) { | ||||
| 		switch (cam_commands[i].to_read) { | ||||
| 		case 4: | ||||
| 			err_code = sn9c2028_long_command(gspca_dev, | ||||
| 					cam_commands[i].instruction); | ||||
| 			break; | ||||
| 		case 1: | ||||
| 			err_code = sn9c2028_short_command(gspca_dev, | ||||
| 					cam_commands[i].instruction); | ||||
| 			break; | ||||
| 		case 0: | ||||
| 			err_code = sn9c2028_command(gspca_dev, | ||||
| 					cam_commands[i].instruction); | ||||
| 			break; | ||||
| 		} | ||||
| 		if (err_code < 0) | ||||
| 			return err_code; | ||||
| 	} | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| static int start_spy_cam(struct gspca_dev *gspca_dev) | ||||
| { | ||||
| 	struct init_command spy_start_commands[] = { | ||||
| 		{{0x0c, 0x01, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x20, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x21, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x22, 0x01, 0x04, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x23, 0x01, 0x03, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x24, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x25, 0x01, 0x16, 0x00, 0x00}, 4}, /* width  352 */ | ||||
| 		{{0x13, 0x26, 0x01, 0x12, 0x00, 0x00}, 4}, /* height 288 */ | ||||
| 		/* {{0x13, 0x27, 0x01, 0x28, 0x00, 0x00}, 4}, */ | ||||
| 		{{0x13, 0x27, 0x01, 0x68, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x28, 0x01, 0x09, 0x00, 0x00}, 4}, /* red gain ?*/ | ||||
| 		/* {{0x13, 0x28, 0x01, 0x00, 0x00, 0x00}, 4}, */ | ||||
| 		{{0x13, 0x29, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		/* {{0x13, 0x29, 0x01, 0x0c, 0x00, 0x00}, 4}, */ | ||||
| 		{{0x13, 0x2a, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2b, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		/* {{0x13, 0x2c, 0x01, 0x02, 0x00, 0x00}, 4}, */ | ||||
| 		{{0x13, 0x2c, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2d, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		/* {{0x13, 0x2e, 0x01, 0x09, 0x00, 0x00}, 4}, */ | ||||
| 		{{0x13, 0x2e, 0x01, 0x09, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2f, 0x01, 0x07, 0x00, 0x00}, 4}, | ||||
| 		{{0x12, 0x34, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x34, 0x01, 0xa1, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x35, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x02, 0x06, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x03, 0x13, 0x00, 0x00, 0x00}, 4}, /*don't mess with*/ | ||||
| 		/*{{0x11, 0x04, 0x06, 0x00, 0x00, 0x00}, 4}, observed */ | ||||
| 		{{0x11, 0x04, 0x00, 0x00, 0x00, 0x00}, 4}, /* brighter */ | ||||
| 		/*{{0x11, 0x05, 0x65, 0x00, 0x00, 0x00}, 4}, observed */ | ||||
| 		{{0x11, 0x05, 0x00, 0x00, 0x00, 0x00}, 4}, /* brighter */ | ||||
| 		{{0x11, 0x06, 0xb1, 0x00, 0x00, 0x00}, 4}, /* observed */ | ||||
| 		{{0x11, 0x07, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		/*{{0x11, 0x08, 0x06, 0x00, 0x00, 0x00}, 4}, observed */ | ||||
| 		{{0x11, 0x08, 0x0b, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x09, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0a, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0b, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0c, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0d, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0e, 0x04, 0x00, 0x00, 0x00}, 4}, | ||||
| 		/* {{0x11, 0x0f, 0x00, 0x00, 0x00, 0x00}, 4}, */ | ||||
| 		/* brightness or gain. 0 is default. 4 is good
 | ||||
| 		 * indoors at night with incandescent lighting */ | ||||
| 		{{0x11, 0x0f, 0x04, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x10, 0x06, 0x00, 0x00, 0x00}, 4}, /*hstart or hoffs*/ | ||||
| 		{{0x11, 0x11, 0x06, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x12, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x14, 0x02, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x13, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		/* {{0x1b, 0x02, 0x06, 0x00, 0x00, 0x00}, 1}, observed */ | ||||
| 		{{0x1b, 0x02, 0x11, 0x00, 0x00, 0x00}, 1}, /* brighter */ | ||||
| 		/* {{0x1b, 0x13, 0x01, 0x00, 0x00, 0x00}, 1}, observed */ | ||||
| 		{{0x1b, 0x13, 0x11, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x20, 0x34, 0xa1, 0x00, 0x00, 0x00}, 1}, /* compresses */ | ||||
| 		/* Camera should start to capture now. */ | ||||
| 	}; | ||||
| 
 | ||||
| 	return run_start_commands(gspca_dev, spy_start_commands, | ||||
| 				  ARRAY_SIZE(spy_start_commands)); | ||||
| } | ||||
| 
 | ||||
| static int start_cif_cam(struct gspca_dev *gspca_dev) | ||||
| { | ||||
| 	struct init_command cif_start_commands[] = { | ||||
| 		{{0x0c, 0x01, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		/* The entire sequence below seems redundant */ | ||||
| 		/* {{0x13, 0x20, 0x01, 0x00, 0x00, 0x00}, 4},
 | ||||
| 		{{0x13, 0x21, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x22, 0x01, 0x06, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x23, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x24, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x25, 0x01, 0x16, 0x00, 0x00}, 4}, width? | ||||
| 		{{0x13, 0x26, 0x01, 0x12, 0x00, 0x00}, 4}, height? | ||||
| 		{{0x13, 0x27, 0x01, 0x68, 0x00, 0x00}, 4}, subsample? | ||||
| 		{{0x13, 0x28, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x29, 0x01, 0x20, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2a, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2b, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2c, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2d, 0x01, 0x03, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2e, 0x01, 0x0f, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2f, 0x01, 0x0c, 0x00, 0x00}, 4}, | ||||
| 		{{0x12, 0x34, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x34, 0x01, 0xa1, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x35, 0x01, 0x00, 0x00, 0x00}, 4},*/ | ||||
| 		{{0x1b, 0x21, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x17, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x19, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x02, 0x06, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x03, 0x5a, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x04, 0x27, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x05, 0x01, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x12, 0x14, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x13, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x14, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x15, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x16, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x77, 0xa2, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x06, 0x0f, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x07, 0x14, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x08, 0x0f, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x09, 0x10, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x0e, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x0f, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x12, 0x07, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x10, 0x1f, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x11, 0x01, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x13, 0x25, 0x01, 0x16, 0x00, 0x00}, 1}, /* width/8 */ | ||||
| 		{{0x13, 0x26, 0x01, 0x12, 0x00, 0x00}, 1}, /* height/8 */ | ||||
| 		/* {{0x13, 0x27, 0x01, 0x68, 0x00, 0x00}, 4}, subsample?
 | ||||
| 		 * {{0x13, 0x28, 0x01, 0x1e, 0x00, 0x00}, 4}, does nothing | ||||
| 		 * {{0x13, 0x27, 0x01, 0x20, 0x00, 0x00}, 4}, */ | ||||
| 		/* {{0x13, 0x29, 0x01, 0x22, 0x00, 0x00}, 4},
 | ||||
| 		 * causes subsampling | ||||
| 		 * but not a change in the resolution setting! */ | ||||
| 		{{0x13, 0x2c, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2d, 0x01, 0x01, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2e, 0x01, 0x08, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2f, 0x01, 0x06, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x28, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x1b, 0x04, 0x6d, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x05, 0x03, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x20, 0x36, 0x06, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x0e, 0x01, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x12, 0x27, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x1b, 0x0f, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x20, 0x36, 0x05, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x10, 0x0f, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x02, 0x06, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x11, 0x01, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x20, 0x34, 0xa1, 0x00, 0x00, 0x00}, 1},/* use compression */ | ||||
| 		/* Camera should start to capture now. */ | ||||
| 	}; | ||||
| 
 | ||||
| 	return run_start_commands(gspca_dev, cif_start_commands, | ||||
| 				  ARRAY_SIZE(cif_start_commands)); | ||||
| } | ||||
| 
 | ||||
| static int start_ms350_cam(struct gspca_dev *gspca_dev) | ||||
| { | ||||
| 	struct init_command ms350_start_commands[] = { | ||||
| 		{{0x0c, 0x01, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x16, 0x01, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x20, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x21, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x22, 0x01, 0x04, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x23, 0x01, 0x03, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x24, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x25, 0x01, 0x16, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x26, 0x01, 0x12, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x27, 0x01, 0x28, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x28, 0x01, 0x09, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x29, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2a, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2b, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2c, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2d, 0x01, 0x03, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2e, 0x01, 0x0f, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2f, 0x01, 0x0c, 0x00, 0x00}, 4}, | ||||
| 		{{0x12, 0x34, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x34, 0x01, 0xa1, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x35, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x00, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x01, 0x70, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x02, 0x05, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x03, 0x5d, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x04, 0x07, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x05, 0x25, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x06, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x07, 0x09, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x08, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x09, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0b, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0c, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0d, 0x0c, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0e, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x0f, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x10, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x11, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x12, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x13, 0x63, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x15, 0x70, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x18, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x11, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x25, 0x01, 0x28, 0x00, 0x00}, 4}, /* width  */ | ||||
| 		{{0x13, 0x26, 0x01, 0x1e, 0x00, 0x00}, 4}, /* height */ | ||||
| 		{{0x13, 0x28, 0x01, 0x09, 0x00, 0x00}, 4}, /* vstart? */ | ||||
| 		{{0x13, 0x27, 0x01, 0x28, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x29, 0x01, 0x40, 0x00, 0x00}, 4}, /* hstart? */ | ||||
| 		{{0x13, 0x2c, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2d, 0x01, 0x03, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2e, 0x01, 0x0f, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2f, 0x01, 0x0c, 0x00, 0x00}, 4}, | ||||
| 		{{0x1b, 0x02, 0x05, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x11, 0x01, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x20, 0x18, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x02, 0x0a, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x11, 0x01, 0x00, 0x00, 0x00}, 0}, | ||||
| 		/* Camera should start to capture now. */ | ||||
| 	}; | ||||
| 
 | ||||
| 	return run_start_commands(gspca_dev, ms350_start_commands, | ||||
| 				  ARRAY_SIZE(ms350_start_commands)); | ||||
| } | ||||
| 
 | ||||
| static int start_genius_cam(struct gspca_dev *gspca_dev) | ||||
| { | ||||
| 	struct init_command genius_start_commands[] = { | ||||
| 		{{0x0c, 0x01, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x16, 0x01, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x10, 0x00, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x25, 0x01, 0x16, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x26, 0x01, 0x12, 0x00, 0x00}, 4}, | ||||
| 		/* "preliminary" width and height settings */ | ||||
| 		{{0x13, 0x28, 0x01, 0x0e, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x27, 0x01, 0x20, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x29, 0x01, 0x22, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2c, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2d, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2e, 0x01, 0x09, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2f, 0x01, 0x07, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x20, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x21, 0x2d, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x22, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x23, 0x03, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x10, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x11, 0x64, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x12, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x13, 0x91, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x14, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x15, 0x20, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x16, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x17, 0x60, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x20, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x21, 0x2d, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x22, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x23, 0x03, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x25, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x26, 0x02, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x27, 0x88, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x30, 0x38, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x31, 0x2a, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x32, 0x2a, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x33, 0x2a, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x34, 0x02, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x5b, 0x0a, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x25, 0x01, 0x28, 0x00, 0x00}, 4}, /* real width */ | ||||
| 		{{0x13, 0x26, 0x01, 0x1e, 0x00, 0x00}, 4}, /* real height */ | ||||
| 		{{0x13, 0x28, 0x01, 0x0e, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x27, 0x01, 0x20, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x29, 0x01, 0x62, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2c, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2d, 0x01, 0x03, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2e, 0x01, 0x0f, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2f, 0x01, 0x0c, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x20, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x21, 0x2a, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x22, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x23, 0x28, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x10, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x11, 0x04, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x12, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x13, 0x03, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x14, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x15, 0xe0, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x16, 0x02, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x11, 0x17, 0x80, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x1c, 0x20, 0x00, 0x2a, 0x00, 0x00}, 1}, | ||||
| 		{{0x1c, 0x20, 0x00, 0x2a, 0x00, 0x00}, 1}, | ||||
| 		{{0x20, 0x34, 0xa1, 0x00, 0x00, 0x00}, 0} | ||||
| 		/* Camera should start to capture now. */ | ||||
| 	}; | ||||
| 
 | ||||
| 	return run_start_commands(gspca_dev, genius_start_commands, | ||||
| 				  ARRAY_SIZE(genius_start_commands)); | ||||
| } | ||||
| 
 | ||||
| static int start_vivitar_cam(struct gspca_dev *gspca_dev) | ||||
| { | ||||
| 	struct init_command vivitar_start_commands[] = { | ||||
| 		{{0x0c, 0x01, 0x00, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x20, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x21, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x22, 0x01, 0x01, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x23, 0x01, 0x01, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x24, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x25, 0x01, 0x28, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x26, 0x01, 0x1e, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x27, 0x01, 0x20, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x28, 0x01, 0x0a, 0x00, 0x00}, 4}, | ||||
| 		/*
 | ||||
| 		 * Above is changed from OEM 0x0b. Fixes Bayer tiling. | ||||
| 		 * Presumably gives a vertical shift of one row. | ||||
| 		 */ | ||||
| 		{{0x13, 0x29, 0x01, 0x20, 0x00, 0x00}, 4}, | ||||
| 		/* Above seems to do horizontal shift. */ | ||||
| 		{{0x13, 0x2a, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2b, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2c, 0x01, 0x02, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2d, 0x01, 0x03, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2e, 0x01, 0x0f, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x2f, 0x01, 0x0c, 0x00, 0x00}, 4}, | ||||
| 		/* Above three commands seem to relate to brightness. */ | ||||
| 		{{0x12, 0x34, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x34, 0x01, 0xa1, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x35, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x1b, 0x12, 0x80, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x01, 0x77, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x02, 0x3a, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x12, 0x78, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x13, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x14, 0x80, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x15, 0x34, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x1b, 0x04, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x20, 0x44, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x23, 0xee, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x26, 0xa0, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x27, 0x9a, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x28, 0xa0, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x29, 0x30, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x2a, 0x80, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x2b, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x2f, 0x3d, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x30, 0x24, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x32, 0x86, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x60, 0xa9, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x61, 0x42, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x65, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x69, 0x38, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x6f, 0x88, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x70, 0x0b, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x71, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x74, 0x21, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x75, 0x86, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x76, 0x00, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x7d, 0xf3, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x17, 0x1c, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x18, 0xc0, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x19, 0x05, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x1a, 0xf6, 0x00, 0x00, 0x00}, 1}, | ||||
| 		/* {{0x13, 0x25, 0x01, 0x28, 0x00, 0x00}, 4},
 | ||||
| 		{{0x13, 0x26, 0x01, 0x1e, 0x00, 0x00}, 4}, | ||||
| 		{{0x13, 0x28, 0x01, 0x0b, 0x00, 0x00}, 4}, */ | ||||
| 		{{0x20, 0x36, 0x06, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x10, 0x26, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x12, 0x27, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x1b, 0x76, 0x03, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x20, 0x36, 0x05, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x1b, 0x00, 0x3f, 0x00, 0x00, 0x00}, 1}, | ||||
| 		/* Above is brightness; OEM driver setting is 0x10 */ | ||||
| 		{{0x12, 0x27, 0x01, 0x00, 0x00, 0x00}, 4}, | ||||
| 		{{0x20, 0x29, 0x30, 0x00, 0x00, 0x00}, 1}, | ||||
| 		{{0x20, 0x34, 0xa1, 0x00, 0x00, 0x00}, 1} | ||||
| 	}; | ||||
| 
 | ||||
| 	return run_start_commands(gspca_dev, vivitar_start_commands, | ||||
| 				  ARRAY_SIZE(vivitar_start_commands)); | ||||
| } | ||||
| 
 | ||||
| static int sd_start(struct gspca_dev *gspca_dev) | ||||
| { | ||||
| 	struct sd *sd = (struct sd *) gspca_dev; | ||||
| 	int err_code; | ||||
| 
 | ||||
| 	sd->sof_read = 0; | ||||
| 
 | ||||
| 	switch (sd->model) { | ||||
| 	case 0x7005: | ||||
| 		err_code = start_genius_cam(gspca_dev); | ||||
| 		break; | ||||
| 	case 0x8001: | ||||
| 		err_code = start_spy_cam(gspca_dev); | ||||
| 		break; | ||||
| 	case 0x8003: | ||||
| 		err_code = start_cif_cam(gspca_dev); | ||||
| 		break; | ||||
| 	case 0x8008: | ||||
| 		err_code = start_ms350_cam(gspca_dev); | ||||
| 		break; | ||||
| 	case 0x800a: | ||||
| 		err_code = start_vivitar_cam(gspca_dev); | ||||
| 		break; | ||||
| 	default: | ||||
| 		pr_err("Starting unknown camera, please report this\n"); | ||||
| 		return -ENXIO; | ||||
| 	} | ||||
| 
 | ||||
| 	return err_code; | ||||
| } | ||||
| 
 | ||||
| static void sd_stopN(struct gspca_dev *gspca_dev) | ||||
| { | ||||
| 	int result; | ||||
| 	__u8 data[6]; | ||||
| 
 | ||||
| 	result = sn9c2028_read1(gspca_dev); | ||||
| 	if (result < 0) | ||||
| 		PERR("Camera Stop read failed"); | ||||
| 
 | ||||
| 	memset(data, 0, 6); | ||||
| 	data[0] = 0x14; | ||||
| 	result = sn9c2028_command(gspca_dev, data); | ||||
| 	if (result < 0) | ||||
| 		PERR("Camera Stop command failed"); | ||||
| } | ||||
| 
 | ||||
| /* Include sn9c2028 sof detection functions */ | ||||
| #include "sn9c2028.h" | ||||
| 
 | ||||
| static void sd_pkt_scan(struct gspca_dev *gspca_dev, | ||||
| 			__u8 *data,			/* isoc packet */ | ||||
| 			int len)			/* iso packet length */ | ||||
| { | ||||
| 	unsigned char *sof; | ||||
| 
 | ||||
| 	sof = sn9c2028_find_sof(gspca_dev, data, len); | ||||
| 	if (sof) { | ||||
| 		int n; | ||||
| 
 | ||||
| 		/* finish decoding current frame */ | ||||
| 		n = sof - data; | ||||
| 		if (n > sizeof sn9c2028_sof_marker) | ||||
| 			n -= sizeof sn9c2028_sof_marker; | ||||
| 		else | ||||
| 			n = 0; | ||||
| 		gspca_frame_add(gspca_dev, LAST_PACKET, data, n); | ||||
| 		/* Start next frame. */ | ||||
| 		gspca_frame_add(gspca_dev, FIRST_PACKET, | ||||
| 			sn9c2028_sof_marker, sizeof sn9c2028_sof_marker); | ||||
| 		len -= sof - data; | ||||
| 		data = sof; | ||||
| 	} | ||||
| 	gspca_frame_add(gspca_dev, INTER_PACKET, data, len); | ||||
| } | ||||
| 
 | ||||
| /* sub-driver description */ | ||||
| static const struct sd_desc sd_desc = { | ||||
| 	.name = MODULE_NAME, | ||||
| 	.config = sd_config, | ||||
| 	.init = sd_init, | ||||
| 	.start = sd_start, | ||||
| 	.stopN = sd_stopN, | ||||
| 	.pkt_scan = sd_pkt_scan, | ||||
| }; | ||||
| 
 | ||||
| /* -- module initialisation -- */ | ||||
| static const struct usb_device_id device_table[] = { | ||||
| 	{USB_DEVICE(0x0458, 0x7005)}, /* Genius Smart 300, version 2 */ | ||||
| 	/* The Genius Smart is untested. I can't find an owner ! */ | ||||
| 	/* {USB_DEVICE(0x0c45, 0x8000)}, DC31VC, Don't know this camera */ | ||||
| 	{USB_DEVICE(0x0c45, 0x8001)}, /* Wild Planet digital spy cam */ | ||||
| 	{USB_DEVICE(0x0c45, 0x8003)}, /* Several small CIF cameras */ | ||||
| 	/* {USB_DEVICE(0x0c45, 0x8006)}, Unknown VGA camera */ | ||||
| 	{USB_DEVICE(0x0c45, 0x8008)}, /* Mini-Shotz ms-350 */ | ||||
| 	{USB_DEVICE(0x0c45, 0x800a)}, /* Vivicam 3350B */ | ||||
| 	{} | ||||
| }; | ||||
| 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); | ||||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue
	
	 awab228
						awab228