em28xx-core.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724
  1. /*
  2. em28xx-core.c - driver for Empia EM2800/EM2820/2840 USB video capture devices
  3. Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it>
  4. Markus Rechberger <mrechberger@gmail.com>
  5. Mauro Carvalho Chehab <mchehab@brturbo.com.br>
  6. Sascha Sommer <saschasommer@freenet.de>
  7. This program is free software; you can redistribute it and/or modify
  8. it under the terms of the GNU General Public License as published by
  9. the Free Software Foundation; either version 2 of the License, or
  10. (at your option) any later version.
  11. This program is distributed in the hope that it will be useful,
  12. but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. GNU General Public License for more details.
  15. You should have received a copy of the GNU General Public License
  16. along with this program; if not, write to the Free Software
  17. Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18. */
  19. #include <linux/init.h>
  20. #include <linux/list.h>
  21. #include <linux/module.h>
  22. #include <linux/moduleparam.h>
  23. #include <linux/usb.h>
  24. #include <linux/vmalloc.h>
  25. #include "em28xx.h"
  26. /* #define ENABLE_DEBUG_ISOC_FRAMES */
  27. static unsigned int core_debug = 0;
  28. module_param(core_debug,int,0644);
  29. MODULE_PARM_DESC(core_debug,"enable debug messages [core]");
  30. #define em28xx_coredbg(fmt, arg...) do {\
  31. if (core_debug) \
  32. printk(KERN_INFO "%s %s :"fmt, \
  33. dev->name, __FUNCTION__ , ##arg); } while (0)
  34. static unsigned int reg_debug = 0;
  35. module_param(reg_debug,int,0644);
  36. MODULE_PARM_DESC(reg_debug,"enable debug messages [URB reg]");
  37. #define em28xx_regdbg(fmt, arg...) do {\
  38. if (reg_debug) \
  39. printk(KERN_INFO "%s %s :"fmt, \
  40. dev->name, __FUNCTION__ , ##arg); } while (0)
  41. static unsigned int isoc_debug = 0;
  42. module_param(isoc_debug,int,0644);
  43. MODULE_PARM_DESC(isoc_debug,"enable debug messages [isoc transfers]");
  44. #define em28xx_isocdbg(fmt, arg...) do {\
  45. if (isoc_debug) \
  46. printk(KERN_INFO "%s %s :"fmt, \
  47. dev->name, __FUNCTION__ , ##arg); } while (0)
  48. static int alt = EM28XX_PINOUT;
  49. module_param(alt, int, 0644);
  50. MODULE_PARM_DESC(alt, "alternate setting to use for video endpoint");
  51. /*
  52. * em28xx_request_buffers()
  53. * allocate a number of buffers
  54. */
  55. u32 em28xx_request_buffers(struct em28xx *dev, u32 count)
  56. {
  57. const size_t imagesize = PAGE_ALIGN(dev->frame_size); /*needs to be page aligned cause the buffers can be mapped individually! */
  58. void *buff = NULL;
  59. u32 i;
  60. em28xx_coredbg("requested %i buffers with size %zi", count, imagesize);
  61. if (count > EM28XX_NUM_FRAMES)
  62. count = EM28XX_NUM_FRAMES;
  63. dev->num_frames = count;
  64. while (dev->num_frames > 0) {
  65. if ((buff = vmalloc_32(dev->num_frames * imagesize))) {
  66. memset(buff, 0, dev->num_frames * imagesize);
  67. break;
  68. }
  69. dev->num_frames--;
  70. }
  71. for (i = 0; i < dev->num_frames; i++) {
  72. dev->frame[i].bufmem = buff + i * imagesize;
  73. dev->frame[i].buf.index = i;
  74. dev->frame[i].buf.m.offset = i * imagesize;
  75. dev->frame[i].buf.length = dev->frame_size;
  76. dev->frame[i].buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  77. dev->frame[i].buf.sequence = 0;
  78. dev->frame[i].buf.field = V4L2_FIELD_NONE;
  79. dev->frame[i].buf.memory = V4L2_MEMORY_MMAP;
  80. dev->frame[i].buf.flags = 0;
  81. }
  82. return dev->num_frames;
  83. }
  84. /*
  85. * em28xx_queue_unusedframes()
  86. * add all frames that are not currently in use to the inbuffer queue
  87. */
  88. void em28xx_queue_unusedframes(struct em28xx *dev)
  89. {
  90. unsigned long lock_flags;
  91. u32 i;
  92. for (i = 0; i < dev->num_frames; i++)
  93. if (dev->frame[i].state == F_UNUSED) {
  94. dev->frame[i].state = F_QUEUED;
  95. spin_lock_irqsave(&dev->queue_lock, lock_flags);
  96. list_add_tail(&dev->frame[i].frame, &dev->inqueue);
  97. spin_unlock_irqrestore(&dev->queue_lock, lock_flags);
  98. }
  99. }
  100. /*
  101. * em28xx_release_buffers()
  102. * free frame buffers
  103. */
  104. void em28xx_release_buffers(struct em28xx *dev)
  105. {
  106. if (dev->num_frames) {
  107. vfree(dev->frame[0].bufmem);
  108. dev->num_frames = 0;
  109. }
  110. }
  111. /*
  112. * em28xx_read_reg_req()
  113. * reads data from the usb device specifying bRequest
  114. */
  115. int em28xx_read_reg_req_len(struct em28xx *dev, u8 req, u16 reg,
  116. char *buf, int len)
  117. {
  118. int ret, byte;
  119. em28xx_regdbg("req=%02x, reg=%02x ", req, reg);
  120. ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0), req,
  121. USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  122. 0x0000, reg, buf, len, HZ);
  123. if (reg_debug){
  124. printk(ret < 0 ? " failed!\n" : "%02x values: ", ret);
  125. for (byte = 0; byte < len; byte++) {
  126. printk(" %02x", buf[byte]);
  127. }
  128. printk("\n");
  129. }
  130. return ret;
  131. }
  132. /*
  133. * em28xx_read_reg_req()
  134. * reads data from the usb device specifying bRequest
  135. */
  136. int em28xx_read_reg_req(struct em28xx *dev, u8 req, u16 reg)
  137. {
  138. u8 val;
  139. int ret;
  140. em28xx_regdbg("req=%02x, reg=%02x:", req, reg);
  141. ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0), req,
  142. USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  143. 0x0000, reg, &val, 1, HZ);
  144. if (reg_debug)
  145. printk(ret < 0 ? " failed!\n" : "%02x\n", val);
  146. if (ret < 0)
  147. return ret;
  148. return val;
  149. }
  150. int em28xx_read_reg(struct em28xx *dev, u16 reg)
  151. {
  152. return em28xx_read_reg_req(dev, USB_REQ_GET_STATUS, reg);
  153. }
  154. /*
  155. * em28xx_write_regs_req()
  156. * sends data to the usb device, specifying bRequest
  157. */
  158. int em28xx_write_regs_req(struct em28xx *dev, u8 req, u16 reg, char *buf,
  159. int len)
  160. {
  161. int ret;
  162. /*usb_control_msg seems to expect a kmalloced buffer */
  163. unsigned char *bufs = kmalloc(len, GFP_KERNEL);
  164. em28xx_regdbg("req=%02x reg=%02x:", req, reg);
  165. if (reg_debug) {
  166. int i;
  167. for (i = 0; i < len; ++i)
  168. printk (" %02x", (unsigned char)buf[i]);
  169. printk ("\n");
  170. }
  171. if (!bufs)
  172. return -ENOMEM;
  173. memcpy(bufs, buf, len);
  174. ret = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0), req,
  175. USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
  176. 0x0000, reg, bufs, len, HZ);
  177. mdelay(5); /* FIXME: magic number */
  178. kfree(bufs);
  179. return ret;
  180. }
  181. int em28xx_write_regs(struct em28xx *dev, u16 reg, char *buf, int len)
  182. {
  183. return em28xx_write_regs_req(dev, USB_REQ_GET_STATUS, reg, buf, len);
  184. }
  185. /*
  186. * em28xx_write_reg_bits()
  187. * sets only some bits (specified by bitmask) of a register, by first reading
  188. * the actual value
  189. */
  190. int em28xx_write_reg_bits(struct em28xx *dev, u16 reg, u8 val,
  191. u8 bitmask)
  192. {
  193. int oldval;
  194. u8 newval;
  195. if ((oldval = em28xx_read_reg(dev, reg)) < 0)
  196. return oldval;
  197. newval = (((u8) oldval) & ~bitmask) | (val & bitmask);
  198. return em28xx_write_regs(dev, reg, &newval, 1);
  199. }
  200. /*
  201. * em28xx_write_ac97()
  202. * write a 16 bit value to the specified AC97 address (LSB first!)
  203. */
  204. int em28xx_write_ac97(struct em28xx *dev, u8 reg, u8 * val)
  205. {
  206. int ret;
  207. u8 addr = reg & 0x7f;
  208. if ((ret = em28xx_write_regs(dev, AC97LSB_REG, val, 2)) < 0)
  209. return ret;
  210. if ((ret = em28xx_write_regs(dev, AC97ADDR_REG, &addr, 1)) < 0)
  211. return ret;
  212. if ((ret = em28xx_read_reg(dev, AC97BUSY_REG)) < 0)
  213. return ret;
  214. else if (((u8) ret) & 0x01) {
  215. em28xx_warn ("AC97 command still being executed: not handled properly!\n");
  216. }
  217. return 0;
  218. }
  219. int em28xx_audio_analog_set(struct em28xx *dev)
  220. {
  221. char s[2] = { 0x00, 0x00 };
  222. s[0] |= 0x1f - dev->volume;
  223. s[1] |= 0x1f - dev->volume;
  224. if (dev->mute)
  225. s[1] |= 0x80;
  226. return em28xx_write_ac97(dev, MASTER_AC97, s);
  227. }
  228. int em28xx_colorlevels_set_default(struct em28xx *dev)
  229. {
  230. em28xx_write_regs(dev, YGAIN_REG, "\x10", 1); /* contrast */
  231. em28xx_write_regs(dev, YOFFSET_REG, "\x00", 1); /* brightness */
  232. em28xx_write_regs(dev, UVGAIN_REG, "\x10", 1); /* saturation */
  233. em28xx_write_regs(dev, UOFFSET_REG, "\x00", 1);
  234. em28xx_write_regs(dev, VOFFSET_REG, "\x00", 1);
  235. em28xx_write_regs(dev, SHARPNESS_REG, "\x00", 1);
  236. em28xx_write_regs(dev, GAMMA_REG, "\x20", 1);
  237. em28xx_write_regs(dev, RGAIN_REG, "\x20", 1);
  238. em28xx_write_regs(dev, GGAIN_REG, "\x20", 1);
  239. em28xx_write_regs(dev, BGAIN_REG, "\x20", 1);
  240. em28xx_write_regs(dev, ROFFSET_REG, "\x00", 1);
  241. em28xx_write_regs(dev, GOFFSET_REG, "\x00", 1);
  242. return em28xx_write_regs(dev, BOFFSET_REG, "\x00", 1);
  243. }
  244. int em28xx_capture_start(struct em28xx *dev, int start)
  245. {
  246. int ret;
  247. /* FIXME: which is the best order? */
  248. /* video registers are sampled by VREF */
  249. if ((ret = em28xx_write_reg_bits(dev, USBSUSP_REG, start ? 0x10 : 0x00,
  250. 0x10)) < 0)
  251. return ret;
  252. /* enable video capture */
  253. return em28xx_write_regs(dev, VINENABLE_REG, start ? "\x67" : "\x27", 1);
  254. }
  255. int em28xx_outfmt_set_yuv422(struct em28xx *dev)
  256. {
  257. em28xx_write_regs(dev, OUTFMT_REG, "\x34", 1);
  258. em28xx_write_regs(dev, VINMODE_REG, "\x10", 1);
  259. return em28xx_write_regs(dev, VINCTRL_REG, "\x11", 1);
  260. }
  261. int em28xx_accumulator_set(struct em28xx *dev, u8 xmin, u8 xmax, u8 ymin,
  262. u8 ymax)
  263. {
  264. em28xx_coredbg("em28xx Scale: (%d,%d)-(%d,%d)\n", xmin, ymin, xmax, ymax);
  265. em28xx_write_regs(dev, XMIN_REG, &xmin, 1);
  266. em28xx_write_regs(dev, XMAX_REG, &xmax, 1);
  267. em28xx_write_regs(dev, YMIN_REG, &ymin, 1);
  268. return em28xx_write_regs(dev, YMAX_REG, &ymax, 1);
  269. }
  270. int em28xx_capture_area_set(struct em28xx *dev, u8 hstart, u8 vstart,
  271. u16 width, u16 height)
  272. {
  273. u8 cwidth = width;
  274. u8 cheight = height;
  275. u8 overflow = (height >> 7 & 0x02) | (width >> 8 & 0x01);
  276. em28xx_coredbg("em28xx Area Set: (%d,%d)\n", (width | (overflow & 2) << 7),
  277. (height | (overflow & 1) << 8));
  278. em28xx_write_regs(dev, HSTART_REG, &hstart, 1);
  279. em28xx_write_regs(dev, VSTART_REG, &vstart, 1);
  280. em28xx_write_regs(dev, CWIDTH_REG, &cwidth, 1);
  281. em28xx_write_regs(dev, CHEIGHT_REG, &cheight, 1);
  282. return em28xx_write_regs(dev, OFLOW_REG, &overflow, 1);
  283. }
  284. int em28xx_scaler_set(struct em28xx *dev, u16 h, u16 v)
  285. {
  286. u8 mode;
  287. /* the em2800 scaler only supports scaling down to 50% */
  288. if(dev->is_em2800)
  289. mode = (v ? 0x20 : 0x00) | (h ? 0x10 : 0x00);
  290. else {
  291. u8 buf[2];
  292. buf[0] = h;
  293. buf[1] = h >> 8;
  294. em28xx_write_regs(dev, HSCALELOW_REG, (char *)buf, 2);
  295. buf[0] = v;
  296. buf[1] = v >> 8;
  297. em28xx_write_regs(dev, VSCALELOW_REG, (char *)buf, 2);
  298. /* it seems that both H and V scalers must be active to work correctly */
  299. mode = (h || v)? 0x30: 0x00;
  300. }
  301. return em28xx_write_reg_bits(dev, COMPR_REG, mode, 0x30);
  302. }
  303. /* FIXME: this only function read values from dev */
  304. int em28xx_resolution_set(struct em28xx *dev)
  305. {
  306. int width, height;
  307. width = norm_maxw(dev);
  308. height = norm_maxh(dev) >> 1;
  309. em28xx_outfmt_set_yuv422(dev);
  310. em28xx_accumulator_set(dev, 1, (width - 4) >> 2, 1, (height - 4) >> 2);
  311. em28xx_capture_area_set(dev, 0, 0, width >> 2, height >> 2);
  312. return em28xx_scaler_set(dev, dev->hscale, dev->vscale);
  313. }
  314. /******************* isoc transfer handling ****************************/
  315. #ifdef ENABLE_DEBUG_ISOC_FRAMES
  316. static void em28xx_isoc_dump(struct urb *urb, struct pt_regs *regs)
  317. {
  318. int len = 0;
  319. int ntrans = 0;
  320. int i;
  321. printk(KERN_DEBUG "isocIrq: sf=%d np=%d ec=%x\n",
  322. urb->start_frame, urb->number_of_packets,
  323. urb->error_count);
  324. for (i = 0; i < urb->number_of_packets; i++) {
  325. unsigned char *buf =
  326. urb->transfer_buffer +
  327. urb->iso_frame_desc[i].offset;
  328. int alen = urb->iso_frame_desc[i].actual_length;
  329. if (alen > 0) {
  330. if (buf[0] == 0x88) {
  331. ntrans++;
  332. len += alen;
  333. } else if (buf[0] == 0x22) {
  334. printk(KERN_DEBUG
  335. "= l=%d nt=%d bpp=%d\n",
  336. len - 4 * ntrans, ntrans,
  337. ntrans == 0 ? 0 : len / ntrans);
  338. ntrans = 1;
  339. len = alen;
  340. } else
  341. printk(KERN_DEBUG "!\n");
  342. }
  343. printk(KERN_DEBUG " n=%d s=%d al=%d %x\n", i,
  344. urb->iso_frame_desc[i].status,
  345. urb->iso_frame_desc[i].actual_length,
  346. (unsigned int)
  347. *((unsigned char *)(urb->transfer_buffer +
  348. urb->iso_frame_desc[i].
  349. offset)));
  350. }
  351. }
  352. #endif
  353. static inline int em28xx_isoc_video(struct em28xx *dev,struct em28xx_frame_t **f,
  354. unsigned long *lock_flags, unsigned char buf)
  355. {
  356. if (!(buf & 0x01)) {
  357. if ((*f)->state == F_GRABBING) {
  358. /*previous frame is incomplete */
  359. if ((*f)->fieldbytesused < dev->field_size) {
  360. (*f)->state = F_ERROR;
  361. em28xx_isocdbg ("dropping incomplete bottom field (%i missing bytes)",
  362. dev->field_size-(*f)->fieldbytesused);
  363. } else {
  364. (*f)->state = F_DONE;
  365. (*f)->buf.bytesused = dev->frame_size;
  366. }
  367. }
  368. if ((*f)->state == F_DONE || (*f)->state == F_ERROR) {
  369. /* move current frame to outqueue and get next free buffer from inqueue */
  370. spin_lock_irqsave(&dev-> queue_lock, *lock_flags);
  371. list_move_tail(&(*f)->frame, &dev->outqueue);
  372. if (!list_empty(&dev->inqueue))
  373. (*f) = list_entry(dev-> inqueue.next,
  374. struct em28xx_frame_t,frame);
  375. else
  376. (*f) = NULL;
  377. spin_unlock_irqrestore(&dev->queue_lock,*lock_flags);
  378. }
  379. if (!(*f)) {
  380. em28xx_isocdbg ("new frame but no buffer is free");
  381. return -1;
  382. }
  383. do_gettimeofday(&(*f)->buf.timestamp);
  384. (*f)->buf.sequence = ++dev->frame_count;
  385. (*f)->buf.field = V4L2_FIELD_INTERLACED;
  386. (*f)->state = F_GRABBING;
  387. (*f)->buf.bytesused = 0;
  388. (*f)->top_field = 1;
  389. (*f)->fieldbytesused = 0;
  390. } else {
  391. /* acquiring bottom field */
  392. if ((*f)->state == F_GRABBING) {
  393. if (!(*f)->top_field) {
  394. (*f)->state = F_ERROR;
  395. em28xx_isocdbg ("unexpected begin of bottom field; discarding it");
  396. } else if ((*f)-> fieldbytesused < dev->field_size - 172) {
  397. (*f)->state = F_ERROR;
  398. em28xx_isocdbg ("dropping incomplete top field (%i missing bytes)",
  399. dev->field_size-(*f)->fieldbytesused);
  400. } else {
  401. (*f)->top_field = 0;
  402. (*f)->fieldbytesused = 0;
  403. }
  404. }
  405. }
  406. return (0);
  407. }
  408. static inline void em28xx_isoc_video_copy(struct em28xx *dev,
  409. struct em28xx_frame_t **f, unsigned char *buf, int len)
  410. {
  411. void *fieldstart, *startwrite, *startread;
  412. int linesdone, currlinedone, offset, lencopy,remain;
  413. if(dev->frame_size != (*f)->buf.length){
  414. em28xx_err("frame_size %i and buf.length %i are different!!!\n",dev->frame_size,(*f)->buf.length);
  415. return;
  416. }
  417. if ((*f)->fieldbytesused + len > dev->field_size)
  418. len =dev->field_size - (*f)->fieldbytesused;
  419. if (buf[0] != 0x88 && buf[0] != 0x22) {
  420. em28xx_isocdbg("frame is not complete\n");
  421. startread = buf;
  422. len+=4;
  423. } else
  424. startread = buf + 4;
  425. remain = len;
  426. if ((*f)->top_field)
  427. fieldstart = (*f)->bufmem;
  428. else
  429. fieldstart = (*f)->bufmem + dev->bytesperline;
  430. linesdone = (*f)->fieldbytesused / dev->bytesperline;
  431. currlinedone = (*f)->fieldbytesused % dev->bytesperline;
  432. offset = linesdone * dev->bytesperline * 2 + currlinedone;
  433. startwrite = fieldstart + offset;
  434. lencopy = dev->bytesperline - currlinedone;
  435. lencopy = lencopy > remain ? remain : lencopy;
  436. memcpy(startwrite, startread, lencopy);
  437. remain -= lencopy;
  438. while (remain > 0) {
  439. startwrite += lencopy + dev->bytesperline;
  440. startread += lencopy;
  441. if (dev->bytesperline > remain)
  442. lencopy = remain;
  443. else
  444. lencopy = dev->bytesperline;
  445. memcpy(startwrite, startread, lencopy);
  446. remain -= lencopy;
  447. }
  448. (*f)->fieldbytesused += len;
  449. }
  450. /*
  451. * em28xx_isoIrq()
  452. * handles the incoming isoc urbs and fills the frames from our inqueue
  453. */
  454. void em28xx_isocIrq(struct urb *urb, struct pt_regs *regs)
  455. {
  456. struct em28xx *dev = urb->context;
  457. int i, status;
  458. struct em28xx_frame_t **f;
  459. unsigned long lock_flags;
  460. if (!dev)
  461. return;
  462. #ifdef ENABLE_DEBUG_ISOC_FRAMES
  463. if (isoc_debug>1)
  464. em28xx_isoc_dump(urb, regs);
  465. #endif
  466. if (urb->status == -ENOENT)
  467. return;
  468. f = &dev->frame_current;
  469. if (dev->stream == STREAM_INTERRUPT) {
  470. dev->stream = STREAM_OFF;
  471. if ((*f))
  472. (*f)->state = F_QUEUED;
  473. em28xx_isocdbg("stream interrupted");
  474. wake_up_interruptible(&dev->wait_stream);
  475. }
  476. if ((dev->state & DEV_DISCONNECTED) || (dev->state & DEV_MISCONFIGURED))
  477. return;
  478. if (dev->stream == STREAM_ON && !list_empty(&dev->inqueue)) {
  479. if (!(*f))
  480. (*f) = list_entry(dev->inqueue.next,
  481. struct em28xx_frame_t, frame);
  482. for (i = 0; i < urb->number_of_packets; i++) {
  483. unsigned char *buf = urb->transfer_buffer +
  484. urb->iso_frame_desc[i].offset;
  485. int len = urb->iso_frame_desc[i].actual_length - 4;
  486. if (urb->iso_frame_desc[i].status) {
  487. em28xx_isocdbg("data error: [%d] len=%d, status=%d", i,
  488. urb->iso_frame_desc[i].actual_length,
  489. urb->iso_frame_desc[i].status);
  490. if (urb->iso_frame_desc[i].status != -EPROTO)
  491. continue;
  492. }
  493. if (urb->iso_frame_desc[i].actual_length <= 0) {
  494. em28xx_isocdbg("packet %d is empty",i);
  495. continue;
  496. }
  497. if (urb->iso_frame_desc[i].actual_length >
  498. dev->max_pkt_size) {
  499. em28xx_isocdbg("packet bigger than packet size");
  500. continue;
  501. }
  502. /*new frame */
  503. if (buf[0] == 0x22 && buf[1] == 0x5a) {
  504. em28xx_isocdbg("Video frame, length=%i!",len);
  505. if (em28xx_isoc_video(dev,f,&lock_flags,buf[2]))
  506. break;
  507. } else if (buf[0]==0x33 && buf[1]==0x95 && buf[2]==0x00) {
  508. em28xx_isocdbg("VBI HEADER!!!");
  509. }
  510. /* actual copying */
  511. if ((*f)->state == F_GRABBING) {
  512. em28xx_isoc_video_copy(dev,f,buf, len);
  513. }
  514. }
  515. }
  516. for (i = 0; i < urb->number_of_packets; i++) {
  517. urb->iso_frame_desc[i].status = 0;
  518. urb->iso_frame_desc[i].actual_length = 0;
  519. }
  520. urb->status = 0;
  521. if ((status = usb_submit_urb(urb, GFP_ATOMIC))) {
  522. em28xx_errdev("resubmit of urb failed (error=%i)\n", status);
  523. dev->state |= DEV_MISCONFIGURED;
  524. }
  525. wake_up_interruptible(&dev->wait_frame);
  526. return;
  527. }
  528. /*
  529. * em28xx_uninit_isoc()
  530. * deallocates the buffers and urbs allocated during em28xx_init_iosc()
  531. */
  532. void em28xx_uninit_isoc(struct em28xx *dev)
  533. {
  534. int i;
  535. for (i = 0; i < EM28XX_NUM_BUFS; i++) {
  536. if (dev->urb[i]) {
  537. usb_kill_urb(dev->urb[i]);
  538. if (dev->transfer_buffer[i]){
  539. usb_buffer_free(dev->udev,(EM28XX_NUM_PACKETS*dev->max_pkt_size),dev->transfer_buffer[i],dev->urb[i]->transfer_dma);
  540. }
  541. usb_free_urb(dev->urb[i]);
  542. }
  543. dev->urb[i] = NULL;
  544. dev->transfer_buffer[i] = NULL;
  545. }
  546. em28xx_capture_start(dev, 0);
  547. }
  548. /*
  549. * em28xx_init_isoc()
  550. * allocates transfer buffers and submits the urbs for isoc transfer
  551. */
  552. int em28xx_init_isoc(struct em28xx *dev)
  553. {
  554. /* change interface to 3 which allowes the biggest packet sizes */
  555. int i, errCode;
  556. const int sb_size = EM28XX_NUM_PACKETS * dev->max_pkt_size;
  557. /* reset streaming vars */
  558. dev->frame_current = NULL;
  559. dev->frame_count = 0;
  560. /* allocate urbs */
  561. for (i = 0; i < EM28XX_NUM_BUFS; i++) {
  562. struct urb *urb;
  563. int j, k;
  564. /* allocate transfer buffer */
  565. urb = usb_alloc_urb(EM28XX_NUM_PACKETS, GFP_KERNEL);
  566. if (!urb){
  567. em28xx_errdev("cannot alloc urb %i\n", i);
  568. em28xx_uninit_isoc(dev);
  569. return -ENOMEM;
  570. }
  571. dev->transfer_buffer[i] = usb_buffer_alloc(dev->udev, sb_size, GFP_KERNEL,&urb->transfer_dma);
  572. if (!dev->transfer_buffer[i]) {
  573. em28xx_errdev
  574. ("unable to allocate %i bytes for transfer buffer %i\n",
  575. sb_size, i);
  576. em28xx_uninit_isoc(dev);
  577. return -ENOMEM;
  578. }
  579. memset(dev->transfer_buffer[i], 0, sb_size);
  580. urb->dev = dev->udev;
  581. urb->context = dev;
  582. urb->pipe = usb_rcvisocpipe(dev->udev, 0x82);
  583. urb->transfer_flags = URB_ISO_ASAP;
  584. urb->interval = 1;
  585. urb->transfer_buffer = dev->transfer_buffer[i];
  586. urb->complete = em28xx_isocIrq;
  587. urb->number_of_packets = EM28XX_NUM_PACKETS;
  588. urb->transfer_buffer_length = sb_size;
  589. for (j = k = 0; j < EM28XX_NUM_PACKETS;
  590. j++, k += dev->max_pkt_size) {
  591. urb->iso_frame_desc[j].offset = k;
  592. urb->iso_frame_desc[j].length =
  593. dev->max_pkt_size;
  594. }
  595. dev->urb[i] = urb;
  596. }
  597. /* submit urbs */
  598. for (i = 0; i < EM28XX_NUM_BUFS; i++) {
  599. errCode = usb_submit_urb(dev->urb[i], GFP_KERNEL);
  600. if (errCode) {
  601. em28xx_errdev("submit of urb %i failed (error=%i)\n", i,
  602. errCode);
  603. em28xx_uninit_isoc(dev);
  604. return errCode;
  605. }
  606. }
  607. return 0;
  608. }
  609. int em28xx_set_alternate(struct em28xx *dev)
  610. {
  611. int errCode, prev_alt = dev->alt;
  612. dev->alt = alt;
  613. if (dev->alt == 0) {
  614. int i;
  615. for(i=0;i< dev->num_alt; i++)
  616. if(dev->alt_max_pkt_size[i]>dev->alt_max_pkt_size[dev->alt])
  617. dev->alt=i;
  618. }
  619. if (dev->alt != prev_alt) {
  620. dev->max_pkt_size = dev->alt_max_pkt_size[dev->alt];
  621. em28xx_coredbg("setting alternate %d with wMaxPacketSize=%u\n", dev->alt,
  622. dev->max_pkt_size);
  623. errCode = usb_set_interface(dev->udev, 0, dev->alt);
  624. if (errCode < 0) {
  625. em28xx_errdev ("cannot change alternate number to %d (error=%i)\n",
  626. dev->alt, errCode);
  627. return errCode;
  628. }
  629. }
  630. return 0;
  631. }