162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * GSPCA Endpoints (formerly known as AOX) se401 USB Camera sub Driver 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2011 Hans de Goede <hdegoede@redhat.com> 662306a36Sopenharmony_ci * 762306a36Sopenharmony_ci * Based on the v4l1 se401 driver which is: 862306a36Sopenharmony_ci * 962306a36Sopenharmony_ci * Copyright (c) 2000 Jeroen B. Vreeken (pe1rxq@amsat.org) 1062306a36Sopenharmony_ci */ 1162306a36Sopenharmony_ci 1262306a36Sopenharmony_ci#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#define MODULE_NAME "se401" 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci#define BULK_SIZE 4096 1762306a36Sopenharmony_ci#define PACKET_SIZE 1024 1862306a36Sopenharmony_ci#define READ_REQ_SIZE 64 1962306a36Sopenharmony_ci#define MAX_MODES ((READ_REQ_SIZE - 6) / 4) 2062306a36Sopenharmony_ci/* The se401 compression algorithm uses a fixed quant factor, which 2162306a36Sopenharmony_ci can be configured by setting the high nibble of the SE401_OPERATINGMODE 2262306a36Sopenharmony_ci feature. This needs to exactly match what is in libv4l! */ 2362306a36Sopenharmony_ci#define SE401_QUANT_FACT 8 2462306a36Sopenharmony_ci 2562306a36Sopenharmony_ci#include <linux/input.h> 2662306a36Sopenharmony_ci#include <linux/slab.h> 2762306a36Sopenharmony_ci#include "gspca.h" 2862306a36Sopenharmony_ci#include "se401.h" 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_ciMODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>"); 3162306a36Sopenharmony_ciMODULE_DESCRIPTION("Endpoints se401"); 3262306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_ci/* exposure change state machine states */ 3562306a36Sopenharmony_cienum { 3662306a36Sopenharmony_ci EXPO_CHANGED, 3762306a36Sopenharmony_ci EXPO_DROP_FRAME, 3862306a36Sopenharmony_ci EXPO_NO_CHANGE, 3962306a36Sopenharmony_ci}; 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ci/* specific webcam descriptor */ 4262306a36Sopenharmony_cistruct sd { 4362306a36Sopenharmony_ci struct gspca_dev gspca_dev; /* !! must be the first item */ 4462306a36Sopenharmony_ci struct { /* exposure/freq control cluster */ 4562306a36Sopenharmony_ci struct v4l2_ctrl *exposure; 4662306a36Sopenharmony_ci struct v4l2_ctrl *freq; 4762306a36Sopenharmony_ci }; 4862306a36Sopenharmony_ci bool has_brightness; 4962306a36Sopenharmony_ci struct v4l2_pix_format fmts[MAX_MODES]; 5062306a36Sopenharmony_ci int pixels_read; 5162306a36Sopenharmony_ci int packet_read; 5262306a36Sopenharmony_ci u8 packet[PACKET_SIZE]; 5362306a36Sopenharmony_ci u8 restart_stream; 5462306a36Sopenharmony_ci u8 button_state; 5562306a36Sopenharmony_ci u8 resetlevel; 5662306a36Sopenharmony_ci u8 resetlevel_frame_count; 5762306a36Sopenharmony_ci int resetlevel_adjust_dir; 5862306a36Sopenharmony_ci int expo_change_state; 5962306a36Sopenharmony_ci}; 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_cistatic void se401_write_req(struct gspca_dev *gspca_dev, u16 req, u16 value, 6362306a36Sopenharmony_ci int silent) 6462306a36Sopenharmony_ci{ 6562306a36Sopenharmony_ci int err; 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci if (gspca_dev->usb_err < 0) 6862306a36Sopenharmony_ci return; 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci err = usb_control_msg(gspca_dev->dev, 7162306a36Sopenharmony_ci usb_sndctrlpipe(gspca_dev->dev, 0), req, 7262306a36Sopenharmony_ci USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 7362306a36Sopenharmony_ci value, 0, NULL, 0, 1000); 7462306a36Sopenharmony_ci if (err < 0) { 7562306a36Sopenharmony_ci if (!silent) 7662306a36Sopenharmony_ci pr_err("write req failed req %#04x val %#04x error %d\n", 7762306a36Sopenharmony_ci req, value, err); 7862306a36Sopenharmony_ci gspca_dev->usb_err = err; 7962306a36Sopenharmony_ci } 8062306a36Sopenharmony_ci} 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_cistatic void se401_read_req(struct gspca_dev *gspca_dev, u16 req, int silent) 8362306a36Sopenharmony_ci{ 8462306a36Sopenharmony_ci int err; 8562306a36Sopenharmony_ci 8662306a36Sopenharmony_ci if (gspca_dev->usb_err < 0) 8762306a36Sopenharmony_ci return; 8862306a36Sopenharmony_ci 8962306a36Sopenharmony_ci if (USB_BUF_SZ < READ_REQ_SIZE) { 9062306a36Sopenharmony_ci pr_err("USB_BUF_SZ too small!!\n"); 9162306a36Sopenharmony_ci gspca_dev->usb_err = -ENOBUFS; 9262306a36Sopenharmony_ci return; 9362306a36Sopenharmony_ci } 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_ci err = usb_control_msg(gspca_dev->dev, 9662306a36Sopenharmony_ci usb_rcvctrlpipe(gspca_dev->dev, 0), req, 9762306a36Sopenharmony_ci USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 9862306a36Sopenharmony_ci 0, 0, gspca_dev->usb_buf, READ_REQ_SIZE, 1000); 9962306a36Sopenharmony_ci if (err < 0) { 10062306a36Sopenharmony_ci if (!silent) 10162306a36Sopenharmony_ci pr_err("read req failed req %#04x error %d\n", 10262306a36Sopenharmony_ci req, err); 10362306a36Sopenharmony_ci gspca_dev->usb_err = err; 10462306a36Sopenharmony_ci /* 10562306a36Sopenharmony_ci * Make sure the buffer is zeroed to avoid uninitialized 10662306a36Sopenharmony_ci * values. 10762306a36Sopenharmony_ci */ 10862306a36Sopenharmony_ci memset(gspca_dev->usb_buf, 0, READ_REQ_SIZE); 10962306a36Sopenharmony_ci } 11062306a36Sopenharmony_ci} 11162306a36Sopenharmony_ci 11262306a36Sopenharmony_cistatic void se401_set_feature(struct gspca_dev *gspca_dev, 11362306a36Sopenharmony_ci u16 selector, u16 param) 11462306a36Sopenharmony_ci{ 11562306a36Sopenharmony_ci int err; 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci if (gspca_dev->usb_err < 0) 11862306a36Sopenharmony_ci return; 11962306a36Sopenharmony_ci 12062306a36Sopenharmony_ci err = usb_control_msg(gspca_dev->dev, 12162306a36Sopenharmony_ci usb_sndctrlpipe(gspca_dev->dev, 0), 12262306a36Sopenharmony_ci SE401_REQ_SET_EXT_FEATURE, 12362306a36Sopenharmony_ci USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 12462306a36Sopenharmony_ci param, selector, NULL, 0, 1000); 12562306a36Sopenharmony_ci if (err < 0) { 12662306a36Sopenharmony_ci pr_err("set feature failed sel %#04x param %#04x error %d\n", 12762306a36Sopenharmony_ci selector, param, err); 12862306a36Sopenharmony_ci gspca_dev->usb_err = err; 12962306a36Sopenharmony_ci } 13062306a36Sopenharmony_ci} 13162306a36Sopenharmony_ci 13262306a36Sopenharmony_cistatic int se401_get_feature(struct gspca_dev *gspca_dev, u16 selector) 13362306a36Sopenharmony_ci{ 13462306a36Sopenharmony_ci int err; 13562306a36Sopenharmony_ci 13662306a36Sopenharmony_ci if (gspca_dev->usb_err < 0) 13762306a36Sopenharmony_ci return gspca_dev->usb_err; 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_ci if (USB_BUF_SZ < 2) { 14062306a36Sopenharmony_ci pr_err("USB_BUF_SZ too small!!\n"); 14162306a36Sopenharmony_ci gspca_dev->usb_err = -ENOBUFS; 14262306a36Sopenharmony_ci return gspca_dev->usb_err; 14362306a36Sopenharmony_ci } 14462306a36Sopenharmony_ci 14562306a36Sopenharmony_ci err = usb_control_msg(gspca_dev->dev, 14662306a36Sopenharmony_ci usb_rcvctrlpipe(gspca_dev->dev, 0), 14762306a36Sopenharmony_ci SE401_REQ_GET_EXT_FEATURE, 14862306a36Sopenharmony_ci USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, 14962306a36Sopenharmony_ci 0, selector, gspca_dev->usb_buf, 2, 1000); 15062306a36Sopenharmony_ci if (err < 0) { 15162306a36Sopenharmony_ci pr_err("get feature failed sel %#04x error %d\n", 15262306a36Sopenharmony_ci selector, err); 15362306a36Sopenharmony_ci gspca_dev->usb_err = err; 15462306a36Sopenharmony_ci return err; 15562306a36Sopenharmony_ci } 15662306a36Sopenharmony_ci return gspca_dev->usb_buf[0] | (gspca_dev->usb_buf[1] << 8); 15762306a36Sopenharmony_ci} 15862306a36Sopenharmony_ci 15962306a36Sopenharmony_cistatic void setbrightness(struct gspca_dev *gspca_dev, s32 val) 16062306a36Sopenharmony_ci{ 16162306a36Sopenharmony_ci /* HDG: this does not seem to do anything on my cam */ 16262306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_SET_BRT, val, 0); 16362306a36Sopenharmony_ci} 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_cistatic void setgain(struct gspca_dev *gspca_dev, s32 val) 16662306a36Sopenharmony_ci{ 16762306a36Sopenharmony_ci u16 gain = 63 - val; 16862306a36Sopenharmony_ci 16962306a36Sopenharmony_ci /* red color gain */ 17062306a36Sopenharmony_ci se401_set_feature(gspca_dev, HV7131_REG_ARCG, gain); 17162306a36Sopenharmony_ci /* green color gain */ 17262306a36Sopenharmony_ci se401_set_feature(gspca_dev, HV7131_REG_AGCG, gain); 17362306a36Sopenharmony_ci /* blue color gain */ 17462306a36Sopenharmony_ci se401_set_feature(gspca_dev, HV7131_REG_ABCG, gain); 17562306a36Sopenharmony_ci} 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_cistatic void setexposure(struct gspca_dev *gspca_dev, s32 val, s32 freq) 17862306a36Sopenharmony_ci{ 17962306a36Sopenharmony_ci struct sd *sd = (struct sd *) gspca_dev; 18062306a36Sopenharmony_ci int integration = val << 6; 18162306a36Sopenharmony_ci u8 expose_h, expose_m, expose_l; 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_ci /* Do this before the set_feature calls, for proper timing wrt 18462306a36Sopenharmony_ci the interrupt driven pkt_scan. Note we may still race but that 18562306a36Sopenharmony_ci is not a big issue, the expo change state machine is merely for 18662306a36Sopenharmony_ci avoiding underexposed frames getting send out, if one sneaks 18762306a36Sopenharmony_ci through so be it */ 18862306a36Sopenharmony_ci sd->expo_change_state = EXPO_CHANGED; 18962306a36Sopenharmony_ci 19062306a36Sopenharmony_ci if (freq == V4L2_CID_POWER_LINE_FREQUENCY_50HZ) 19162306a36Sopenharmony_ci integration = integration - integration % 106667; 19262306a36Sopenharmony_ci if (freq == V4L2_CID_POWER_LINE_FREQUENCY_60HZ) 19362306a36Sopenharmony_ci integration = integration - integration % 88889; 19462306a36Sopenharmony_ci 19562306a36Sopenharmony_ci expose_h = (integration >> 16); 19662306a36Sopenharmony_ci expose_m = (integration >> 8); 19762306a36Sopenharmony_ci expose_l = integration; 19862306a36Sopenharmony_ci 19962306a36Sopenharmony_ci /* integration time low */ 20062306a36Sopenharmony_ci se401_set_feature(gspca_dev, HV7131_REG_TITL, expose_l); 20162306a36Sopenharmony_ci /* integration time mid */ 20262306a36Sopenharmony_ci se401_set_feature(gspca_dev, HV7131_REG_TITM, expose_m); 20362306a36Sopenharmony_ci /* integration time high */ 20462306a36Sopenharmony_ci se401_set_feature(gspca_dev, HV7131_REG_TITU, expose_h); 20562306a36Sopenharmony_ci} 20662306a36Sopenharmony_ci 20762306a36Sopenharmony_cistatic int sd_config(struct gspca_dev *gspca_dev, 20862306a36Sopenharmony_ci const struct usb_device_id *id) 20962306a36Sopenharmony_ci{ 21062306a36Sopenharmony_ci struct sd *sd = (struct sd *)gspca_dev; 21162306a36Sopenharmony_ci struct cam *cam = &gspca_dev->cam; 21262306a36Sopenharmony_ci u8 *cd = gspca_dev->usb_buf; 21362306a36Sopenharmony_ci int i, j, n; 21462306a36Sopenharmony_ci int widths[MAX_MODES], heights[MAX_MODES]; 21562306a36Sopenharmony_ci 21662306a36Sopenharmony_ci /* Read the camera descriptor */ 21762306a36Sopenharmony_ci se401_read_req(gspca_dev, SE401_REQ_GET_CAMERA_DESCRIPTOR, 1); 21862306a36Sopenharmony_ci if (gspca_dev->usb_err) { 21962306a36Sopenharmony_ci /* Sometimes after being idle for a while the se401 won't 22062306a36Sopenharmony_ci respond and needs a good kicking */ 22162306a36Sopenharmony_ci usb_reset_device(gspca_dev->dev); 22262306a36Sopenharmony_ci gspca_dev->usb_err = 0; 22362306a36Sopenharmony_ci se401_read_req(gspca_dev, SE401_REQ_GET_CAMERA_DESCRIPTOR, 0); 22462306a36Sopenharmony_ci } 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_ci /* Some cameras start with their LED on */ 22762306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 0, 0); 22862306a36Sopenharmony_ci if (gspca_dev->usb_err) 22962306a36Sopenharmony_ci return gspca_dev->usb_err; 23062306a36Sopenharmony_ci 23162306a36Sopenharmony_ci if (cd[1] != 0x41) { 23262306a36Sopenharmony_ci pr_err("Wrong descriptor type\n"); 23362306a36Sopenharmony_ci return -ENODEV; 23462306a36Sopenharmony_ci } 23562306a36Sopenharmony_ci 23662306a36Sopenharmony_ci if (!(cd[2] & SE401_FORMAT_BAYER)) { 23762306a36Sopenharmony_ci pr_err("Bayer format not supported!\n"); 23862306a36Sopenharmony_ci return -ENODEV; 23962306a36Sopenharmony_ci } 24062306a36Sopenharmony_ci 24162306a36Sopenharmony_ci if (cd[3]) 24262306a36Sopenharmony_ci pr_info("ExtraFeatures: %d\n", cd[3]); 24362306a36Sopenharmony_ci 24462306a36Sopenharmony_ci n = cd[4] | (cd[5] << 8); 24562306a36Sopenharmony_ci if (n > MAX_MODES) { 24662306a36Sopenharmony_ci pr_err("Too many frame sizes\n"); 24762306a36Sopenharmony_ci return -ENODEV; 24862306a36Sopenharmony_ci } 24962306a36Sopenharmony_ci 25062306a36Sopenharmony_ci for (i = 0; i < n ; i++) { 25162306a36Sopenharmony_ci widths[i] = cd[6 + i * 4 + 0] | (cd[6 + i * 4 + 1] << 8); 25262306a36Sopenharmony_ci heights[i] = cd[6 + i * 4 + 2] | (cd[6 + i * 4 + 3] << 8); 25362306a36Sopenharmony_ci } 25462306a36Sopenharmony_ci 25562306a36Sopenharmony_ci for (i = 0; i < n ; i++) { 25662306a36Sopenharmony_ci sd->fmts[i].width = widths[i]; 25762306a36Sopenharmony_ci sd->fmts[i].height = heights[i]; 25862306a36Sopenharmony_ci sd->fmts[i].field = V4L2_FIELD_NONE; 25962306a36Sopenharmony_ci sd->fmts[i].colorspace = V4L2_COLORSPACE_SRGB; 26062306a36Sopenharmony_ci sd->fmts[i].priv = 1; 26162306a36Sopenharmony_ci 26262306a36Sopenharmony_ci /* janggu compression only works for 1/4th or 1/16th res */ 26362306a36Sopenharmony_ci for (j = 0; j < n; j++) { 26462306a36Sopenharmony_ci if (widths[j] / 2 == widths[i] && 26562306a36Sopenharmony_ci heights[j] / 2 == heights[i]) { 26662306a36Sopenharmony_ci sd->fmts[i].priv = 2; 26762306a36Sopenharmony_ci break; 26862306a36Sopenharmony_ci } 26962306a36Sopenharmony_ci } 27062306a36Sopenharmony_ci /* 1/16th if available too is better then 1/4th, because 27162306a36Sopenharmony_ci we then use a larger area of the sensor */ 27262306a36Sopenharmony_ci for (j = 0; j < n; j++) { 27362306a36Sopenharmony_ci if (widths[j] / 4 == widths[i] && 27462306a36Sopenharmony_ci heights[j] / 4 == heights[i]) { 27562306a36Sopenharmony_ci sd->fmts[i].priv = 4; 27662306a36Sopenharmony_ci break; 27762306a36Sopenharmony_ci } 27862306a36Sopenharmony_ci } 27962306a36Sopenharmony_ci 28062306a36Sopenharmony_ci if (sd->fmts[i].priv == 1) { 28162306a36Sopenharmony_ci /* Not a 1/4th or 1/16th res, use bayer */ 28262306a36Sopenharmony_ci sd->fmts[i].pixelformat = V4L2_PIX_FMT_SBGGR8; 28362306a36Sopenharmony_ci sd->fmts[i].bytesperline = widths[i]; 28462306a36Sopenharmony_ci sd->fmts[i].sizeimage = widths[i] * heights[i]; 28562306a36Sopenharmony_ci pr_info("Frame size: %dx%d bayer\n", 28662306a36Sopenharmony_ci widths[i], heights[i]); 28762306a36Sopenharmony_ci } else { 28862306a36Sopenharmony_ci /* Found a match use janggu compression */ 28962306a36Sopenharmony_ci sd->fmts[i].pixelformat = V4L2_PIX_FMT_SE401; 29062306a36Sopenharmony_ci sd->fmts[i].bytesperline = 0; 29162306a36Sopenharmony_ci sd->fmts[i].sizeimage = widths[i] * heights[i] * 3; 29262306a36Sopenharmony_ci pr_info("Frame size: %dx%d 1/%dth janggu\n", 29362306a36Sopenharmony_ci widths[i], heights[i], 29462306a36Sopenharmony_ci sd->fmts[i].priv * sd->fmts[i].priv); 29562306a36Sopenharmony_ci } 29662306a36Sopenharmony_ci } 29762306a36Sopenharmony_ci 29862306a36Sopenharmony_ci cam->cam_mode = sd->fmts; 29962306a36Sopenharmony_ci cam->nmodes = n; 30062306a36Sopenharmony_ci cam->bulk = 1; 30162306a36Sopenharmony_ci cam->bulk_size = BULK_SIZE; 30262306a36Sopenharmony_ci cam->bulk_nurbs = 4; 30362306a36Sopenharmony_ci sd->resetlevel = 0x2d; /* Set initial resetlevel */ 30462306a36Sopenharmony_ci 30562306a36Sopenharmony_ci /* See if the camera supports brightness */ 30662306a36Sopenharmony_ci se401_read_req(gspca_dev, SE401_REQ_GET_BRT, 1); 30762306a36Sopenharmony_ci sd->has_brightness = !!gspca_dev->usb_err; 30862306a36Sopenharmony_ci gspca_dev->usb_err = 0; 30962306a36Sopenharmony_ci 31062306a36Sopenharmony_ci return 0; 31162306a36Sopenharmony_ci} 31262306a36Sopenharmony_ci 31362306a36Sopenharmony_ci/* this function is called at probe and resume time */ 31462306a36Sopenharmony_cistatic int sd_init(struct gspca_dev *gspca_dev) 31562306a36Sopenharmony_ci{ 31662306a36Sopenharmony_ci return 0; 31762306a36Sopenharmony_ci} 31862306a36Sopenharmony_ci 31962306a36Sopenharmony_ci/* function called at start time before URB creation */ 32062306a36Sopenharmony_cistatic int sd_isoc_init(struct gspca_dev *gspca_dev) 32162306a36Sopenharmony_ci{ 32262306a36Sopenharmony_ci gspca_dev->alt = 1; /* Ignore the bogus isoc alt settings */ 32362306a36Sopenharmony_ci 32462306a36Sopenharmony_ci return gspca_dev->usb_err; 32562306a36Sopenharmony_ci} 32662306a36Sopenharmony_ci 32762306a36Sopenharmony_ci/* -- start the camera -- */ 32862306a36Sopenharmony_cistatic int sd_start(struct gspca_dev *gspca_dev) 32962306a36Sopenharmony_ci{ 33062306a36Sopenharmony_ci struct sd *sd = (struct sd *)gspca_dev; 33162306a36Sopenharmony_ci int mult = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv; 33262306a36Sopenharmony_ci int mode = 0; 33362306a36Sopenharmony_ci 33462306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 1, 1); 33562306a36Sopenharmony_ci if (gspca_dev->usb_err) { 33662306a36Sopenharmony_ci /* Sometimes after being idle for a while the se401 won't 33762306a36Sopenharmony_ci respond and needs a good kicking */ 33862306a36Sopenharmony_ci usb_reset_device(gspca_dev->dev); 33962306a36Sopenharmony_ci gspca_dev->usb_err = 0; 34062306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 1, 0); 34162306a36Sopenharmony_ci } 34262306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 1, 0); 34362306a36Sopenharmony_ci 34462306a36Sopenharmony_ci se401_set_feature(gspca_dev, HV7131_REG_MODE_B, 0x05); 34562306a36Sopenharmony_ci 34662306a36Sopenharmony_ci /* set size + mode */ 34762306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_SET_WIDTH, 34862306a36Sopenharmony_ci gspca_dev->pixfmt.width * mult, 0); 34962306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_SET_HEIGHT, 35062306a36Sopenharmony_ci gspca_dev->pixfmt.height * mult, 0); 35162306a36Sopenharmony_ci /* 35262306a36Sopenharmony_ci * HDG: disabled this as it does not seem to do anything 35362306a36Sopenharmony_ci * se401_write_req(gspca_dev, SE401_REQ_SET_OUTPUT_MODE, 35462306a36Sopenharmony_ci * SE401_FORMAT_BAYER, 0); 35562306a36Sopenharmony_ci */ 35662306a36Sopenharmony_ci 35762306a36Sopenharmony_ci switch (mult) { 35862306a36Sopenharmony_ci case 1: /* Raw bayer */ 35962306a36Sopenharmony_ci mode = 0x03; break; 36062306a36Sopenharmony_ci case 2: /* 1/4th janggu */ 36162306a36Sopenharmony_ci mode = SE401_QUANT_FACT << 4; break; 36262306a36Sopenharmony_ci case 4: /* 1/16th janggu */ 36362306a36Sopenharmony_ci mode = (SE401_QUANT_FACT << 4) | 0x02; break; 36462306a36Sopenharmony_ci } 36562306a36Sopenharmony_ci se401_set_feature(gspca_dev, SE401_OPERATINGMODE, mode); 36662306a36Sopenharmony_ci 36762306a36Sopenharmony_ci se401_set_feature(gspca_dev, HV7131_REG_ARLV, sd->resetlevel); 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci sd->packet_read = 0; 37062306a36Sopenharmony_ci sd->pixels_read = 0; 37162306a36Sopenharmony_ci sd->restart_stream = 0; 37262306a36Sopenharmony_ci sd->resetlevel_frame_count = 0; 37362306a36Sopenharmony_ci sd->resetlevel_adjust_dir = 0; 37462306a36Sopenharmony_ci sd->expo_change_state = EXPO_NO_CHANGE; 37562306a36Sopenharmony_ci 37662306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_START_CONTINUOUS_CAPTURE, 0, 0); 37762306a36Sopenharmony_ci 37862306a36Sopenharmony_ci return gspca_dev->usb_err; 37962306a36Sopenharmony_ci} 38062306a36Sopenharmony_ci 38162306a36Sopenharmony_cistatic void sd_stopN(struct gspca_dev *gspca_dev) 38262306a36Sopenharmony_ci{ 38362306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_STOP_CONTINUOUS_CAPTURE, 0, 0); 38462306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 0, 0); 38562306a36Sopenharmony_ci se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 0, 0); 38662306a36Sopenharmony_ci} 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_cistatic void sd_dq_callback(struct gspca_dev *gspca_dev) 38962306a36Sopenharmony_ci{ 39062306a36Sopenharmony_ci struct sd *sd = (struct sd *)gspca_dev; 39162306a36Sopenharmony_ci unsigned int ahrc, alrc; 39262306a36Sopenharmony_ci int oldreset, adjust_dir; 39362306a36Sopenharmony_ci 39462306a36Sopenharmony_ci /* Restart the stream if requested do so by pkt_scan */ 39562306a36Sopenharmony_ci if (sd->restart_stream) { 39662306a36Sopenharmony_ci sd_stopN(gspca_dev); 39762306a36Sopenharmony_ci sd_start(gspca_dev); 39862306a36Sopenharmony_ci sd->restart_stream = 0; 39962306a36Sopenharmony_ci } 40062306a36Sopenharmony_ci 40162306a36Sopenharmony_ci /* Automatically adjust sensor reset level 40262306a36Sopenharmony_ci Hyundai have some really nice docs about this and other sensor 40362306a36Sopenharmony_ci related stuff on their homepage: www.hei.co.kr */ 40462306a36Sopenharmony_ci sd->resetlevel_frame_count++; 40562306a36Sopenharmony_ci if (sd->resetlevel_frame_count < 20) 40662306a36Sopenharmony_ci return; 40762306a36Sopenharmony_ci 40862306a36Sopenharmony_ci /* For some reason this normally read-only register doesn't get reset 40962306a36Sopenharmony_ci to zero after reading them just once... */ 41062306a36Sopenharmony_ci se401_get_feature(gspca_dev, HV7131_REG_HIREFNOH); 41162306a36Sopenharmony_ci se401_get_feature(gspca_dev, HV7131_REG_HIREFNOL); 41262306a36Sopenharmony_ci se401_get_feature(gspca_dev, HV7131_REG_LOREFNOH); 41362306a36Sopenharmony_ci se401_get_feature(gspca_dev, HV7131_REG_LOREFNOL); 41462306a36Sopenharmony_ci ahrc = 256*se401_get_feature(gspca_dev, HV7131_REG_HIREFNOH) + 41562306a36Sopenharmony_ci se401_get_feature(gspca_dev, HV7131_REG_HIREFNOL); 41662306a36Sopenharmony_ci alrc = 256*se401_get_feature(gspca_dev, HV7131_REG_LOREFNOH) + 41762306a36Sopenharmony_ci se401_get_feature(gspca_dev, HV7131_REG_LOREFNOL); 41862306a36Sopenharmony_ci 41962306a36Sopenharmony_ci /* Not an exact science, but it seems to work pretty well... */ 42062306a36Sopenharmony_ci oldreset = sd->resetlevel; 42162306a36Sopenharmony_ci if (alrc > 10) { 42262306a36Sopenharmony_ci while (alrc >= 10 && sd->resetlevel < 63) { 42362306a36Sopenharmony_ci sd->resetlevel++; 42462306a36Sopenharmony_ci alrc /= 2; 42562306a36Sopenharmony_ci } 42662306a36Sopenharmony_ci } else if (ahrc > 20) { 42762306a36Sopenharmony_ci while (ahrc >= 20 && sd->resetlevel > 0) { 42862306a36Sopenharmony_ci sd->resetlevel--; 42962306a36Sopenharmony_ci ahrc /= 2; 43062306a36Sopenharmony_ci } 43162306a36Sopenharmony_ci } 43262306a36Sopenharmony_ci /* Detect ping-pong-ing and halve adjustment to avoid overshoot */ 43362306a36Sopenharmony_ci if (sd->resetlevel > oldreset) 43462306a36Sopenharmony_ci adjust_dir = 1; 43562306a36Sopenharmony_ci else 43662306a36Sopenharmony_ci adjust_dir = -1; 43762306a36Sopenharmony_ci if (sd->resetlevel_adjust_dir && 43862306a36Sopenharmony_ci sd->resetlevel_adjust_dir != adjust_dir) 43962306a36Sopenharmony_ci sd->resetlevel = oldreset + (sd->resetlevel - oldreset) / 2; 44062306a36Sopenharmony_ci 44162306a36Sopenharmony_ci if (sd->resetlevel != oldreset) { 44262306a36Sopenharmony_ci sd->resetlevel_adjust_dir = adjust_dir; 44362306a36Sopenharmony_ci se401_set_feature(gspca_dev, HV7131_REG_ARLV, sd->resetlevel); 44462306a36Sopenharmony_ci } 44562306a36Sopenharmony_ci 44662306a36Sopenharmony_ci sd->resetlevel_frame_count = 0; 44762306a36Sopenharmony_ci} 44862306a36Sopenharmony_ci 44962306a36Sopenharmony_cistatic void sd_complete_frame(struct gspca_dev *gspca_dev, u8 *data, int len) 45062306a36Sopenharmony_ci{ 45162306a36Sopenharmony_ci struct sd *sd = (struct sd *)gspca_dev; 45262306a36Sopenharmony_ci 45362306a36Sopenharmony_ci switch (sd->expo_change_state) { 45462306a36Sopenharmony_ci case EXPO_CHANGED: 45562306a36Sopenharmony_ci /* The exposure was changed while this frame 45662306a36Sopenharmony_ci was being send, so this frame is ok */ 45762306a36Sopenharmony_ci sd->expo_change_state = EXPO_DROP_FRAME; 45862306a36Sopenharmony_ci break; 45962306a36Sopenharmony_ci case EXPO_DROP_FRAME: 46062306a36Sopenharmony_ci /* The exposure was changed while this frame 46162306a36Sopenharmony_ci was being captured, drop it! */ 46262306a36Sopenharmony_ci gspca_dev->last_packet_type = DISCARD_PACKET; 46362306a36Sopenharmony_ci sd->expo_change_state = EXPO_NO_CHANGE; 46462306a36Sopenharmony_ci break; 46562306a36Sopenharmony_ci case EXPO_NO_CHANGE: 46662306a36Sopenharmony_ci break; 46762306a36Sopenharmony_ci } 46862306a36Sopenharmony_ci gspca_frame_add(gspca_dev, LAST_PACKET, data, len); 46962306a36Sopenharmony_ci} 47062306a36Sopenharmony_ci 47162306a36Sopenharmony_cistatic void sd_pkt_scan_janggu(struct gspca_dev *gspca_dev, u8 *data, int len) 47262306a36Sopenharmony_ci{ 47362306a36Sopenharmony_ci struct sd *sd = (struct sd *)gspca_dev; 47462306a36Sopenharmony_ci int imagesize = gspca_dev->pixfmt.width * gspca_dev->pixfmt.height; 47562306a36Sopenharmony_ci int i, plen, bits, pixels, info, count; 47662306a36Sopenharmony_ci 47762306a36Sopenharmony_ci if (sd->restart_stream) 47862306a36Sopenharmony_ci return; 47962306a36Sopenharmony_ci 48062306a36Sopenharmony_ci /* Sometimes a 1024 bytes garbage bulk packet is send between frames */ 48162306a36Sopenharmony_ci if (gspca_dev->last_packet_type == LAST_PACKET && len == 1024) { 48262306a36Sopenharmony_ci gspca_dev->last_packet_type = DISCARD_PACKET; 48362306a36Sopenharmony_ci return; 48462306a36Sopenharmony_ci } 48562306a36Sopenharmony_ci 48662306a36Sopenharmony_ci i = 0; 48762306a36Sopenharmony_ci while (i < len) { 48862306a36Sopenharmony_ci /* Read header if not already be present from prev bulk pkt */ 48962306a36Sopenharmony_ci if (sd->packet_read < 4) { 49062306a36Sopenharmony_ci count = 4 - sd->packet_read; 49162306a36Sopenharmony_ci if (count > len - i) 49262306a36Sopenharmony_ci count = len - i; 49362306a36Sopenharmony_ci memcpy(&sd->packet[sd->packet_read], &data[i], count); 49462306a36Sopenharmony_ci sd->packet_read += count; 49562306a36Sopenharmony_ci i += count; 49662306a36Sopenharmony_ci if (sd->packet_read < 4) 49762306a36Sopenharmony_ci break; 49862306a36Sopenharmony_ci } 49962306a36Sopenharmony_ci bits = sd->packet[3] + (sd->packet[2] << 8); 50062306a36Sopenharmony_ci pixels = sd->packet[1] + ((sd->packet[0] & 0x3f) << 8); 50162306a36Sopenharmony_ci info = (sd->packet[0] & 0xc0) >> 6; 50262306a36Sopenharmony_ci plen = ((bits + 47) >> 4) << 1; 50362306a36Sopenharmony_ci /* Sanity checks */ 50462306a36Sopenharmony_ci if (plen > 1024) { 50562306a36Sopenharmony_ci pr_err("invalid packet len %d restarting stream\n", 50662306a36Sopenharmony_ci plen); 50762306a36Sopenharmony_ci goto error; 50862306a36Sopenharmony_ci } 50962306a36Sopenharmony_ci if (info == 3) { 51062306a36Sopenharmony_ci pr_err("unknown frame info value restarting stream\n"); 51162306a36Sopenharmony_ci goto error; 51262306a36Sopenharmony_ci } 51362306a36Sopenharmony_ci 51462306a36Sopenharmony_ci /* Read (remainder of) packet contents */ 51562306a36Sopenharmony_ci count = plen - sd->packet_read; 51662306a36Sopenharmony_ci if (count > len - i) 51762306a36Sopenharmony_ci count = len - i; 51862306a36Sopenharmony_ci memcpy(&sd->packet[sd->packet_read], &data[i], count); 51962306a36Sopenharmony_ci sd->packet_read += count; 52062306a36Sopenharmony_ci i += count; 52162306a36Sopenharmony_ci if (sd->packet_read < plen) 52262306a36Sopenharmony_ci break; 52362306a36Sopenharmony_ci 52462306a36Sopenharmony_ci sd->pixels_read += pixels; 52562306a36Sopenharmony_ci sd->packet_read = 0; 52662306a36Sopenharmony_ci 52762306a36Sopenharmony_ci switch (info) { 52862306a36Sopenharmony_ci case 0: /* Frame data */ 52962306a36Sopenharmony_ci gspca_frame_add(gspca_dev, INTER_PACKET, sd->packet, 53062306a36Sopenharmony_ci plen); 53162306a36Sopenharmony_ci break; 53262306a36Sopenharmony_ci case 1: /* EOF */ 53362306a36Sopenharmony_ci if (sd->pixels_read != imagesize) { 53462306a36Sopenharmony_ci pr_err("frame size %d expected %d\n", 53562306a36Sopenharmony_ci sd->pixels_read, imagesize); 53662306a36Sopenharmony_ci goto error; 53762306a36Sopenharmony_ci } 53862306a36Sopenharmony_ci sd_complete_frame(gspca_dev, sd->packet, plen); 53962306a36Sopenharmony_ci return; /* Discard the rest of the bulk packet !! */ 54062306a36Sopenharmony_ci case 2: /* SOF */ 54162306a36Sopenharmony_ci gspca_frame_add(gspca_dev, FIRST_PACKET, sd->packet, 54262306a36Sopenharmony_ci plen); 54362306a36Sopenharmony_ci sd->pixels_read = pixels; 54462306a36Sopenharmony_ci break; 54562306a36Sopenharmony_ci } 54662306a36Sopenharmony_ci } 54762306a36Sopenharmony_ci return; 54862306a36Sopenharmony_ci 54962306a36Sopenharmony_cierror: 55062306a36Sopenharmony_ci sd->restart_stream = 1; 55162306a36Sopenharmony_ci /* Give userspace a 0 bytes frame, so our dq callback gets 55262306a36Sopenharmony_ci called and it can restart the stream */ 55362306a36Sopenharmony_ci gspca_frame_add(gspca_dev, FIRST_PACKET, NULL, 0); 55462306a36Sopenharmony_ci gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0); 55562306a36Sopenharmony_ci} 55662306a36Sopenharmony_ci 55762306a36Sopenharmony_cistatic void sd_pkt_scan_bayer(struct gspca_dev *gspca_dev, u8 *data, int len) 55862306a36Sopenharmony_ci{ 55962306a36Sopenharmony_ci struct cam *cam = &gspca_dev->cam; 56062306a36Sopenharmony_ci int imagesize = cam->cam_mode[gspca_dev->curr_mode].sizeimage; 56162306a36Sopenharmony_ci 56262306a36Sopenharmony_ci if (gspca_dev->image_len == 0) { 56362306a36Sopenharmony_ci gspca_frame_add(gspca_dev, FIRST_PACKET, data, len); 56462306a36Sopenharmony_ci return; 56562306a36Sopenharmony_ci } 56662306a36Sopenharmony_ci 56762306a36Sopenharmony_ci if (gspca_dev->image_len + len >= imagesize) { 56862306a36Sopenharmony_ci sd_complete_frame(gspca_dev, data, len); 56962306a36Sopenharmony_ci return; 57062306a36Sopenharmony_ci } 57162306a36Sopenharmony_ci 57262306a36Sopenharmony_ci gspca_frame_add(gspca_dev, INTER_PACKET, data, len); 57362306a36Sopenharmony_ci} 57462306a36Sopenharmony_ci 57562306a36Sopenharmony_cistatic void sd_pkt_scan(struct gspca_dev *gspca_dev, u8 *data, int len) 57662306a36Sopenharmony_ci{ 57762306a36Sopenharmony_ci int mult = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv; 57862306a36Sopenharmony_ci 57962306a36Sopenharmony_ci if (len == 0) 58062306a36Sopenharmony_ci return; 58162306a36Sopenharmony_ci 58262306a36Sopenharmony_ci if (mult == 1) /* mult == 1 means raw bayer */ 58362306a36Sopenharmony_ci sd_pkt_scan_bayer(gspca_dev, data, len); 58462306a36Sopenharmony_ci else 58562306a36Sopenharmony_ci sd_pkt_scan_janggu(gspca_dev, data, len); 58662306a36Sopenharmony_ci} 58762306a36Sopenharmony_ci 58862306a36Sopenharmony_ci#if IS_ENABLED(CONFIG_INPUT) 58962306a36Sopenharmony_cistatic int sd_int_pkt_scan(struct gspca_dev *gspca_dev, u8 *data, int len) 59062306a36Sopenharmony_ci{ 59162306a36Sopenharmony_ci struct sd *sd = (struct sd *)gspca_dev; 59262306a36Sopenharmony_ci u8 state; 59362306a36Sopenharmony_ci 59462306a36Sopenharmony_ci if (len != 2) 59562306a36Sopenharmony_ci return -EINVAL; 59662306a36Sopenharmony_ci 59762306a36Sopenharmony_ci switch (data[0]) { 59862306a36Sopenharmony_ci case 0: 59962306a36Sopenharmony_ci case 1: 60062306a36Sopenharmony_ci state = data[0]; 60162306a36Sopenharmony_ci break; 60262306a36Sopenharmony_ci default: 60362306a36Sopenharmony_ci return -EINVAL; 60462306a36Sopenharmony_ci } 60562306a36Sopenharmony_ci if (sd->button_state != state) { 60662306a36Sopenharmony_ci input_report_key(gspca_dev->input_dev, KEY_CAMERA, state); 60762306a36Sopenharmony_ci input_sync(gspca_dev->input_dev); 60862306a36Sopenharmony_ci sd->button_state = state; 60962306a36Sopenharmony_ci } 61062306a36Sopenharmony_ci 61162306a36Sopenharmony_ci return 0; 61262306a36Sopenharmony_ci} 61362306a36Sopenharmony_ci#endif 61462306a36Sopenharmony_ci 61562306a36Sopenharmony_cistatic int sd_s_ctrl(struct v4l2_ctrl *ctrl) 61662306a36Sopenharmony_ci{ 61762306a36Sopenharmony_ci struct gspca_dev *gspca_dev = 61862306a36Sopenharmony_ci container_of(ctrl->handler, struct gspca_dev, ctrl_handler); 61962306a36Sopenharmony_ci struct sd *sd = (struct sd *)gspca_dev; 62062306a36Sopenharmony_ci 62162306a36Sopenharmony_ci gspca_dev->usb_err = 0; 62262306a36Sopenharmony_ci 62362306a36Sopenharmony_ci if (!gspca_dev->streaming) 62462306a36Sopenharmony_ci return 0; 62562306a36Sopenharmony_ci 62662306a36Sopenharmony_ci switch (ctrl->id) { 62762306a36Sopenharmony_ci case V4L2_CID_BRIGHTNESS: 62862306a36Sopenharmony_ci setbrightness(gspca_dev, ctrl->val); 62962306a36Sopenharmony_ci break; 63062306a36Sopenharmony_ci case V4L2_CID_GAIN: 63162306a36Sopenharmony_ci setgain(gspca_dev, ctrl->val); 63262306a36Sopenharmony_ci break; 63362306a36Sopenharmony_ci case V4L2_CID_EXPOSURE: 63462306a36Sopenharmony_ci setexposure(gspca_dev, ctrl->val, sd->freq->val); 63562306a36Sopenharmony_ci break; 63662306a36Sopenharmony_ci } 63762306a36Sopenharmony_ci return gspca_dev->usb_err; 63862306a36Sopenharmony_ci} 63962306a36Sopenharmony_ci 64062306a36Sopenharmony_cistatic const struct v4l2_ctrl_ops sd_ctrl_ops = { 64162306a36Sopenharmony_ci .s_ctrl = sd_s_ctrl, 64262306a36Sopenharmony_ci}; 64362306a36Sopenharmony_ci 64462306a36Sopenharmony_cistatic int sd_init_controls(struct gspca_dev *gspca_dev) 64562306a36Sopenharmony_ci{ 64662306a36Sopenharmony_ci struct sd *sd = (struct sd *)gspca_dev; 64762306a36Sopenharmony_ci struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler; 64862306a36Sopenharmony_ci 64962306a36Sopenharmony_ci gspca_dev->vdev.ctrl_handler = hdl; 65062306a36Sopenharmony_ci v4l2_ctrl_handler_init(hdl, 4); 65162306a36Sopenharmony_ci if (sd->has_brightness) 65262306a36Sopenharmony_ci v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 65362306a36Sopenharmony_ci V4L2_CID_BRIGHTNESS, 0, 255, 1, 15); 65462306a36Sopenharmony_ci /* max is really 63 but > 50 is not pretty */ 65562306a36Sopenharmony_ci v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 65662306a36Sopenharmony_ci V4L2_CID_GAIN, 0, 50, 1, 25); 65762306a36Sopenharmony_ci sd->exposure = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops, 65862306a36Sopenharmony_ci V4L2_CID_EXPOSURE, 0, 32767, 1, 15000); 65962306a36Sopenharmony_ci sd->freq = v4l2_ctrl_new_std_menu(hdl, &sd_ctrl_ops, 66062306a36Sopenharmony_ci V4L2_CID_POWER_LINE_FREQUENCY, 66162306a36Sopenharmony_ci V4L2_CID_POWER_LINE_FREQUENCY_60HZ, 0, 0); 66262306a36Sopenharmony_ci 66362306a36Sopenharmony_ci if (hdl->error) { 66462306a36Sopenharmony_ci pr_err("Could not initialize controls\n"); 66562306a36Sopenharmony_ci return hdl->error; 66662306a36Sopenharmony_ci } 66762306a36Sopenharmony_ci v4l2_ctrl_cluster(2, &sd->exposure); 66862306a36Sopenharmony_ci return 0; 66962306a36Sopenharmony_ci} 67062306a36Sopenharmony_ci 67162306a36Sopenharmony_ci/* sub-driver description */ 67262306a36Sopenharmony_cistatic const struct sd_desc sd_desc = { 67362306a36Sopenharmony_ci .name = MODULE_NAME, 67462306a36Sopenharmony_ci .config = sd_config, 67562306a36Sopenharmony_ci .init = sd_init, 67662306a36Sopenharmony_ci .init_controls = sd_init_controls, 67762306a36Sopenharmony_ci .isoc_init = sd_isoc_init, 67862306a36Sopenharmony_ci .start = sd_start, 67962306a36Sopenharmony_ci .stopN = sd_stopN, 68062306a36Sopenharmony_ci .dq_callback = sd_dq_callback, 68162306a36Sopenharmony_ci .pkt_scan = sd_pkt_scan, 68262306a36Sopenharmony_ci#if IS_ENABLED(CONFIG_INPUT) 68362306a36Sopenharmony_ci .int_pkt_scan = sd_int_pkt_scan, 68462306a36Sopenharmony_ci#endif 68562306a36Sopenharmony_ci}; 68662306a36Sopenharmony_ci 68762306a36Sopenharmony_ci/* -- module initialisation -- */ 68862306a36Sopenharmony_cistatic const struct usb_device_id device_table[] = { 68962306a36Sopenharmony_ci {USB_DEVICE(0x03e8, 0x0004)}, /* Endpoints/Aox SE401 */ 69062306a36Sopenharmony_ci {USB_DEVICE(0x0471, 0x030b)}, /* Philips PCVC665K */ 69162306a36Sopenharmony_ci {USB_DEVICE(0x047d, 0x5001)}, /* Kensington 67014 */ 69262306a36Sopenharmony_ci {USB_DEVICE(0x047d, 0x5002)}, /* Kensington 6701(5/7) */ 69362306a36Sopenharmony_ci {USB_DEVICE(0x047d, 0x5003)}, /* Kensington 67016 */ 69462306a36Sopenharmony_ci {} 69562306a36Sopenharmony_ci}; 69662306a36Sopenharmony_ciMODULE_DEVICE_TABLE(usb, device_table); 69762306a36Sopenharmony_ci 69862306a36Sopenharmony_ci/* -- device connect -- */ 69962306a36Sopenharmony_cistatic int sd_probe(struct usb_interface *intf, 70062306a36Sopenharmony_ci const struct usb_device_id *id) 70162306a36Sopenharmony_ci{ 70262306a36Sopenharmony_ci return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd), 70362306a36Sopenharmony_ci THIS_MODULE); 70462306a36Sopenharmony_ci} 70562306a36Sopenharmony_ci 70662306a36Sopenharmony_cistatic int sd_pre_reset(struct usb_interface *intf) 70762306a36Sopenharmony_ci{ 70862306a36Sopenharmony_ci return 0; 70962306a36Sopenharmony_ci} 71062306a36Sopenharmony_ci 71162306a36Sopenharmony_cistatic int sd_post_reset(struct usb_interface *intf) 71262306a36Sopenharmony_ci{ 71362306a36Sopenharmony_ci return 0; 71462306a36Sopenharmony_ci} 71562306a36Sopenharmony_ci 71662306a36Sopenharmony_cistatic struct usb_driver sd_driver = { 71762306a36Sopenharmony_ci .name = MODULE_NAME, 71862306a36Sopenharmony_ci .id_table = device_table, 71962306a36Sopenharmony_ci .probe = sd_probe, 72062306a36Sopenharmony_ci .disconnect = gspca_disconnect, 72162306a36Sopenharmony_ci#ifdef CONFIG_PM 72262306a36Sopenharmony_ci .suspend = gspca_suspend, 72362306a36Sopenharmony_ci .resume = gspca_resume, 72462306a36Sopenharmony_ci .reset_resume = gspca_resume, 72562306a36Sopenharmony_ci#endif 72662306a36Sopenharmony_ci .pre_reset = sd_pre_reset, 72762306a36Sopenharmony_ci .post_reset = sd_post_reset, 72862306a36Sopenharmony_ci}; 72962306a36Sopenharmony_ci 73062306a36Sopenharmony_cimodule_usb_driver(sd_driver); 731