se401.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740
  1. /*
  2. * GSPCA Endpoints (formerly known as AOX) se401 USB Camera sub Driver
  3. *
  4. * Copyright (C) 2011 Hans de Goede <hdegoede@redhat.com>
  5. *
  6. * Based on the v4l1 se401 driver which is:
  7. *
  8. * Copyright (c) 2000 Jeroen B. Vreeken (pe1rxq@amsat.org)
  9. *
  10. * This program is free software; you can redistribute it and/or modify
  11. * it under the terms of the GNU General Public License as published by
  12. * the Free Software Foundation; either version 2 of the License, or
  13. * (at your option) any later version.
  14. *
  15. * This program is distributed in the hope that it will be useful,
  16. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  18. * GNU General Public License for more details.
  19. *
  20. */
  21. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  22. #define MODULE_NAME "se401"
  23. #define BULK_SIZE 4096
  24. #define PACKET_SIZE 1024
  25. #define READ_REQ_SIZE 64
  26. #define MAX_MODES ((READ_REQ_SIZE - 6) / 4)
  27. /* The se401 compression algorithm uses a fixed quant factor, which
  28. can be configured by setting the high nibble of the SE401_OPERATINGMODE
  29. feature. This needs to exactly match what is in libv4l! */
  30. #define SE401_QUANT_FACT 8
  31. #include <linux/input.h>
  32. #include <linux/slab.h>
  33. #include "gspca.h"
  34. #include "se401.h"
  35. MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
  36. MODULE_DESCRIPTION("Endpoints se401");
  37. MODULE_LICENSE("GPL");
  38. /* exposure change state machine states */
  39. enum {
  40. EXPO_CHANGED,
  41. EXPO_DROP_FRAME,
  42. EXPO_NO_CHANGE,
  43. };
  44. /* specific webcam descriptor */
  45. struct sd {
  46. struct gspca_dev gspca_dev; /* !! must be the first item */
  47. struct { /* exposure/freq control cluster */
  48. struct v4l2_ctrl *exposure;
  49. struct v4l2_ctrl *freq;
  50. };
  51. bool has_brightness;
  52. struct v4l2_pix_format fmts[MAX_MODES];
  53. int pixels_read;
  54. int packet_read;
  55. u8 packet[PACKET_SIZE];
  56. u8 restart_stream;
  57. u8 button_state;
  58. u8 resetlevel;
  59. u8 resetlevel_frame_count;
  60. int resetlevel_adjust_dir;
  61. int expo_change_state;
  62. };
  63. static void se401_write_req(struct gspca_dev *gspca_dev, u16 req, u16 value,
  64. int silent)
  65. {
  66. int err;
  67. if (gspca_dev->usb_err < 0)
  68. return;
  69. err = usb_control_msg(gspca_dev->dev,
  70. usb_sndctrlpipe(gspca_dev->dev, 0), req,
  71. USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  72. value, 0, NULL, 0, 1000);
  73. if (err < 0) {
  74. if (!silent)
  75. pr_err("write req failed req %#04x val %#04x error %d\n",
  76. req, value, err);
  77. gspca_dev->usb_err = err;
  78. }
  79. }
  80. static void se401_read_req(struct gspca_dev *gspca_dev, u16 req, int silent)
  81. {
  82. int err;
  83. if (gspca_dev->usb_err < 0)
  84. return;
  85. if (USB_BUF_SZ < READ_REQ_SIZE) {
  86. pr_err("USB_BUF_SZ too small!!\n");
  87. gspca_dev->usb_err = -ENOBUFS;
  88. return;
  89. }
  90. err = usb_control_msg(gspca_dev->dev,
  91. usb_rcvctrlpipe(gspca_dev->dev, 0), req,
  92. USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  93. 0, 0, gspca_dev->usb_buf, READ_REQ_SIZE, 1000);
  94. if (err < 0) {
  95. if (!silent)
  96. pr_err("read req failed req %#04x error %d\n",
  97. req, err);
  98. gspca_dev->usb_err = err;
  99. /*
  100. * Make sure the buffer is zeroed to avoid uninitialized
  101. * values.
  102. */
  103. memset(gspca_dev->usb_buf, 0, READ_REQ_SIZE);
  104. }
  105. }
  106. static void se401_set_feature(struct gspca_dev *gspca_dev,
  107. u16 selector, u16 param)
  108. {
  109. int err;
  110. if (gspca_dev->usb_err < 0)
  111. return;
  112. err = usb_control_msg(gspca_dev->dev,
  113. usb_sndctrlpipe(gspca_dev->dev, 0),
  114. SE401_REQ_SET_EXT_FEATURE,
  115. USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  116. param, selector, NULL, 0, 1000);
  117. if (err < 0) {
  118. pr_err("set feature failed sel %#04x param %#04x error %d\n",
  119. selector, param, err);
  120. gspca_dev->usb_err = err;
  121. }
  122. }
  123. static int se401_get_feature(struct gspca_dev *gspca_dev, u16 selector)
  124. {
  125. int err;
  126. if (gspca_dev->usb_err < 0)
  127. return gspca_dev->usb_err;
  128. if (USB_BUF_SZ < 2) {
  129. pr_err("USB_BUF_SZ too small!!\n");
  130. gspca_dev->usb_err = -ENOBUFS;
  131. return gspca_dev->usb_err;
  132. }
  133. err = usb_control_msg(gspca_dev->dev,
  134. usb_rcvctrlpipe(gspca_dev->dev, 0),
  135. SE401_REQ_GET_EXT_FEATURE,
  136. USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  137. 0, selector, gspca_dev->usb_buf, 2, 1000);
  138. if (err < 0) {
  139. pr_err("get feature failed sel %#04x error %d\n",
  140. selector, err);
  141. gspca_dev->usb_err = err;
  142. return err;
  143. }
  144. return gspca_dev->usb_buf[0] | (gspca_dev->usb_buf[1] << 8);
  145. }
  146. static void setbrightness(struct gspca_dev *gspca_dev, s32 val)
  147. {
  148. /* HDG: this does not seem to do anything on my cam */
  149. se401_write_req(gspca_dev, SE401_REQ_SET_BRT, val, 0);
  150. }
  151. static void setgain(struct gspca_dev *gspca_dev, s32 val)
  152. {
  153. u16 gain = 63 - val;
  154. /* red color gain */
  155. se401_set_feature(gspca_dev, HV7131_REG_ARCG, gain);
  156. /* green color gain */
  157. se401_set_feature(gspca_dev, HV7131_REG_AGCG, gain);
  158. /* blue color gain */
  159. se401_set_feature(gspca_dev, HV7131_REG_ABCG, gain);
  160. }
  161. static void setexposure(struct gspca_dev *gspca_dev, s32 val, s32 freq)
  162. {
  163. struct sd *sd = (struct sd *) gspca_dev;
  164. int integration = val << 6;
  165. u8 expose_h, expose_m, expose_l;
  166. /* Do this before the set_feature calls, for proper timing wrt
  167. the interrupt driven pkt_scan. Note we may still race but that
  168. is not a big issue, the expo change state machine is merely for
  169. avoiding underexposed frames getting send out, if one sneaks
  170. through so be it */
  171. sd->expo_change_state = EXPO_CHANGED;
  172. if (freq == V4L2_CID_POWER_LINE_FREQUENCY_50HZ)
  173. integration = integration - integration % 106667;
  174. if (freq == V4L2_CID_POWER_LINE_FREQUENCY_60HZ)
  175. integration = integration - integration % 88889;
  176. expose_h = (integration >> 16);
  177. expose_m = (integration >> 8);
  178. expose_l = integration;
  179. /* integration time low */
  180. se401_set_feature(gspca_dev, HV7131_REG_TITL, expose_l);
  181. /* integration time mid */
  182. se401_set_feature(gspca_dev, HV7131_REG_TITM, expose_m);
  183. /* integration time high */
  184. se401_set_feature(gspca_dev, HV7131_REG_TITU, expose_h);
  185. }
  186. static int sd_config(struct gspca_dev *gspca_dev,
  187. const struct usb_device_id *id)
  188. {
  189. struct sd *sd = (struct sd *)gspca_dev;
  190. struct cam *cam = &gspca_dev->cam;
  191. u8 *cd = gspca_dev->usb_buf;
  192. int i, j, n;
  193. int widths[MAX_MODES], heights[MAX_MODES];
  194. /* Read the camera descriptor */
  195. se401_read_req(gspca_dev, SE401_REQ_GET_CAMERA_DESCRIPTOR, 1);
  196. if (gspca_dev->usb_err) {
  197. /* Sometimes after being idle for a while the se401 won't
  198. respond and needs a good kicking */
  199. usb_reset_device(gspca_dev->dev);
  200. gspca_dev->usb_err = 0;
  201. se401_read_req(gspca_dev, SE401_REQ_GET_CAMERA_DESCRIPTOR, 0);
  202. }
  203. /* Some cameras start with their LED on */
  204. se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 0, 0);
  205. if (gspca_dev->usb_err)
  206. return gspca_dev->usb_err;
  207. if (cd[1] != 0x41) {
  208. pr_err("Wrong descriptor type\n");
  209. return -ENODEV;
  210. }
  211. if (!(cd[2] & SE401_FORMAT_BAYER)) {
  212. pr_err("Bayer format not supported!\n");
  213. return -ENODEV;
  214. }
  215. if (cd[3])
  216. pr_info("ExtraFeatures: %d\n", cd[3]);
  217. n = cd[4] | (cd[5] << 8);
  218. if (n > MAX_MODES) {
  219. pr_err("Too many frame sizes\n");
  220. return -ENODEV;
  221. }
  222. for (i = 0; i < n ; i++) {
  223. widths[i] = cd[6 + i * 4 + 0] | (cd[6 + i * 4 + 1] << 8);
  224. heights[i] = cd[6 + i * 4 + 2] | (cd[6 + i * 4 + 3] << 8);
  225. }
  226. for (i = 0; i < n ; i++) {
  227. sd->fmts[i].width = widths[i];
  228. sd->fmts[i].height = heights[i];
  229. sd->fmts[i].field = V4L2_FIELD_NONE;
  230. sd->fmts[i].colorspace = V4L2_COLORSPACE_SRGB;
  231. sd->fmts[i].priv = 1;
  232. /* janggu compression only works for 1/4th or 1/16th res */
  233. for (j = 0; j < n; j++) {
  234. if (widths[j] / 2 == widths[i] &&
  235. heights[j] / 2 == heights[i]) {
  236. sd->fmts[i].priv = 2;
  237. break;
  238. }
  239. }
  240. /* 1/16th if available too is better then 1/4th, because
  241. we then use a larger area of the sensor */
  242. for (j = 0; j < n; j++) {
  243. if (widths[j] / 4 == widths[i] &&
  244. heights[j] / 4 == heights[i]) {
  245. sd->fmts[i].priv = 4;
  246. break;
  247. }
  248. }
  249. if (sd->fmts[i].priv == 1) {
  250. /* Not a 1/4th or 1/16th res, use bayer */
  251. sd->fmts[i].pixelformat = V4L2_PIX_FMT_SBGGR8;
  252. sd->fmts[i].bytesperline = widths[i];
  253. sd->fmts[i].sizeimage = widths[i] * heights[i];
  254. pr_info("Frame size: %dx%d bayer\n",
  255. widths[i], heights[i]);
  256. } else {
  257. /* Found a match use janggu compression */
  258. sd->fmts[i].pixelformat = V4L2_PIX_FMT_SE401;
  259. sd->fmts[i].bytesperline = 0;
  260. sd->fmts[i].sizeimage = widths[i] * heights[i] * 3;
  261. pr_info("Frame size: %dx%d 1/%dth janggu\n",
  262. widths[i], heights[i],
  263. sd->fmts[i].priv * sd->fmts[i].priv);
  264. }
  265. }
  266. cam->cam_mode = sd->fmts;
  267. cam->nmodes = n;
  268. cam->bulk = 1;
  269. cam->bulk_size = BULK_SIZE;
  270. cam->bulk_nurbs = 4;
  271. sd->resetlevel = 0x2d; /* Set initial resetlevel */
  272. /* See if the camera supports brightness */
  273. se401_read_req(gspca_dev, SE401_REQ_GET_BRT, 1);
  274. sd->has_brightness = !!gspca_dev->usb_err;
  275. gspca_dev->usb_err = 0;
  276. return 0;
  277. }
  278. /* this function is called at probe and resume time */
  279. static int sd_init(struct gspca_dev *gspca_dev)
  280. {
  281. return 0;
  282. }
  283. /* function called at start time before URB creation */
  284. static int sd_isoc_init(struct gspca_dev *gspca_dev)
  285. {
  286. gspca_dev->alt = 1; /* Ignore the bogus isoc alt settings */
  287. return gspca_dev->usb_err;
  288. }
  289. /* -- start the camera -- */
  290. static int sd_start(struct gspca_dev *gspca_dev)
  291. {
  292. struct sd *sd = (struct sd *)gspca_dev;
  293. int mult = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv;
  294. int mode = 0;
  295. se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 1, 1);
  296. if (gspca_dev->usb_err) {
  297. /* Sometimes after being idle for a while the se401 won't
  298. respond and needs a good kicking */
  299. usb_reset_device(gspca_dev->dev);
  300. gspca_dev->usb_err = 0;
  301. se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 1, 0);
  302. }
  303. se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 1, 0);
  304. se401_set_feature(gspca_dev, HV7131_REG_MODE_B, 0x05);
  305. /* set size + mode */
  306. se401_write_req(gspca_dev, SE401_REQ_SET_WIDTH,
  307. gspca_dev->pixfmt.width * mult, 0);
  308. se401_write_req(gspca_dev, SE401_REQ_SET_HEIGHT,
  309. gspca_dev->pixfmt.height * mult, 0);
  310. /*
  311. * HDG: disabled this as it does not seem to do anything
  312. * se401_write_req(gspca_dev, SE401_REQ_SET_OUTPUT_MODE,
  313. * SE401_FORMAT_BAYER, 0);
  314. */
  315. switch (mult) {
  316. case 1: /* Raw bayer */
  317. mode = 0x03; break;
  318. case 2: /* 1/4th janggu */
  319. mode = SE401_QUANT_FACT << 4; break;
  320. case 4: /* 1/16th janggu */
  321. mode = (SE401_QUANT_FACT << 4) | 0x02; break;
  322. }
  323. se401_set_feature(gspca_dev, SE401_OPERATINGMODE, mode);
  324. se401_set_feature(gspca_dev, HV7131_REG_ARLV, sd->resetlevel);
  325. sd->packet_read = 0;
  326. sd->pixels_read = 0;
  327. sd->restart_stream = 0;
  328. sd->resetlevel_frame_count = 0;
  329. sd->resetlevel_adjust_dir = 0;
  330. sd->expo_change_state = EXPO_NO_CHANGE;
  331. se401_write_req(gspca_dev, SE401_REQ_START_CONTINUOUS_CAPTURE, 0, 0);
  332. return gspca_dev->usb_err;
  333. }
  334. static void sd_stopN(struct gspca_dev *gspca_dev)
  335. {
  336. se401_write_req(gspca_dev, SE401_REQ_STOP_CONTINUOUS_CAPTURE, 0, 0);
  337. se401_write_req(gspca_dev, SE401_REQ_LED_CONTROL, 0, 0);
  338. se401_write_req(gspca_dev, SE401_REQ_CAMERA_POWER, 0, 0);
  339. }
  340. static void sd_dq_callback(struct gspca_dev *gspca_dev)
  341. {
  342. struct sd *sd = (struct sd *)gspca_dev;
  343. unsigned int ahrc, alrc;
  344. int oldreset, adjust_dir;
  345. /* Restart the stream if requested do so by pkt_scan */
  346. if (sd->restart_stream) {
  347. sd_stopN(gspca_dev);
  348. sd_start(gspca_dev);
  349. sd->restart_stream = 0;
  350. }
  351. /* Automatically adjust sensor reset level
  352. Hyundai have some really nice docs about this and other sensor
  353. related stuff on their homepage: www.hei.co.kr */
  354. sd->resetlevel_frame_count++;
  355. if (sd->resetlevel_frame_count < 20)
  356. return;
  357. /* For some reason this normally read-only register doesn't get reset
  358. to zero after reading them just once... */
  359. se401_get_feature(gspca_dev, HV7131_REG_HIREFNOH);
  360. se401_get_feature(gspca_dev, HV7131_REG_HIREFNOL);
  361. se401_get_feature(gspca_dev, HV7131_REG_LOREFNOH);
  362. se401_get_feature(gspca_dev, HV7131_REG_LOREFNOL);
  363. ahrc = 256*se401_get_feature(gspca_dev, HV7131_REG_HIREFNOH) +
  364. se401_get_feature(gspca_dev, HV7131_REG_HIREFNOL);
  365. alrc = 256*se401_get_feature(gspca_dev, HV7131_REG_LOREFNOH) +
  366. se401_get_feature(gspca_dev, HV7131_REG_LOREFNOL);
  367. /* Not an exact science, but it seems to work pretty well... */
  368. oldreset = sd->resetlevel;
  369. if (alrc > 10) {
  370. while (alrc >= 10 && sd->resetlevel < 63) {
  371. sd->resetlevel++;
  372. alrc /= 2;
  373. }
  374. } else if (ahrc > 20) {
  375. while (ahrc >= 20 && sd->resetlevel > 0) {
  376. sd->resetlevel--;
  377. ahrc /= 2;
  378. }
  379. }
  380. /* Detect ping-pong-ing and halve adjustment to avoid overshoot */
  381. if (sd->resetlevel > oldreset)
  382. adjust_dir = 1;
  383. else
  384. adjust_dir = -1;
  385. if (sd->resetlevel_adjust_dir &&
  386. sd->resetlevel_adjust_dir != adjust_dir)
  387. sd->resetlevel = oldreset + (sd->resetlevel - oldreset) / 2;
  388. if (sd->resetlevel != oldreset) {
  389. sd->resetlevel_adjust_dir = adjust_dir;
  390. se401_set_feature(gspca_dev, HV7131_REG_ARLV, sd->resetlevel);
  391. }
  392. sd->resetlevel_frame_count = 0;
  393. }
  394. static void sd_complete_frame(struct gspca_dev *gspca_dev, u8 *data, int len)
  395. {
  396. struct sd *sd = (struct sd *)gspca_dev;
  397. switch (sd->expo_change_state) {
  398. case EXPO_CHANGED:
  399. /* The exposure was changed while this frame
  400. was being send, so this frame is ok */
  401. sd->expo_change_state = EXPO_DROP_FRAME;
  402. break;
  403. case EXPO_DROP_FRAME:
  404. /* The exposure was changed while this frame
  405. was being captured, drop it! */
  406. gspca_dev->last_packet_type = DISCARD_PACKET;
  407. sd->expo_change_state = EXPO_NO_CHANGE;
  408. break;
  409. case EXPO_NO_CHANGE:
  410. break;
  411. }
  412. gspca_frame_add(gspca_dev, LAST_PACKET, data, len);
  413. }
  414. static void sd_pkt_scan_janggu(struct gspca_dev *gspca_dev, u8 *data, int len)
  415. {
  416. struct sd *sd = (struct sd *)gspca_dev;
  417. int imagesize = gspca_dev->pixfmt.width * gspca_dev->pixfmt.height;
  418. int i, plen, bits, pixels, info, count;
  419. if (sd->restart_stream)
  420. return;
  421. /* Sometimes a 1024 bytes garbage bulk packet is send between frames */
  422. if (gspca_dev->last_packet_type == LAST_PACKET && len == 1024) {
  423. gspca_dev->last_packet_type = DISCARD_PACKET;
  424. return;
  425. }
  426. i = 0;
  427. while (i < len) {
  428. /* Read header if not already be present from prev bulk pkt */
  429. if (sd->packet_read < 4) {
  430. count = 4 - sd->packet_read;
  431. if (count > len - i)
  432. count = len - i;
  433. memcpy(&sd->packet[sd->packet_read], &data[i], count);
  434. sd->packet_read += count;
  435. i += count;
  436. if (sd->packet_read < 4)
  437. break;
  438. }
  439. bits = sd->packet[3] + (sd->packet[2] << 8);
  440. pixels = sd->packet[1] + ((sd->packet[0] & 0x3f) << 8);
  441. info = (sd->packet[0] & 0xc0) >> 6;
  442. plen = ((bits + 47) >> 4) << 1;
  443. /* Sanity checks */
  444. if (plen > 1024) {
  445. pr_err("invalid packet len %d restarting stream\n",
  446. plen);
  447. goto error;
  448. }
  449. if (info == 3) {
  450. pr_err("unknown frame info value restarting stream\n");
  451. goto error;
  452. }
  453. /* Read (remainder of) packet contents */
  454. count = plen - sd->packet_read;
  455. if (count > len - i)
  456. count = len - i;
  457. memcpy(&sd->packet[sd->packet_read], &data[i], count);
  458. sd->packet_read += count;
  459. i += count;
  460. if (sd->packet_read < plen)
  461. break;
  462. sd->pixels_read += pixels;
  463. sd->packet_read = 0;
  464. switch (info) {
  465. case 0: /* Frame data */
  466. gspca_frame_add(gspca_dev, INTER_PACKET, sd->packet,
  467. plen);
  468. break;
  469. case 1: /* EOF */
  470. if (sd->pixels_read != imagesize) {
  471. pr_err("frame size %d expected %d\n",
  472. sd->pixels_read, imagesize);
  473. goto error;
  474. }
  475. sd_complete_frame(gspca_dev, sd->packet, plen);
  476. return; /* Discard the rest of the bulk packet !! */
  477. case 2: /* SOF */
  478. gspca_frame_add(gspca_dev, FIRST_PACKET, sd->packet,
  479. plen);
  480. sd->pixels_read = pixels;
  481. break;
  482. }
  483. }
  484. return;
  485. error:
  486. sd->restart_stream = 1;
  487. /* Give userspace a 0 bytes frame, so our dq callback gets
  488. called and it can restart the stream */
  489. gspca_frame_add(gspca_dev, FIRST_PACKET, NULL, 0);
  490. gspca_frame_add(gspca_dev, LAST_PACKET, NULL, 0);
  491. }
  492. static void sd_pkt_scan_bayer(struct gspca_dev *gspca_dev, u8 *data, int len)
  493. {
  494. struct cam *cam = &gspca_dev->cam;
  495. int imagesize = cam->cam_mode[gspca_dev->curr_mode].sizeimage;
  496. if (gspca_dev->image_len == 0) {
  497. gspca_frame_add(gspca_dev, FIRST_PACKET, data, len);
  498. return;
  499. }
  500. if (gspca_dev->image_len + len >= imagesize) {
  501. sd_complete_frame(gspca_dev, data, len);
  502. return;
  503. }
  504. gspca_frame_add(gspca_dev, INTER_PACKET, data, len);
  505. }
  506. static void sd_pkt_scan(struct gspca_dev *gspca_dev, u8 *data, int len)
  507. {
  508. int mult = gspca_dev->cam.cam_mode[gspca_dev->curr_mode].priv;
  509. if (len == 0)
  510. return;
  511. if (mult == 1) /* mult == 1 means raw bayer */
  512. sd_pkt_scan_bayer(gspca_dev, data, len);
  513. else
  514. sd_pkt_scan_janggu(gspca_dev, data, len);
  515. }
  516. #if IS_ENABLED(CONFIG_INPUT)
  517. static int sd_int_pkt_scan(struct gspca_dev *gspca_dev, u8 *data, int len)
  518. {
  519. struct sd *sd = (struct sd *)gspca_dev;
  520. u8 state;
  521. if (len != 2)
  522. return -EINVAL;
  523. switch (data[0]) {
  524. case 0:
  525. case 1:
  526. state = data[0];
  527. break;
  528. default:
  529. return -EINVAL;
  530. }
  531. if (sd->button_state != state) {
  532. input_report_key(gspca_dev->input_dev, KEY_CAMERA, state);
  533. input_sync(gspca_dev->input_dev);
  534. sd->button_state = state;
  535. }
  536. return 0;
  537. }
  538. #endif
  539. static int sd_s_ctrl(struct v4l2_ctrl *ctrl)
  540. {
  541. struct gspca_dev *gspca_dev =
  542. container_of(ctrl->handler, struct gspca_dev, ctrl_handler);
  543. struct sd *sd = (struct sd *)gspca_dev;
  544. gspca_dev->usb_err = 0;
  545. if (!gspca_dev->streaming)
  546. return 0;
  547. switch (ctrl->id) {
  548. case V4L2_CID_BRIGHTNESS:
  549. setbrightness(gspca_dev, ctrl->val);
  550. break;
  551. case V4L2_CID_GAIN:
  552. setgain(gspca_dev, ctrl->val);
  553. break;
  554. case V4L2_CID_EXPOSURE:
  555. setexposure(gspca_dev, ctrl->val, sd->freq->val);
  556. break;
  557. }
  558. return gspca_dev->usb_err;
  559. }
  560. static const struct v4l2_ctrl_ops sd_ctrl_ops = {
  561. .s_ctrl = sd_s_ctrl,
  562. };
  563. static int sd_init_controls(struct gspca_dev *gspca_dev)
  564. {
  565. struct sd *sd = (struct sd *)gspca_dev;
  566. struct v4l2_ctrl_handler *hdl = &gspca_dev->ctrl_handler;
  567. gspca_dev->vdev.ctrl_handler = hdl;
  568. v4l2_ctrl_handler_init(hdl, 4);
  569. if (sd->has_brightness)
  570. v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
  571. V4L2_CID_BRIGHTNESS, 0, 255, 1, 15);
  572. /* max is really 63 but > 50 is not pretty */
  573. v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
  574. V4L2_CID_GAIN, 0, 50, 1, 25);
  575. sd->exposure = v4l2_ctrl_new_std(hdl, &sd_ctrl_ops,
  576. V4L2_CID_EXPOSURE, 0, 32767, 1, 15000);
  577. sd->freq = v4l2_ctrl_new_std_menu(hdl, &sd_ctrl_ops,
  578. V4L2_CID_POWER_LINE_FREQUENCY,
  579. V4L2_CID_POWER_LINE_FREQUENCY_60HZ, 0, 0);
  580. if (hdl->error) {
  581. pr_err("Could not initialize controls\n");
  582. return hdl->error;
  583. }
  584. v4l2_ctrl_cluster(2, &sd->exposure);
  585. return 0;
  586. }
  587. /* sub-driver description */
  588. static const struct sd_desc sd_desc = {
  589. .name = MODULE_NAME,
  590. .config = sd_config,
  591. .init = sd_init,
  592. .init_controls = sd_init_controls,
  593. .isoc_init = sd_isoc_init,
  594. .start = sd_start,
  595. .stopN = sd_stopN,
  596. .dq_callback = sd_dq_callback,
  597. .pkt_scan = sd_pkt_scan,
  598. #if IS_ENABLED(CONFIG_INPUT)
  599. .int_pkt_scan = sd_int_pkt_scan,
  600. #endif
  601. };
  602. /* -- module initialisation -- */
  603. static const struct usb_device_id device_table[] = {
  604. {USB_DEVICE(0x03e8, 0x0004)}, /* Endpoints/Aox SE401 */
  605. {USB_DEVICE(0x0471, 0x030b)}, /* Philips PCVC665K */
  606. {USB_DEVICE(0x047d, 0x5001)}, /* Kensington 67014 */
  607. {USB_DEVICE(0x047d, 0x5002)}, /* Kensington 6701(5/7) */
  608. {USB_DEVICE(0x047d, 0x5003)}, /* Kensington 67016 */
  609. {}
  610. };
  611. MODULE_DEVICE_TABLE(usb, device_table);
  612. /* -- device connect -- */
  613. static int sd_probe(struct usb_interface *intf,
  614. const struct usb_device_id *id)
  615. {
  616. return gspca_dev_probe(intf, id, &sd_desc, sizeof(struct sd),
  617. THIS_MODULE);
  618. }
  619. static int sd_pre_reset(struct usb_interface *intf)
  620. {
  621. return 0;
  622. }
  623. static int sd_post_reset(struct usb_interface *intf)
  624. {
  625. return 0;
  626. }
  627. static struct usb_driver sd_driver = {
  628. .name = MODULE_NAME,
  629. .id_table = device_table,
  630. .probe = sd_probe,
  631. .disconnect = gspca_disconnect,
  632. #ifdef CONFIG_PM
  633. .suspend = gspca_suspend,
  634. .resume = gspca_resume,
  635. .reset_resume = gspca_resume,
  636. #endif
  637. .pre_reset = sd_pre_reset,
  638. .post_reset = sd_post_reset,
  639. };
  640. module_usb_driver(sd_driver);