1 /******************************************************************************
2 * *
3 * easycap_main.c *
4 * *
5 * Video driver for EasyCAP USB2.0 Video Capture Device DC60 *
6 * *
7 * *
8 ******************************************************************************/
9 /*
10 *
11 * Copyright (C) 2010 R.M. Thomas <rmthomas@sciolus.org>
12 *
13 *
14 * This is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License as published by
16 * the Free Software Foundation; either version 2 of the License, or
17 * (at your option) any later version.
18 *
19 * The software is distributed in the hope that it will be useful,
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 * GNU General Public License for more details.
23 *
24 * You should have received a copy of the GNU General Public License
25 * along with this software; if not, write to the Free Software
26 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
27 *
28 */
29 /*****************************************************************************/
30
31 #include "easycap.h"
32 #include <linux/usb/audio.h>
33
34
35 MODULE_LICENSE("GPL");
36 MODULE_AUTHOR("R.M. Thomas <rmthomas@sciolus.org>");
37 MODULE_DESCRIPTION(EASYCAP_DRIVER_DESCRIPTION);
38 MODULE_VERSION(EASYCAP_DRIVER_VERSION);
39
40 #ifdef CONFIG_EASYCAP_DEBUG
41 int easycap_debug;
42 module_param_named(debug, easycap_debug, int, S_IRUGO | S_IWUSR);
43 MODULE_PARM_DESC(debug, "Debug level: 0(default),1,2,...,9");
44 #endif /* CONFIG_EASYCAP_DEBUG */
45
46 bool easycap_readback;
47 module_param_named(readback, easycap_readback, bool, S_IRUGO | S_IWUSR);
48 MODULE_PARM_DESC(readback, "read back written registers: (default false)");
49
50 static int easycap_bars = 1;
51 module_param_named(bars, easycap_bars, int, S_IRUGO | S_IWUSR);
52 MODULE_PARM_DESC(bars,
53 "Testcard bars on input signal failure: 0=>no, 1=>yes(default)");
54
55 static int easycap_gain = 16;
56 module_param_named(gain, easycap_gain, int, S_IRUGO | S_IWUSR);
57 MODULE_PARM_DESC(gain, "Audio gain: 0,...,16(default),...31");
58
59 static bool easycap_ntsc;
60 module_param_named(ntsc, easycap_ntsc, bool, S_IRUGO | S_IWUSR);
61 MODULE_PARM_DESC(ntsc, "NTSC default encoding (default PAL)");
62
63
64
65 struct easycap_dongle easycapdc60_dongle[DONGLE_MANY];
66 static struct mutex mutex_dongle;
67 static void easycap_complete(struct urb *purb);
68 static int reset(struct easycap *peasycap);
69 static int field2frame(struct easycap *peasycap);
70 static int redaub(struct easycap *peasycap,
71 void *pad, void *pex, int much, int more,
72 u8 mask, u8 margin, bool isuy);
73
strerror(int err)74 const char *strerror(int err)
75 {
76 #define ERRNOSTR(_e) case _e: return # _e
77 switch (err) {
78 case 0: return "OK";
79 ERRNOSTR(ENOMEM);
80 ERRNOSTR(ENODEV);
81 ERRNOSTR(ENXIO);
82 ERRNOSTR(EINVAL);
83 ERRNOSTR(EAGAIN);
84 ERRNOSTR(EFBIG);
85 ERRNOSTR(EPIPE);
86 ERRNOSTR(EMSGSIZE);
87 ERRNOSTR(ENOSPC);
88 ERRNOSTR(EINPROGRESS);
89 ERRNOSTR(ENOSR);
90 ERRNOSTR(EOVERFLOW);
91 ERRNOSTR(EPROTO);
92 ERRNOSTR(EILSEQ);
93 ERRNOSTR(ETIMEDOUT);
94 ERRNOSTR(EOPNOTSUPP);
95 ERRNOSTR(EPFNOSUPPORT);
96 ERRNOSTR(EAFNOSUPPORT);
97 ERRNOSTR(EADDRINUSE);
98 ERRNOSTR(EADDRNOTAVAIL);
99 ERRNOSTR(ENOBUFS);
100 ERRNOSTR(EISCONN);
101 ERRNOSTR(ENOTCONN);
102 ERRNOSTR(ESHUTDOWN);
103 ERRNOSTR(ENOENT);
104 ERRNOSTR(ECONNRESET);
105 ERRNOSTR(ETIME);
106 ERRNOSTR(ECOMM);
107 ERRNOSTR(EREMOTEIO);
108 ERRNOSTR(EXDEV);
109 ERRNOSTR(EPERM);
110 default: return "unknown";
111 }
112
113 #undef ERRNOSTR
114 }
115
116 /****************************************************************************/
117 /*---------------------------------------------------------------------------*/
118 /*
119 * THIS ROUTINE DOES NOT DETECT DUPLICATE OCCURRENCES OF POINTER peasycap
120 */
121 /*---------------------------------------------------------------------------*/
easycap_isdongle(struct easycap * peasycap)122 int easycap_isdongle(struct easycap *peasycap)
123 {
124 int k;
125 if (!peasycap)
126 return -2;
127 for (k = 0; k < DONGLE_MANY; k++) {
128 if (easycapdc60_dongle[k].peasycap == peasycap) {
129 peasycap->isdongle = k;
130 return k;
131 }
132 }
133 return -1;
134 }
135 /*^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^*/
easycap_open(struct inode * inode,struct file * file)136 static int easycap_open(struct inode *inode, struct file *file)
137 {
138 struct video_device *pvideo_device;
139 struct easycap *peasycap;
140 int rc;
141
142 JOT(4, "\n");
143 SAY("==========OPEN=========\n");
144
145 pvideo_device = video_devdata(file);
146 if (!pvideo_device) {
147 SAY("ERROR: pvideo_device is NULL.\n");
148 return -EFAULT;
149 }
150 peasycap = (struct easycap *)video_get_drvdata(pvideo_device);
151 if (!peasycap) {
152 SAY("ERROR: peasycap is NULL\n");
153 return -EFAULT;
154 }
155 if (!peasycap->pusb_device) {
156 SAM("ERROR: peasycap->pusb_device is NULL\n");
157 return -EFAULT;
158 }
159
160 JOM(16, "peasycap->pusb_device=%p\n", peasycap->pusb_device);
161
162 file->private_data = peasycap;
163 rc = easycap_wakeup_device(peasycap->pusb_device);
164 if (rc) {
165 SAM("ERROR: wakeup_device() rc = %i\n", rc);
166 if (-ENODEV == rc)
167 SAM("ERROR: wakeup_device() returned -ENODEV\n");
168 else
169 SAM("ERROR: wakeup_device() rc = %i\n", rc);
170 return rc;
171 }
172 JOM(8, "wakeup_device() OK\n");
173 peasycap->input = 0;
174 rc = reset(peasycap);
175 if (rc) {
176 SAM("ERROR: reset() rc = %i\n", rc);
177 return -EFAULT;
178 }
179 return 0;
180 }
181
182 /*****************************************************************************/
183 /*---------------------------------------------------------------------------*/
184 /*
185 * RESET THE HARDWARE TO ITS REFERENCE STATE.
186 *
187 * THIS ROUTINE MAY BE CALLED REPEATEDLY IF easycap_complete() DETECTS
188 * A BAD VIDEO FRAME SIZE.
189 */
190 /*---------------------------------------------------------------------------*/
reset(struct easycap * peasycap)191 static int reset(struct easycap *peasycap)
192 {
193 struct easycap_standard const *peasycap_standard;
194 int fmtidx, input, rate;
195 bool ntsc, other;
196 int rc;
197
198 if (!peasycap) {
199 SAY("ERROR: peasycap is NULL\n");
200 return -EFAULT;
201 }
202 input = peasycap->input;
203
204 /*---------------------------------------------------------------------------*/
205 /*
206 * IF THE SAA7113H HAS ALREADY ACQUIRED SYNC, USE ITS HARDWARE-DETECTED
207 * FIELD FREQUENCY TO DISTINGUISH NTSC FROM PAL. THIS IS ESSENTIAL FOR
208 * gstreamer AND OTHER USERSPACE PROGRAMS WHICH MAY NOT ATTEMPT TO INITIATE
209 * A SWITCH BETWEEN PAL AND NTSC.
210 *
211 * FUNCTION ready_saa() MAY REQUIRE A SUBSTANTIAL FRACTION OF A SECOND TO
212 * COMPLETE, SO SHOULD NOT BE INVOKED WITHOUT GOOD REASON.
213 */
214 /*---------------------------------------------------------------------------*/
215 other = false;
216 JOM(8, "peasycap->ntsc=%d\n", peasycap->ntsc);
217
218 rate = ready_saa(peasycap->pusb_device);
219 if (rate < 0) {
220 JOM(8, "not ready to capture after %i ms ...\n", PATIENCE);
221 ntsc = !peasycap->ntsc;
222 JOM(8, "... trying %s ..\n", ntsc ? "NTSC" : "PAL");
223 rc = setup_stk(peasycap->pusb_device, ntsc);
224 if (rc) {
225 SAM("ERROR: setup_stk() rc = %i\n", rc);
226 return -EFAULT;
227 }
228 rc = setup_saa(peasycap->pusb_device, ntsc);
229 if (rc) {
230 SAM("ERROR: setup_saa() rc = %i\n", rc);
231 return -EFAULT;
232 }
233
234 rate = ready_saa(peasycap->pusb_device);
235 if (rate < 0) {
236 JOM(8, "not ready to capture after %i ms\n", PATIENCE);
237 JOM(8, "... saa register 0x1F has 0x%02X\n",
238 read_saa(peasycap->pusb_device, 0x1F));
239 ntsc = peasycap->ntsc;
240 } else {
241 JOM(8, "... success at second try: %i=rate\n", rate);
242 ntsc = (0 < (rate/2)) ? true : false ;
243 other = true;
244 }
245 } else {
246 JOM(8, "... success at first try: %i=rate\n", rate);
247 ntsc = (0 < rate/2) ? true : false ;
248 }
249 JOM(8, "ntsc=%d\n", ntsc);
250 /*---------------------------------------------------------------------------*/
251
252 rc = setup_stk(peasycap->pusb_device, ntsc);
253 if (rc) {
254 SAM("ERROR: setup_stk() rc = %i\n", rc);
255 return -EFAULT;
256 }
257 rc = setup_saa(peasycap->pusb_device, ntsc);
258 if (rc) {
259 SAM("ERROR: setup_saa() rc = %i\n", rc);
260 return -EFAULT;
261 }
262
263 memset(peasycap->merit, 0, sizeof(peasycap->merit));
264
265 peasycap->video_eof = 0;
266 peasycap->audio_eof = 0;
267 /*---------------------------------------------------------------------------*/
268 /*
269 * RESTORE INPUT AND FORCE REFRESH OF STANDARD, FORMAT, ETC.
270 *
271 * WHILE THIS PROCEDURE IS IN PROGRESS, SOME IOCTL COMMANDS WILL RETURN -EBUSY.
272 */
273 /*---------------------------------------------------------------------------*/
274 peasycap->input = -8192;
275 peasycap->standard_offset = -8192;
276 fmtidx = ntsc ? NTSC_M : PAL_BGHIN;
277 if (other) {
278 peasycap_standard = &easycap_standard[0];
279 while (0xFFFF != peasycap_standard->mask) {
280 if (fmtidx == peasycap_standard->v4l2_standard.index) {
281 peasycap->inputset[input].standard_offset =
282 peasycap_standard - easycap_standard;
283 break;
284 }
285 peasycap_standard++;
286 }
287 if (0xFFFF == peasycap_standard->mask) {
288 SAM("ERROR: standard not found\n");
289 return -EINVAL;
290 }
291 JOM(8, "%i=peasycap->inputset[%i].standard_offset\n",
292 peasycap->inputset[input].standard_offset, input);
293 }
294 peasycap->format_offset = -8192;
295 peasycap->brightness = -8192;
296 peasycap->contrast = -8192;
297 peasycap->saturation = -8192;
298 peasycap->hue = -8192;
299
300 rc = easycap_newinput(peasycap, input);
301
302 if (rc) {
303 SAM("ERROR: newinput(.,%i) rc = %i\n", rc, input);
304 return -EFAULT;
305 }
306 JOM(4, "restored input, standard and format\n");
307
308 JOM(8, "true=peasycap->ntsc %d\n", peasycap->ntsc);
309
310 if (0 > peasycap->input) {
311 SAM("MISTAKE: %i=peasycap->input\n", peasycap->input);
312 return -ENOENT;
313 }
314 if (0 > peasycap->standard_offset) {
315 SAM("MISTAKE: %i=peasycap->standard_offset\n",
316 peasycap->standard_offset);
317 return -ENOENT;
318 }
319 if (0 > peasycap->format_offset) {
320 SAM("MISTAKE: %i=peasycap->format_offset\n",
321 peasycap->format_offset);
322 return -ENOENT;
323 }
324 if (0 > peasycap->brightness) {
325 SAM("MISTAKE: %i=peasycap->brightness\n",
326 peasycap->brightness);
327 return -ENOENT;
328 }
329 if (0 > peasycap->contrast) {
330 SAM("MISTAKE: %i=peasycap->contrast\n", peasycap->contrast);
331 return -ENOENT;
332 }
333 if (0 > peasycap->saturation) {
334 SAM("MISTAKE: %i=peasycap->saturation\n",
335 peasycap->saturation);
336 return -ENOENT;
337 }
338 if (0 > peasycap->hue) {
339 SAM("MISTAKE: %i=peasycap->hue\n", peasycap->hue);
340 return -ENOENT;
341 }
342 return 0;
343 }
344 /*****************************************************************************/
345 /*---------------------------------------------------------------------------*/
346 /*
347 * IF THE REQUESTED INPUT IS THE SAME AS THE EXISTING INPUT, DO NOTHING.
348 * OTHERWISE:
349 * KILL URBS, CLEAR FIELD AND FRAME BUFFERS AND RESET THEIR
350 * _read AND _fill POINTERS.
351 * SELECT THE NEW INPUT.
352 * ADJUST THE STANDARD, FORMAT, BRIGHTNESS, CONTRAST, SATURATION AND HUE
353 * ON THE BASIS OF INFORMATION IN STRUCTURE easycap.inputset[input].
354 * RESUBMIT THE URBS IF STREAMING WAS ALREADY IN PROGRESS.
355 *
356 * NOTE:
357 * THIS ROUTINE MAY BE CALLED FREQUENTLY BY ZONEMINDER VIA IOCTL,
358 * SO IT SHOULD WRITE ONLY SPARINGLY TO THE LOGFILE.
359 */
360 /*---------------------------------------------------------------------------*/
easycap_newinput(struct easycap * peasycap,int input)361 int easycap_newinput(struct easycap *peasycap, int input)
362 {
363 int rc, k, m, mood, off;
364 int inputnow, video_idlenow, audio_idlenow;
365 bool resubmit;
366
367 if (!peasycap) {
368 SAY("ERROR: peasycap is NULL\n");
369 return -EFAULT;
370 }
371 JOM(8, "%i=input sought\n", input);
372
373 if (0 > input && INPUT_MANY <= input)
374 return -ENOENT;
375 inputnow = peasycap->input;
376 if (input == inputnow)
377 return 0;
378 /*---------------------------------------------------------------------------*/
379 /*
380 * IF STREAMING IS IN PROGRESS THE URBS ARE KILLED AT THIS
381 * STAGE AND WILL BE RESUBMITTED PRIOR TO EXIT FROM THE ROUTINE.
382 * IF NO STREAMING IS IN PROGRESS NO URBS WILL BE SUBMITTED BY THE
383 * ROUTINE.
384 */
385 /*---------------------------------------------------------------------------*/
386 video_idlenow = peasycap->video_idle;
387 audio_idlenow = peasycap->audio_idle;
388
389 peasycap->video_idle = 1;
390 peasycap->audio_idle = 1;
391 if (peasycap->video_isoc_streaming) {
392 resubmit = true;
393 easycap_video_kill_urbs(peasycap);
394 } else {
395 resubmit = false;
396 }
397 /*---------------------------------------------------------------------------*/
398 if (!peasycap->pusb_device) {
399 SAM("ERROR: peasycap->pusb_device is NULL\n");
400 return -ENODEV;
401 }
402 rc = usb_set_interface(peasycap->pusb_device,
403 peasycap->video_interface,
404 peasycap->video_altsetting_off);
405 if (rc) {
406 SAM("ERROR: usb_set_interface() rc = %i\n", rc);
407 return -EFAULT;
408 }
409 rc = stop_100(peasycap->pusb_device);
410 if (rc) {
411 SAM("ERROR: stop_100() rc = %i\n", rc);
412 return -EFAULT;
413 }
414 for (k = 0; k < FIELD_BUFFER_MANY; k++) {
415 for (m = 0; m < FIELD_BUFFER_SIZE/PAGE_SIZE; m++)
416 memset(peasycap->field_buffer[k][m].pgo, 0, PAGE_SIZE);
417 }
418 for (k = 0; k < FRAME_BUFFER_MANY; k++) {
419 for (m = 0; m < FRAME_BUFFER_SIZE/PAGE_SIZE; m++)
420 memset(peasycap->frame_buffer[k][m].pgo, 0, PAGE_SIZE);
421 }
422 peasycap->field_page = 0;
423 peasycap->field_read = 0;
424 peasycap->field_fill = 0;
425
426 peasycap->frame_read = 0;
427 peasycap->frame_fill = 0;
428 for (k = 0; k < peasycap->input; k++) {
429 (peasycap->frame_fill)++;
430 if (peasycap->frame_buffer_many <= peasycap->frame_fill)
431 peasycap->frame_fill = 0;
432 }
433 peasycap->input = input;
434 select_input(peasycap->pusb_device, peasycap->input, 9);
435 /*---------------------------------------------------------------------------*/
436 if (input == peasycap->inputset[input].input) {
437 off = peasycap->inputset[input].standard_offset;
438 if (off != peasycap->standard_offset) {
439 rc = adjust_standard(peasycap,
440 easycap_standard[off].v4l2_standard.id);
441 if (rc) {
442 SAM("ERROR: adjust_standard() rc = %i\n", rc);
443 return -EFAULT;
444 }
445 JOM(8, "%i=peasycap->standard_offset\n",
446 peasycap->standard_offset);
447 } else {
448 JOM(8, "%i=peasycap->standard_offset unchanged\n",
449 peasycap->standard_offset);
450 }
451 off = peasycap->inputset[input].format_offset;
452 if (off != peasycap->format_offset) {
453 struct v4l2_pix_format *pix =
454 &easycap_format[off].v4l2_format.fmt.pix;
455 rc = adjust_format(peasycap,
456 pix->width, pix->height,
457 pix->pixelformat, pix->field, false);
458 if (0 > rc) {
459 SAM("ERROR: adjust_format() rc = %i\n", rc);
460 return -EFAULT;
461 }
462 JOM(8, "%i=peasycap->format_offset\n",
463 peasycap->format_offset);
464 } else {
465 JOM(8, "%i=peasycap->format_offset unchanged\n",
466 peasycap->format_offset);
467 }
468 mood = peasycap->inputset[input].brightness;
469 if (mood != peasycap->brightness) {
470 rc = adjust_brightness(peasycap, mood);
471 if (rc) {
472 SAM("ERROR: adjust_brightness rc = %i\n", rc);
473 return -EFAULT;
474 }
475 JOM(8, "%i=peasycap->brightness\n",
476 peasycap->brightness);
477 }
478 mood = peasycap->inputset[input].contrast;
479 if (mood != peasycap->contrast) {
480 rc = adjust_contrast(peasycap, mood);
481 if (rc) {
482 SAM("ERROR: adjust_contrast rc = %i\n", rc);
483 return -EFAULT;
484 }
485 JOM(8, "%i=peasycap->contrast\n", peasycap->contrast);
486 }
487 mood = peasycap->inputset[input].saturation;
488 if (mood != peasycap->saturation) {
489 rc = adjust_saturation(peasycap, mood);
490 if (rc) {
491 SAM("ERROR: adjust_saturation rc = %i\n", rc);
492 return -EFAULT;
493 }
494 JOM(8, "%i=peasycap->saturation\n",
495 peasycap->saturation);
496 }
497 mood = peasycap->inputset[input].hue;
498 if (mood != peasycap->hue) {
499 rc = adjust_hue(peasycap, mood);
500 if (rc) {
501 SAM("ERROR: adjust_hue rc = %i\n", rc);
502 return -EFAULT;
503 }
504 JOM(8, "%i=peasycap->hue\n", peasycap->hue);
505 }
506 } else {
507 SAM("MISTAKE: easycap.inputset[%i] unpopulated\n", input);
508 return -ENOENT;
509 }
510 /*---------------------------------------------------------------------------*/
511 if (!peasycap->pusb_device) {
512 SAM("ERROR: peasycap->pusb_device is NULL\n");
513 return -ENODEV;
514 }
515 rc = usb_set_interface(peasycap->pusb_device,
516 peasycap->video_interface,
517 peasycap->video_altsetting_on);
518 if (rc) {
519 SAM("ERROR: usb_set_interface() rc = %i\n", rc);
520 return -EFAULT;
521 }
522 rc = start_100(peasycap->pusb_device);
523 if (rc) {
524 SAM("ERROR: start_100() rc = %i\n", rc);
525 return -EFAULT;
526 }
527 if (resubmit)
528 easycap_video_submit_urbs(peasycap);
529
530 peasycap->video_isoc_sequence = VIDEO_ISOC_BUFFER_MANY - 1;
531 peasycap->video_idle = video_idlenow;
532 peasycap->audio_idle = audio_idlenow;
533 peasycap->video_junk = 0;
534
535 return 0;
536 }
537 /*****************************************************************************/
easycap_video_submit_urbs(struct easycap * peasycap)538 int easycap_video_submit_urbs(struct easycap *peasycap)
539 {
540 struct data_urb *pdata_urb;
541 struct urb *purb;
542 struct list_head *plist_head;
543 int j, isbad, nospc, m, rc;
544 int isbuf;
545
546 if (!peasycap) {
547 SAY("ERROR: peasycap is NULL\n");
548 return -EFAULT;
549 }
550
551 if (!peasycap->purb_video_head) {
552 SAY("ERROR: peasycap->urb_video_head uninitialized\n");
553 return -EFAULT;
554 }
555 if (!peasycap->pusb_device) {
556 SAY("ERROR: peasycap->pusb_device is NULL\n");
557 return -ENODEV;
558 }
559 if (!peasycap->video_isoc_streaming) {
560 JOM(4, "submission of all video urbs\n");
561 isbad = 0; nospc = 0; m = 0;
562 list_for_each(plist_head, (peasycap->purb_video_head)) {
563 pdata_urb = list_entry(plist_head,
564 struct data_urb, list_head);
565 if (pdata_urb && pdata_urb->purb) {
566 purb = pdata_urb->purb;
567 isbuf = pdata_urb->isbuf;
568 purb->interval = 1;
569 purb->dev = peasycap->pusb_device;
570 purb->pipe =
571 usb_rcvisocpipe(peasycap->pusb_device,
572 peasycap->video_endpointnumber);
573 purb->transfer_flags = URB_ISO_ASAP;
574 purb->transfer_buffer =
575 peasycap->video_isoc_buffer[isbuf].pgo;
576 purb->transfer_buffer_length =
577 peasycap->video_isoc_buffer_size;
578 purb->complete = easycap_complete;
579 purb->context = peasycap;
580 purb->start_frame = 0;
581 purb->number_of_packets =
582 peasycap->video_isoc_framesperdesc;
583
584 for (j = 0; j < peasycap->video_isoc_framesperdesc; j++) {
585 purb->iso_frame_desc[j]. offset =
586 j * peasycap->video_isoc_maxframesize;
587 purb->iso_frame_desc[j]. length =
588 peasycap->video_isoc_maxframesize;
589 }
590
591 rc = usb_submit_urb(purb, GFP_KERNEL);
592 if (rc) {
593 isbad++;
594 SAM("ERROR: usb_submit_urb() failed "
595 "for urb with rc:-%s\n",
596 strerror(rc));
597 if (rc == -ENOSPC)
598 nospc++;
599 } else {
600 m++;
601 }
602 } else {
603 isbad++;
604 }
605 }
606 if (nospc) {
607 SAM("-ENOSPC=usb_submit_urb() for %i urbs\n", nospc);
608 SAM("..... possibly inadequate USB bandwidth\n");
609 peasycap->video_eof = 1;
610 }
611
612 if (isbad)
613 easycap_video_kill_urbs(peasycap);
614 else
615 peasycap->video_isoc_streaming = 1;
616 } else {
617 JOM(4, "already streaming video urbs\n");
618 }
619 return 0;
620 }
621 /*****************************************************************************/
easycap_audio_kill_urbs(struct easycap * peasycap)622 int easycap_audio_kill_urbs(struct easycap *peasycap)
623 {
624 int m;
625 struct list_head *plist_head;
626 struct data_urb *pdata_urb;
627
628 if (!peasycap->audio_isoc_streaming)
629 return 0;
630
631 if (!peasycap->purb_audio_head) {
632 SAM("ERROR: peasycap->purb_audio_head is NULL\n");
633 return -EFAULT;
634 }
635
636 peasycap->audio_isoc_streaming = 0;
637 m = 0;
638 list_for_each(plist_head, peasycap->purb_audio_head) {
639 pdata_urb = list_entry(plist_head, struct data_urb, list_head);
640 if (pdata_urb && pdata_urb->purb) {
641 usb_kill_urb(pdata_urb->purb);
642 m++;
643 }
644 }
645
646 JOM(4, "%i audio urbs killed\n", m);
647
648 return 0;
649 }
easycap_video_kill_urbs(struct easycap * peasycap)650 int easycap_video_kill_urbs(struct easycap *peasycap)
651 {
652 int m;
653 struct list_head *plist_head;
654 struct data_urb *pdata_urb;
655
656 if (!peasycap->video_isoc_streaming)
657 return 0;
658
659 if (!peasycap->purb_video_head) {
660 SAM("ERROR: peasycap->purb_video_head is NULL\n");
661 return -EFAULT;
662 }
663
664 peasycap->video_isoc_streaming = 0;
665 JOM(4, "killing video urbs\n");
666 m = 0;
667 list_for_each(plist_head, (peasycap->purb_video_head)) {
668 pdata_urb = list_entry(plist_head, struct data_urb, list_head);
669 if (pdata_urb && pdata_urb->purb) {
670 usb_kill_urb(pdata_urb->purb);
671 m++;
672 }
673 }
674 JOM(4, "%i video urbs killed\n", m);
675
676 return 0;
677 }
678 /****************************************************************************/
679 /*^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^*/
680 /*--------------------------------------------------------------------------*/
easycap_open_noinode(struct file * file)681 static int easycap_open_noinode(struct file *file)
682 {
683 return easycap_open(NULL, file);
684 }
685
videodev_release(struct video_device * pvideo_device)686 static int videodev_release(struct video_device *pvideo_device)
687 {
688 struct easycap *peasycap;
689
690 peasycap = video_get_drvdata(pvideo_device);
691 if (!peasycap) {
692 SAY("ERROR: peasycap is NULL\n");
693 SAY("ending unsuccessfully\n");
694 return -EFAULT;
695 }
696 if (easycap_video_kill_urbs(peasycap)) {
697 SAM("ERROR: easycap_video_kill_urbs() failed\n");
698 return -EFAULT;
699 }
700 JOM(4, "ending successfully\n");
701 return 0;
702 }
703 /*^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^*/
704 /*****************************************************************************/
705 /*--------------------------------------------------------------------------*/
706 /*
707 * THIS FUNCTION IS CALLED FROM WITHIN easycap_usb_disconnect() AND IS
708 * PROTECTED BY SEMAPHORES SET AND CLEARED BY easycap_usb_disconnect().
709 *
710 * BY THIS STAGE THE DEVICE HAS ALREADY BEEN PHYSICALLY UNPLUGGED, SO
711 * peasycap->pusb_device IS NO LONGER VALID.
712 */
713 /*---------------------------------------------------------------------------*/
easycap_delete(struct kref * pkref)714 static void easycap_delete(struct kref *pkref)
715 {
716 struct easycap *peasycap;
717 struct data_urb *pdata_urb;
718 struct list_head *plist_head, *plist_next;
719 int k, m, gone, kd;
720 int allocation_video_urb;
721 int allocation_video_page;
722 int allocation_video_struct;
723 int allocation_audio_urb;
724 int allocation_audio_page;
725 int allocation_audio_struct;
726 int registered_video, registered_audio;
727
728 peasycap = container_of(pkref, struct easycap, kref);
729 if (!peasycap) {
730 SAM("ERROR: peasycap is NULL: cannot perform deletions\n");
731 return;
732 }
733 kd = easycap_isdongle(peasycap);
734 /*---------------------------------------------------------------------------*/
735 /*
736 * FREE VIDEO.
737 */
738 /*---------------------------------------------------------------------------*/
739 if (peasycap->purb_video_head) {
740 m = 0;
741 list_for_each(plist_head, peasycap->purb_video_head) {
742 pdata_urb = list_entry(plist_head,
743 struct data_urb, list_head);
744 if (pdata_urb && pdata_urb->purb) {
745 usb_free_urb(pdata_urb->purb);
746 pdata_urb->purb = NULL;
747 peasycap->allocation_video_urb--;
748 m++;
749 }
750 }
751
752 JOM(4, "%i video urbs freed\n", m);
753 /*---------------------------------------------------------------------------*/
754 JOM(4, "freeing video data_urb structures.\n");
755 m = 0;
756 list_for_each_safe(plist_head, plist_next,
757 peasycap->purb_video_head) {
758 pdata_urb = list_entry(plist_head,
759 struct data_urb, list_head);
760 if (pdata_urb) {
761 peasycap->allocation_video_struct -=
762 sizeof(struct data_urb);
763 kfree(pdata_urb);
764 m++;
765 }
766 }
767 JOM(4, "%i video data_urb structures freed\n", m);
768 JOM(4, "setting peasycap->purb_video_head=NULL\n");
769 peasycap->purb_video_head = NULL;
770 }
771 /*---------------------------------------------------------------------------*/
772 JOM(4, "freeing video isoc buffers.\n");
773 m = 0;
774 for (k = 0; k < VIDEO_ISOC_BUFFER_MANY; k++) {
775 if (peasycap->video_isoc_buffer[k].pgo) {
776 free_pages((unsigned long)
777 peasycap->video_isoc_buffer[k].pgo,
778 VIDEO_ISOC_ORDER);
779 peasycap->video_isoc_buffer[k].pgo = NULL;
780 peasycap->allocation_video_page -=
781 BIT(VIDEO_ISOC_ORDER);
782 m++;
783 }
784 }
785 JOM(4, "isoc video buffers freed: %i pages\n",
786 m * (0x01 << VIDEO_ISOC_ORDER));
787 /*---------------------------------------------------------------------------*/
788 JOM(4, "freeing video field buffers.\n");
789 gone = 0;
790 for (k = 0; k < FIELD_BUFFER_MANY; k++) {
791 for (m = 0; m < FIELD_BUFFER_SIZE/PAGE_SIZE; m++) {
792 if (peasycap->field_buffer[k][m].pgo) {
793 free_page((unsigned long)
794 peasycap->field_buffer[k][m].pgo);
795 peasycap->field_buffer[k][m].pgo = NULL;
796 peasycap->allocation_video_page -= 1;
797 gone++;
798 }
799 }
800 }
801 JOM(4, "video field buffers freed: %i pages\n", gone);
802 /*---------------------------------------------------------------------------*/
803 JOM(4, "freeing video frame buffers.\n");
804 gone = 0;
805 for (k = 0; k < FRAME_BUFFER_MANY; k++) {
806 for (m = 0; m < FRAME_BUFFER_SIZE/PAGE_SIZE; m++) {
807 if (peasycap->frame_buffer[k][m].pgo) {
808 free_page((unsigned long)
809 peasycap->frame_buffer[k][m].pgo);
810 peasycap->frame_buffer[k][m].pgo = NULL;
811 peasycap->allocation_video_page -= 1;
812 gone++;
813 }
814 }
815 }
816 JOM(4, "video frame buffers freed: %i pages\n", gone);
817 /*---------------------------------------------------------------------------*/
818 /*
819 * FREE AUDIO.
820 */
821 /*---------------------------------------------------------------------------*/
822 if (peasycap->purb_audio_head) {
823 JOM(4, "freeing audio urbs\n");
824 m = 0;
825 list_for_each(plist_head, (peasycap->purb_audio_head)) {
826 pdata_urb = list_entry(plist_head,
827 struct data_urb, list_head);
828 if (pdata_urb && pdata_urb->purb) {
829 usb_free_urb(pdata_urb->purb);
830 pdata_urb->purb = NULL;
831 peasycap->allocation_audio_urb--;
832 m++;
833 }
834 }
835 JOM(4, "%i audio urbs freed\n", m);
836 /*---------------------------------------------------------------------------*/
837 JOM(4, "freeing audio data_urb structures.\n");
838 m = 0;
839 list_for_each_safe(plist_head, plist_next,
840 peasycap->purb_audio_head) {
841 pdata_urb = list_entry(plist_head,
842 struct data_urb, list_head);
843 if (pdata_urb) {
844 peasycap->allocation_audio_struct -=
845 sizeof(struct data_urb);
846 kfree(pdata_urb);
847 m++;
848 }
849 }
850 JOM(4, "%i audio data_urb structures freed\n", m);
851 JOM(4, "setting peasycap->purb_audio_head=NULL\n");
852 peasycap->purb_audio_head = NULL;
853 }
854 /*---------------------------------------------------------------------------*/
855 JOM(4, "freeing audio isoc buffers.\n");
856 m = 0;
857 for (k = 0; k < AUDIO_ISOC_BUFFER_MANY; k++) {
858 if (peasycap->audio_isoc_buffer[k].pgo) {
859 free_pages((unsigned long)
860 (peasycap->audio_isoc_buffer[k].pgo),
861 AUDIO_ISOC_ORDER);
862 peasycap->audio_isoc_buffer[k].pgo = NULL;
863 peasycap->allocation_audio_page -=
864 BIT(AUDIO_ISOC_ORDER);
865 m++;
866 }
867 }
868 JOM(4, "easyoss_delete(): isoc audio buffers freed: %i pages\n",
869 m * (0x01 << AUDIO_ISOC_ORDER));
870 /*---------------------------------------------------------------------------*/
871 JOM(4, "freeing easycap structure.\n");
872 allocation_video_urb = peasycap->allocation_video_urb;
873 allocation_video_page = peasycap->allocation_video_page;
874 allocation_video_struct = peasycap->allocation_video_struct;
875 registered_video = peasycap->registered_video;
876 allocation_audio_urb = peasycap->allocation_audio_urb;
877 allocation_audio_page = peasycap->allocation_audio_page;
878 allocation_audio_struct = peasycap->allocation_audio_struct;
879 registered_audio = peasycap->registered_audio;
880
881 if (0 <= kd && DONGLE_MANY > kd) {
882 if (mutex_lock_interruptible(&mutex_dongle)) {
883 SAY("ERROR: cannot down mutex_dongle\n");
884 } else {
885 JOM(4, "locked mutex_dongle\n");
886 easycapdc60_dongle[kd].peasycap = NULL;
887 mutex_unlock(&mutex_dongle);
888 JOM(4, "unlocked mutex_dongle\n");
889 JOT(4, " null-->dongle[%i].peasycap\n", kd);
890 allocation_video_struct -= sizeof(struct easycap);
891 }
892 } else {
893 SAY("ERROR: cannot purge dongle[].peasycap");
894 }
895
896 kfree(peasycap);
897
898 /*---------------------------------------------------------------------------*/
899 SAY("%8i=video urbs after all deletions\n", allocation_video_urb);
900 SAY("%8i=video pages after all deletions\n", allocation_video_page);
901 SAY("%8i=video structs after all deletions\n", allocation_video_struct);
902 SAY("%8i=video devices after all deletions\n", registered_video);
903 SAY("%8i=audio urbs after all deletions\n", allocation_audio_urb);
904 SAY("%8i=audio pages after all deletions\n", allocation_audio_page);
905 SAY("%8i=audio structs after all deletions\n", allocation_audio_struct);
906 SAY("%8i=audio devices after all deletions\n", registered_audio);
907
908 JOT(4, "ending.\n");
909 return;
910 }
911 /*****************************************************************************/
easycap_poll(struct file * file,poll_table * wait)912 static unsigned int easycap_poll(struct file *file, poll_table *wait)
913 {
914 struct easycap *peasycap;
915 int rc, kd;
916
917 JOT(8, "\n");
918
919 if (NULL == ((poll_table *)wait))
920 JOT(8, "WARNING: poll table pointer is NULL ... continuing\n");
921 if (!file) {
922 SAY("ERROR: file pointer is NULL\n");
923 return -ERESTARTSYS;
924 }
925 peasycap = file->private_data;
926 if (!peasycap) {
927 SAY("ERROR: peasycap is NULL\n");
928 return -EFAULT;
929 }
930 if (!peasycap->pusb_device) {
931 SAY("ERROR: peasycap->pusb_device is NULL\n");
932 return -EFAULT;
933 }
934 /*---------------------------------------------------------------------------*/
935 kd = easycap_isdongle(peasycap);
936 if (0 <= kd && DONGLE_MANY > kd) {
937 if (mutex_lock_interruptible(&easycapdc60_dongle[kd].mutex_video)) {
938 SAY("ERROR: cannot down dongle[%i].mutex_video\n", kd);
939 return -ERESTARTSYS;
940 }
941 JOM(4, "locked dongle[%i].mutex_video\n", kd);
942 /*
943 * MEANWHILE, easycap_usb_disconnect() MAY HAVE FREED POINTER
944 * peasycap, IN WHICH CASE A REPEAT CALL TO isdongle() WILL FAIL.
945 * IF NECESSARY, BAIL OUT.
946 */
947 if (kd != easycap_isdongle(peasycap)) {
948 mutex_unlock(&easycapdc60_dongle[kd].mutex_video);
949 return -ERESTARTSYS;
950 }
951 if (!file) {
952 SAY("ERROR: file is NULL\n");
953 mutex_unlock(&easycapdc60_dongle[kd].mutex_video);
954 return -ERESTARTSYS;
955 }
956 peasycap = file->private_data;
957 if (!peasycap) {
958 SAY("ERROR: peasycap is NULL\n");
959 mutex_unlock(&easycapdc60_dongle[kd].mutex_video);
960 return -ERESTARTSYS;
961 }
962 if (!peasycap->pusb_device) {
963 SAM("ERROR: peasycap->pusb_device is NULL\n");
964 mutex_unlock(&easycapdc60_dongle[kd].mutex_video);
965 return -ERESTARTSYS;
966 }
967 } else
968 /*
969 * IF easycap_usb_disconnect() HAS ALREADY FREED POINTER peasycap
970 * BEFORE THE ATTEMPT TO ACQUIRE THE SEMAPHORE, isdongle() WILL
971 * HAVE FAILED. BAIL OUT.
972 */
973 return -ERESTARTSYS;
974 /*---------------------------------------------------------------------------*/
975 rc = easycap_video_dqbuf(peasycap, 0);
976 peasycap->polled = 1;
977 mutex_unlock(&easycapdc60_dongle[kd].mutex_video);
978 if (rc)
979 return POLLERR;
980
981 return POLLIN | POLLRDNORM;
982 }
983 /*****************************************************************************/
984 /*---------------------------------------------------------------------------*/
985 /*
986 * IF mode IS NONZERO THIS ROUTINE RETURNS -EAGAIN RATHER THAN BLOCKING.
987 */
988 /*---------------------------------------------------------------------------*/
easycap_video_dqbuf(struct easycap * peasycap,int mode)989 int easycap_video_dqbuf(struct easycap *peasycap, int mode)
990 {
991 int input, ifield, miss, rc;
992
993
994 if (!peasycap) {
995 SAY("ERROR: peasycap is NULL\n");
996 return -EFAULT;
997 }
998 if (!peasycap->pusb_device) {
999 SAY("ERROR: peasycap->pusb_device is NULL\n");
1000 return -EFAULT;
1001 }
1002 ifield = 0;
1003 JOM(8, "%i=ifield\n", ifield);
1004 /*---------------------------------------------------------------------------*/
1005 /*
1006 * CHECK FOR LOST INPUT SIGNAL.
1007 *
1008 * FOR THE FOUR-CVBS EasyCAP, THIS DOES NOT WORK AS EXPECTED.
1009 * IF INPUT 0 IS PRESENT AND SYNC ACQUIRED, UNPLUGGING INPUT 4 DOES NOT
1010 * RESULT IN SETTING BIT 0x40 ON REGISTER 0x1F, PRESUMABLY BECAUSE THERE
1011 * IS FLYWHEELING ON INPUT 0. THE UPSHOT IS:
1012 *
1013 * INPUT 0 PLUGGED, INPUT 4 PLUGGED => SCREEN 0 OK, SCREEN 4 OK
1014 * INPUT 0 PLUGGED, INPUT 4 UNPLUGGED => SCREEN 0 OK, SCREEN 4 BLACK
1015 * INPUT 0 UNPLUGGED, INPUT 4 PLUGGED => SCREEN 0 BARS, SCREEN 4 OK
1016 * INPUT 0 UNPLUGGED, INPUT 4 UNPLUGGED => SCREEN 0 BARS, SCREEN 4 BARS
1017 */
1018 /*---------------------------------------------------------------------------*/
1019 input = peasycap->input;
1020 if (0 <= input && INPUT_MANY > input) {
1021 rc = read_saa(peasycap->pusb_device, 0x1F);
1022 if (0 <= rc) {
1023 if (rc & 0x40)
1024 peasycap->lost[input] += 1;
1025 else
1026 peasycap->lost[input] -= 2;
1027
1028 if (0 > peasycap->lost[input])
1029 peasycap->lost[input] = 0;
1030 else if ((2 * VIDEO_LOST_TOLERATE) < peasycap->lost[input])
1031 peasycap->lost[input] = (2 * VIDEO_LOST_TOLERATE);
1032 }
1033 }
1034 /*---------------------------------------------------------------------------*/
1035 /*
1036 * WAIT FOR FIELD ifield (0 => TOP, 1 => BOTTOM)
1037 */
1038 /*---------------------------------------------------------------------------*/
1039 miss = 0;
1040 while ((peasycap->field_read == peasycap->field_fill) ||
1041 (0 != (0xFF00 & peasycap->field_buffer
1042 [peasycap->field_read][0].kount)) ||
1043 (ifield != (0x00FF & peasycap->field_buffer
1044 [peasycap->field_read][0].kount))) {
1045 if (mode)
1046 return -EAGAIN;
1047
1048 JOM(8, "first wait on wq_video, %i=field_read %i=field_fill\n",
1049 peasycap->field_read, peasycap->field_fill);
1050
1051 if (0 != (wait_event_interruptible(peasycap->wq_video,
1052 (peasycap->video_idle || peasycap->video_eof ||
1053 ((peasycap->field_read != peasycap->field_fill) &&
1054 (0 == (0xFF00 & peasycap->field_buffer[peasycap->field_read][0].kount)) &&
1055 (ifield == (0x00FF & peasycap->field_buffer[peasycap->field_read][0].kount))))))) {
1056 SAM("aborted by signal\n");
1057 return -EIO;
1058 }
1059 if (peasycap->video_idle) {
1060 JOM(8, "%i=peasycap->video_idle returning -EAGAIN\n",
1061 peasycap->video_idle);
1062 return -EAGAIN;
1063 }
1064 if (peasycap->video_eof) {
1065 JOM(8, "%i=peasycap->video_eof\n", peasycap->video_eof);
1066 #if defined(PERSEVERE)
1067 if (1 == peasycap->status) {
1068 JOM(8, "persevering ...\n");
1069 peasycap->video_eof = 0;
1070 peasycap->audio_eof = 0;
1071 if (0 != reset(peasycap)) {
1072 JOM(8, " ... failed returning -EIO\n");
1073 peasycap->video_eof = 1;
1074 peasycap->audio_eof = 1;
1075 easycap_video_kill_urbs(peasycap);
1076 return -EIO;
1077 }
1078 peasycap->status = 0;
1079 JOM(8, " ... OK returning -EAGAIN\n");
1080 return -EAGAIN;
1081 }
1082 #endif /*PERSEVERE*/
1083 peasycap->video_eof = 1;
1084 peasycap->audio_eof = 1;
1085 easycap_video_kill_urbs(peasycap);
1086 JOM(8, "returning -EIO\n");
1087 return -EIO;
1088 }
1089 miss++;
1090 }
1091 JOM(8, "first awakening on wq_video after %i waits\n", miss);
1092
1093 rc = field2frame(peasycap);
1094 if (rc)
1095 SAM("ERROR: field2frame() rc = %i\n", rc);
1096 /*---------------------------------------------------------------------------*/
1097 /*
1098 * WAIT FOR THE OTHER FIELD
1099 */
1100 /*---------------------------------------------------------------------------*/
1101 if (ifield)
1102 ifield = 0;
1103 else
1104 ifield = 1;
1105 miss = 0;
1106 while ((peasycap->field_read == peasycap->field_fill) ||
1107 (0 != (0xFF00 & peasycap->field_buffer[peasycap->field_read][0].kount)) ||
1108 (ifield != (0x00FF & peasycap->field_buffer[peasycap->field_read][0].kount))) {
1109 if (mode)
1110 return -EAGAIN;
1111
1112 JOM(8, "second wait on wq_video %i=field_read %i=field_fill\n",
1113 peasycap->field_read, peasycap->field_fill);
1114 if (0 != (wait_event_interruptible(peasycap->wq_video,
1115 (peasycap->video_idle || peasycap->video_eof ||
1116 ((peasycap->field_read != peasycap->field_fill) &&
1117 (0 == (0xFF00 & peasycap->field_buffer[peasycap->field_read][0].kount)) &&
1118 (ifield == (0x00FF & peasycap->field_buffer[peasycap->field_read][0].kount))))))) {
1119 SAM("aborted by signal\n");
1120 return -EIO;
1121 }
1122 if (peasycap->video_idle) {
1123 JOM(8, "%i=peasycap->video_idle returning -EAGAIN\n",
1124 peasycap->video_idle);
1125 return -EAGAIN;
1126 }
1127 if (peasycap->video_eof) {
1128 JOM(8, "%i=peasycap->video_eof\n", peasycap->video_eof);
1129 #if defined(PERSEVERE)
1130 if (1 == peasycap->status) {
1131 JOM(8, "persevering ...\n");
1132 peasycap->video_eof = 0;
1133 peasycap->audio_eof = 0;
1134 if (0 != reset(peasycap)) {
1135 JOM(8, " ... failed returning -EIO\n");
1136 peasycap->video_eof = 1;
1137 peasycap->audio_eof = 1;
1138 easycap_video_kill_urbs(peasycap);
1139 return -EIO;
1140 }
1141 peasycap->status = 0;
1142 JOM(8, " ... OK ... returning -EAGAIN\n");
1143 return -EAGAIN;
1144 }
1145 #endif /*PERSEVERE*/
1146 peasycap->video_eof = 1;
1147 peasycap->audio_eof = 1;
1148 easycap_video_kill_urbs(peasycap);
1149 JOM(8, "returning -EIO\n");
1150 return -EIO;
1151 }
1152 miss++;
1153 }
1154 JOM(8, "second awakening on wq_video after %i waits\n", miss);
1155
1156 rc = field2frame(peasycap);
1157 if (rc)
1158 SAM("ERROR: field2frame() rc = %i\n", rc);
1159 /*---------------------------------------------------------------------------*/
1160 /*
1161 * WASTE THIS FRAME
1162 */
1163 /*---------------------------------------------------------------------------*/
1164 if (peasycap->skip) {
1165 peasycap->skipped++;
1166 if (peasycap->skip != peasycap->skipped)
1167 return peasycap->skip - peasycap->skipped;
1168 else
1169 peasycap->skipped = 0;
1170 }
1171 /*---------------------------------------------------------------------------*/
1172 peasycap->frame_read = peasycap->frame_fill;
1173 peasycap->queued[peasycap->frame_read] = 0;
1174 peasycap->done[peasycap->frame_read] = V4L2_BUF_FLAG_DONE;
1175
1176 peasycap->frame_fill++;
1177 if (peasycap->frame_buffer_many <= peasycap->frame_fill)
1178 peasycap->frame_fill = 0;
1179
1180 if (0x01 & easycap_standard[peasycap->standard_offset].mask)
1181 peasycap->frame_buffer[peasycap->frame_read][0].kount =
1182 V4L2_FIELD_TOP;
1183 else
1184 peasycap->frame_buffer[peasycap->frame_read][0].kount =
1185 V4L2_FIELD_BOTTOM;
1186
1187
1188 JOM(8, "setting: %i=peasycap->frame_read\n", peasycap->frame_read);
1189 JOM(8, "bumped to: %i=peasycap->frame_fill\n", peasycap->frame_fill);
1190
1191 return 0;
1192 }
1193 /*****************************************************************************/
1194 /*---------------------------------------------------------------------------*/
1195 /*
1196 * BY DEFINITION, odd IS true FOR THE FIELD OCCUPYING LINES 1,3,5,...,479
1197 * odd IS false FOR THE FIELD OCCUPYING LINES 0,2,4,...,478
1198 *
1199 * WHEN BOOLEAN PARAMETER decimatepixel IS true, ONLY THE FIELD FOR WHICH
1200 * odd==false IS TRANSFERRED TO THE FRAME BUFFER.
1201 *
1202 */
1203 /*---------------------------------------------------------------------------*/
field2frame(struct easycap * peasycap)1204 static int field2frame(struct easycap *peasycap)
1205 {
1206
1207 void *pex, *pad;
1208 int kex, kad, mex, mad, rex, rad, rad2;
1209 int c2, c3, w2, w3, cz, wz;
1210 int rc, bytesperpixel, multiplier;
1211 int much, more, over, rump, caches, input;
1212 u8 mask, margin;
1213 bool odd, isuy, decimatepixel, badinput;
1214
1215 if (!peasycap) {
1216 SAY("ERROR: peasycap is NULL\n");
1217 return -EFAULT;
1218 }
1219
1220 badinput = false;
1221 input = 0x07 & peasycap->field_buffer[peasycap->field_read][0].input;
1222
1223 JOM(8, "===== parity %i, input 0x%02X, field buffer %i --> "
1224 "frame buffer %i\n",
1225 peasycap->field_buffer[peasycap->field_read][0].kount,
1226 peasycap->field_buffer[peasycap->field_read][0].input,
1227 peasycap->field_read, peasycap->frame_fill);
1228 JOM(8, "===== %i=bytesperpixel\n", peasycap->bytesperpixel);
1229
1230 /*---------------------------------------------------------------------------*/
1231 /*
1232 * REJECT OR CLEAN BAD FIELDS
1233 */
1234 /*---------------------------------------------------------------------------*/
1235 if (peasycap->field_read == peasycap->field_fill) {
1236 SAM("ERROR: on entry, still filling field buffer %i\n",
1237 peasycap->field_read);
1238 return 0;
1239 }
1240 #ifdef EASYCAP_TESTCARD
1241 easycap_testcard(peasycap, peasycap->field_read);
1242 #else
1243 if (0 <= input && INPUT_MANY > input) {
1244 if (easycap_bars && VIDEO_LOST_TOLERATE <= peasycap->lost[input])
1245 easycap_testcard(peasycap, peasycap->field_read);
1246 }
1247 #endif /*EASYCAP_TESTCARD*/
1248 /*---------------------------------------------------------------------------*/
1249
1250 bytesperpixel = peasycap->bytesperpixel;
1251 decimatepixel = peasycap->decimatepixel;
1252
1253 if ((2 != bytesperpixel) &&
1254 (3 != bytesperpixel) &&
1255 (4 != bytesperpixel)) {
1256 SAM("MISTAKE: %i=bytesperpixel\n", bytesperpixel);
1257 return -EFAULT;
1258 }
1259 if (decimatepixel)
1260 multiplier = 2;
1261 else
1262 multiplier = 1;
1263
1264 w2 = 2 * multiplier * (peasycap->width);
1265 w3 = bytesperpixel * multiplier * (peasycap->width);
1266 wz = multiplier * (peasycap->height) *
1267 multiplier * (peasycap->width);
1268
1269 kex = peasycap->field_read; mex = 0;
1270 kad = peasycap->frame_fill; mad = 0;
1271
1272 pex = peasycap->field_buffer[kex][0].pgo; rex = PAGE_SIZE;
1273 pad = peasycap->frame_buffer[kad][0].pgo; rad = PAGE_SIZE;
1274 odd = !!(peasycap->field_buffer[kex][0].kount);
1275
1276 if (odd && (!decimatepixel)) {
1277 JOM(8, "initial skipping %4i bytes p.%4i\n",
1278 w3/multiplier, mad);
1279 pad += (w3 / multiplier); rad -= (w3 / multiplier);
1280 }
1281 isuy = true;
1282 mask = 0; rump = 0; caches = 0;
1283
1284 cz = 0;
1285 while (cz < wz) {
1286 /*
1287 * PROCESS ONE LINE OF FRAME AT FULL RESOLUTION:
1288 * READ w2 BYTES FROM FIELD BUFFER,
1289 * WRITE w3 BYTES TO FRAME BUFFER
1290 */
1291 if (!decimatepixel) {
1292 over = w2;
1293 do {
1294 much = over; more = 0;
1295 margin = 0; mask = 0x00;
1296 if (rex < much)
1297 much = rex;
1298 rump = 0;
1299
1300 if (much % 2) {
1301 SAM("MISTAKE: much is odd\n");
1302 return -EFAULT;
1303 }
1304
1305 more = (bytesperpixel *
1306 much) / 2;
1307 /* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
1308 if (1 < bytesperpixel) {
1309 if (rad * 2 < much * bytesperpixel) {
1310 /*
1311 * INJUDICIOUS ALTERATION OF
1312 * THIS STATEMENT BLOCK WILL
1313 * CAUSE BREAKAGE. BEWARE.
1314 */
1315 rad2 = rad + bytesperpixel - 1;
1316 much = ((((2 * rad2)/bytesperpixel)/2) * 2);
1317 rump = ((bytesperpixel * much) / 2) - rad;
1318 more = rad;
1319 }
1320 mask = (u8)rump;
1321 margin = 0;
1322 if (much == rex) {
1323 mask |= 0x04;
1324 if ((mex + 1) < FIELD_BUFFER_SIZE / PAGE_SIZE)
1325 margin = *((u8 *)(peasycap->field_buffer[kex][mex + 1].pgo));
1326 else
1327 mask |= 0x08;
1328 }
1329 } else {
1330 SAM("MISTAKE: %i=bytesperpixel\n",
1331 bytesperpixel);
1332 return -EFAULT;
1333 }
1334 if (rump)
1335 caches++;
1336 if (badinput) {
1337 JOM(8, "ERROR: 0x%02X=->field_buffer"
1338 "[%i][%i].input, "
1339 "0x%02X=(0x08|->input)\n",
1340 peasycap->field_buffer
1341 [kex][mex].input, kex, mex,
1342 (0x08|peasycap->input));
1343 }
1344 rc = redaub(peasycap, pad, pex, much, more,
1345 mask, margin, isuy);
1346 if (0 > rc) {
1347 SAM("ERROR: redaub() failed\n");
1348 return -EFAULT;
1349 }
1350 if (much % 4)
1351 isuy = !isuy;
1352
1353 over -= much; cz += much;
1354 pex += much; rex -= much;
1355 if (!rex) {
1356 mex++;
1357 pex = peasycap->field_buffer[kex][mex].pgo;
1358 rex = PAGE_SIZE;
1359 if (peasycap->field_buffer[kex][mex].input != (0x08|peasycap->input))
1360 badinput = true;
1361 }
1362 pad += more;
1363 rad -= more;
1364 if (!rad) {
1365 mad++;
1366 pad = peasycap->frame_buffer[kad][mad].pgo;
1367 rad = PAGE_SIZE;
1368 if (rump) {
1369 pad += rump;
1370 rad -= rump;
1371 }
1372 }
1373 } while (over);
1374 /*---------------------------------------------------------------------------*/
1375 /*
1376 * SKIP w3 BYTES IN TARGET FRAME BUFFER,
1377 * UNLESS IT IS THE LAST LINE OF AN ODD FRAME
1378 */
1379 /*---------------------------------------------------------------------------*/
1380 if (!odd || (cz != wz)) {
1381 over = w3;
1382 do {
1383 if (!rad) {
1384 mad++;
1385 pad = peasycap->frame_buffer
1386 [kad][mad].pgo;
1387 rad = PAGE_SIZE;
1388 }
1389 more = over;
1390 if (rad < more)
1391 more = rad;
1392 over -= more;
1393 pad += more;
1394 rad -= more;
1395 } while (over);
1396 }
1397 /*---------------------------------------------------------------------------*/
1398 /*
1399 * PROCESS ONE LINE OF FRAME AT REDUCED RESOLUTION:
1400 * ONLY IF false==odd,
1401 * READ w2 BYTES FROM FIELD BUFFER,
1402 * WRITE w3 / 2 BYTES TO FRAME BUFFER
1403 */
1404 /*---------------------------------------------------------------------------*/
1405 } else if (!odd) {
1406 over = w2;
1407 do {
1408 much = over; more = 0; margin = 0; mask = 0x00;
1409 if (rex < much)
1410 much = rex;
1411 rump = 0;
1412
1413 if (much % 2) {
1414 SAM("MISTAKE: much is odd\n");
1415 return -EFAULT;
1416 }
1417
1418 more = (bytesperpixel * much) / 4;
1419 /* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
1420 if (1 < bytesperpixel) {
1421 if (rad * 4 < much * bytesperpixel) {
1422 /*
1423 * INJUDICIOUS ALTERATION OF
1424 * THIS STATEMENT BLOCK
1425 * WILL CAUSE BREAKAGE.
1426 * BEWARE.
1427 */
1428 rad2 = rad + bytesperpixel - 1;
1429 much = ((((2 * rad2) / bytesperpixel) / 2) * 4);
1430 rump = ((bytesperpixel * much) / 4) - rad;
1431 more = rad;
1432 }
1433 mask = (u8)rump;
1434 margin = 0;
1435 if (much == rex) {
1436 mask |= 0x04;
1437 if ((mex + 1) < FIELD_BUFFER_SIZE / PAGE_SIZE)
1438 margin = *((u8 *)(peasycap->field_buffer[kex][mex + 1].pgo));
1439 else
1440 mask |= 0x08;
1441 }
1442 /* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
1443 } else {
1444 SAM("MISTAKE: %i=bytesperpixel\n",
1445 bytesperpixel);
1446 return -EFAULT;
1447 }
1448 /* - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - */
1449 if (rump)
1450 caches++;
1451
1452 if (badinput) {
1453 JOM(8, "ERROR: 0x%02X=->field_buffer"
1454 "[%i][%i].input, "
1455 "0x%02X=(0x08|->input)\n",
1456 peasycap->field_buffer
1457 [kex][mex].input, kex, mex,
1458 (0x08|peasycap->input));
1459 }
1460 rc = redaub(peasycap, pad, pex, much, more,
1461 mask, margin, isuy);
1462 if (0 > rc) {
1463 SAM("ERROR: redaub() failed\n");
1464 return -EFAULT;
1465 }
1466 over -= much; cz += much;
1467 pex += much; rex -= much;
1468 if (!rex) {
1469 mex++;
1470 pex = peasycap->field_buffer[kex][mex].pgo;
1471 rex = PAGE_SIZE;
1472 if (peasycap->field_buffer[kex][mex].input !=
1473 (0x08|peasycap->input))
1474 badinput = true;
1475 }
1476 pad += more;
1477 rad -= more;
1478 if (!rad) {
1479 mad++;
1480 pad = peasycap->frame_buffer[kad][mad].pgo;
1481 rad = PAGE_SIZE;
1482 if (rump) {
1483 pad += rump;
1484 rad -= rump;
1485 }
1486 }
1487 } while (over);
1488 /*---------------------------------------------------------------------------*/
1489 /*
1490 * OTHERWISE JUST
1491 * READ w2 BYTES FROM FIELD BUFFER AND DISCARD THEM
1492 */
1493 /*---------------------------------------------------------------------------*/
1494 } else {
1495 over = w2;
1496 do {
1497 if (!rex) {
1498 mex++;
1499 pex = peasycap->field_buffer[kex][mex].pgo;
1500 rex = PAGE_SIZE;
1501 if (peasycap->field_buffer[kex][mex].input !=
1502 (0x08|peasycap->input)) {
1503 JOM(8, "ERROR: 0x%02X=->field_buffer"
1504 "[%i][%i].input, "
1505 "0x%02X=(0x08|->input)\n",
1506 peasycap->field_buffer
1507 [kex][mex].input, kex, mex,
1508 (0x08|peasycap->input));
1509 badinput = true;
1510 }
1511 }
1512 much = over;
1513 if (rex < much)
1514 much = rex;
1515 over -= much;
1516 cz += much;
1517 pex += much;
1518 rex -= much;
1519 } while (over);
1520 }
1521 }
1522 /*---------------------------------------------------------------------------*/
1523 /*
1524 * SANITY CHECKS
1525 */
1526 /*---------------------------------------------------------------------------*/
1527 c2 = (mex + 1)*PAGE_SIZE - rex;
1528 if (cz != c2)
1529 SAM("ERROR: discrepancy %i in bytes read\n", c2 - cz);
1530 c3 = (mad + 1)*PAGE_SIZE - rad;
1531
1532 if (!decimatepixel) {
1533 if (bytesperpixel * cz != c3)
1534 SAM("ERROR: discrepancy %i in bytes written\n",
1535 c3 - (bytesperpixel * cz));
1536 } else {
1537 if (!odd) {
1538 if (bytesperpixel *
1539 cz != (4 * c3))
1540 SAM("ERROR: discrepancy %i in bytes written\n",
1541 (2*c3)-(bytesperpixel * cz));
1542 } else {
1543 if (0 != c3)
1544 SAM("ERROR: discrepancy %i "
1545 "in bytes written\n", c3);
1546 }
1547 }
1548 if (rump)
1549 SAM("WORRY: undischarged cache at end of line in frame buffer\n");
1550
1551 JOM(8, "===== field2frame(): %i bytes --> %i bytes (incl skip)\n", c2, c3);
1552 JOM(8, "===== field2frame(): %i=mad %i=rad\n", mad, rad);
1553
1554 if (odd)
1555 JOM(8, "+++++ field2frame(): frame buffer %i is full\n", kad);
1556
1557 if (peasycap->field_read == peasycap->field_fill)
1558 SAM("WARNING: on exit, filling field buffer %i\n",
1559 peasycap->field_read);
1560
1561 if (caches)
1562 JOM(8, "%i=caches\n", caches);
1563 return 0;
1564 }
1565 /*---------------------------------------------------------------------------*/
1566 /*
1567 * DECIMATION AND COLOURSPACE CONVERSION.
1568 *
1569 * THIS ROUTINE REQUIRES THAT ALL THE DATA TO BE READ RESIDES ON ONE PAGE
1570 * AND THAT ALL THE DATA TO BE WRITTEN RESIDES ON ONE (DIFFERENT) PAGE.
1571 * THE CALLING ROUTINE MUST ENSURE THAT THIS REQUIREMENT IS MET, AND MUST
1572 * ALSO ENSURE THAT much IS EVEN.
1573 *
1574 * much BYTES ARE READ, AT LEAST (bytesperpixel * much)/2 BYTES ARE WRITTEN
1575 * IF THERE IS NO DECIMATION, HALF THIS AMOUNT IF THERE IS DECIMATION.
1576 *
1577 * mask IS ZERO WHEN NO SPECIAL BEHAVIOUR REQUIRED. OTHERWISE IT IS SET THUS:
1578 * 0x03 & mask = number of bytes to be written to cache instead of to
1579 * frame buffer
1580 * 0x04 & mask => use argument margin to set the chrominance for last pixel
1581 * 0x08 & mask => do not set the chrominance for last pixel
1582 *
1583 * YUV to RGB CONVERSION IS (OR SHOULD BE) ITU-R BT 601.
1584 *
1585 * THERE IS A LOT OF CODE REPETITION IN THIS ROUTINE IN ORDER TO AVOID
1586 * INEFFICIENT SWITCHING INSIDE INNER LOOPS. REARRANGING THE LOGIC TO
1587 * REDUCE CODE LENGTH WILL GENERALLY IMPAIR RUNTIME PERFORMANCE. BEWARE.
1588 */
1589 /*---------------------------------------------------------------------------*/
redaub(struct easycap * peasycap,void * pad,void * pex,int much,int more,u8 mask,u8 margin,bool isuy)1590 static int redaub(struct easycap *peasycap,
1591 void *pad, void *pex, int much, int more,
1592 u8 mask, u8 margin, bool isuy)
1593 {
1594 static s32 ay[256], bu[256], rv[256], gu[256], gv[256];
1595 u8 *pcache;
1596 u8 r, g, b, y, u, v, c, *p2, *p3, *pz, *pr;
1597 int bytesperpixel;
1598 bool byteswaporder, decimatepixel, last;
1599 int j, rump;
1600 s32 tmp;
1601
1602 if (much % 2) {
1603 SAM("MISTAKE: much is odd\n");
1604 return -EFAULT;
1605 }
1606 bytesperpixel = peasycap->bytesperpixel;
1607 byteswaporder = peasycap->byteswaporder;
1608 decimatepixel = peasycap->decimatepixel;
1609
1610 /*---------------------------------------------------------------------------*/
1611 if (!bu[255]) {
1612 for (j = 0; j < 112; j++) {
1613 tmp = (0xFF00 & (453 * j)) >> 8;
1614 bu[j + 128] = tmp; bu[127 - j] = -tmp;
1615 tmp = (0xFF00 & (359 * j)) >> 8;
1616 rv[j + 128] = tmp; rv[127 - j] = -tmp;
1617 tmp = (0xFF00 & (88 * j)) >> 8;
1618 gu[j + 128] = tmp; gu[127 - j] = -tmp;
1619 tmp = (0xFF00 & (183 * j)) >> 8;
1620 gv[j + 128] = tmp; gv[127 - j] = -tmp;
1621 }
1622 for (j = 0; j < 16; j++) {
1623 bu[j] = bu[16]; rv[j] = rv[16];
1624 gu[j] = gu[16]; gv[j] = gv[16];
1625 }
1626 for (j = 240; j < 256; j++) {
1627 bu[j] = bu[239]; rv[j] = rv[239];
1628 gu[j] = gu[239]; gv[j] = gv[239];
1629 }
1630 for (j = 16; j < 236; j++)
1631 ay[j] = j;
1632 for (j = 0; j < 16; j++)
1633 ay[j] = ay[16];
1634 for (j = 236; j < 256; j++)
1635 ay[j] = ay[235];
1636 JOM(8, "lookup tables are prepared\n");
1637 }
1638 pcache = peasycap->pcache;
1639 if (!pcache)
1640 pcache = &peasycap->cache[0];
1641 /*---------------------------------------------------------------------------*/
1642 /*
1643 * TRANSFER CONTENTS OF CACHE TO THE FRAME BUFFER
1644 */
1645 /*---------------------------------------------------------------------------*/
1646 if (!pcache) {
1647 SAM("MISTAKE: pcache is NULL\n");
1648 return -EFAULT;
1649 }
1650
1651 if (pcache != &peasycap->cache[0])
1652 JOM(16, "cache has %i bytes\n", (int)(pcache - &peasycap->cache[0]));
1653 p2 = &peasycap->cache[0];
1654 p3 = (u8 *)pad - (int)(pcache - &peasycap->cache[0]);
1655 while (p2 < pcache) {
1656 *p3++ = *p2; p2++;
1657 }
1658 pcache = &peasycap->cache[0];
1659 if (p3 != pad) {
1660 SAM("MISTAKE: pointer misalignment\n");
1661 return -EFAULT;
1662 }
1663 /*---------------------------------------------------------------------------*/
1664 rump = (int)(0x03 & mask);
1665 u = 0; v = 0;
1666 p2 = (u8 *)pex; pz = p2 + much; pr = p3 + more; last = false;
1667 p2++;
1668
1669 if (isuy)
1670 u = *(p2 - 1);
1671 else
1672 v = *(p2 - 1);
1673
1674 if (rump)
1675 JOM(16, "%4i=much %4i=more %i=rump\n", much, more, rump);
1676
1677 /*---------------------------------------------------------------------------*/
1678 switch (bytesperpixel) {
1679 case 2: {
1680 if (!decimatepixel) {
1681 memcpy(pad, pex, (size_t)much);
1682 if (!byteswaporder) {
1683 /* UYVY */
1684 return 0;
1685 } else {
1686 /* YUYV */
1687 p3 = (u8 *)pad; pz = p3 + much;
1688 while (pz > p3) {
1689 c = *p3;
1690 *p3 = *(p3 + 1);
1691 *(p3 + 1) = c;
1692 p3 += 2;
1693 }
1694 return 0;
1695 }
1696 } else {
1697 if (!byteswaporder) {
1698 /* UYVY DECIMATED */
1699 p2 = (u8 *)pex; p3 = (u8 *)pad; pz = p2 + much;
1700 while (pz > p2) {
1701 *p3 = *p2;
1702 *(p3 + 1) = *(p2 + 1);
1703 *(p3 + 2) = *(p2 + 2);
1704 *(p3 + 3) = *(p2 + 3);
1705 p3 += 4; p2 += 8;
1706 }
1707 return 0;
1708 } else {
1709 /* YUYV DECIMATED */
1710 p2 = (u8 *)pex; p3 = (u8 *)pad; pz = p2 + much;
1711 while (pz > p2) {
1712 *p3 = *(p2 + 1);
1713 *(p3 + 1) = *p2;
1714 *(p3 + 2) = *(p2 + 3);
1715 *(p3 + 3) = *(p2 + 2);
1716 p3 += 4; p2 += 8;
1717 }
1718 return 0;
1719 }
1720 }
1721 break;
1722 }
1723 case 3:
1724 {
1725 if (!decimatepixel) {
1726 if (!byteswaporder) {
1727 /* RGB */
1728 while (pz > p2) {
1729 if (pr <= (p3 + bytesperpixel))
1730 last = true;
1731 else
1732 last = false;
1733 y = *p2;
1734 if (last && (0x0C & mask)) {
1735 if (0x04 & mask) {
1736 if (isuy)
1737 v = margin;
1738 else
1739 u = margin;
1740 } else
1741 if (0x08 & mask)
1742 ;
1743 } else {
1744 if (isuy)
1745 v = *(p2 + 1);
1746 else
1747 u = *(p2 + 1);
1748 }
1749
1750 tmp = ay[(int)y] + rv[(int)v];
1751 r = (255 < tmp) ? 255 : ((0 > tmp) ?
1752 0 : (u8)tmp);
1753 tmp = ay[(int)y] - gu[(int)u] - gv[(int)v];
1754 g = (255 < tmp) ? 255 : ((0 > tmp) ?
1755 0 : (u8)tmp);
1756 tmp = ay[(int)y] + bu[(int)u];
1757 b = (255 < tmp) ? 255 : ((0 > tmp) ?
1758 0 : (u8)tmp);
1759
1760 if (last && rump) {
1761 pcache = &peasycap->cache[0];
1762 switch (bytesperpixel - rump) {
1763 case 1: {
1764 *p3 = r;
1765 *pcache++ = g;
1766 *pcache++ = b;
1767 break;
1768 }
1769 case 2: {
1770 *p3 = r;
1771 *(p3 + 1) = g;
1772 *pcache++ = b;
1773 break;
1774 }
1775 default: {
1776 SAM("MISTAKE: %i=rump\n",
1777 bytesperpixel - rump);
1778 return -EFAULT;
1779 }
1780 }
1781 } else {
1782 *p3 = r;
1783 *(p3 + 1) = g;
1784 *(p3 + 2) = b;
1785 }
1786 p2 += 2;
1787 if (isuy)
1788 isuy = false;
1789 else
1790 isuy = true;
1791 p3 += bytesperpixel;
1792 }
1793 return 0;
1794 } else {
1795 /* BGR */
1796 while (pz > p2) {
1797 if (pr <= (p3 + bytesperpixel))
1798 last = true;
1799 else
1800 last = false;
1801 y = *p2;
1802 if (last && (0x0C & mask)) {
1803 if (0x04 & mask) {
1804 if (isuy)
1805 v = margin;
1806 else
1807 u = margin;
1808 }
1809 else
1810 if (0x08 & mask)
1811 ;
1812 } else {
1813 if (isuy)
1814 v = *(p2 + 1);
1815 else
1816 u = *(p2 + 1);
1817 }
1818
1819 tmp = ay[(int)y] + rv[(int)v];
1820 r = (255 < tmp) ? 255 : ((0 > tmp) ?
1821 0 : (u8)tmp);
1822 tmp = ay[(int)y] - gu[(int)u] - gv[(int)v];
1823 g = (255 < tmp) ? 255 : ((0 > tmp) ?
1824 0 : (u8)tmp);
1825 tmp = ay[(int)y] + bu[(int)u];
1826 b = (255 < tmp) ? 255 : ((0 > tmp) ?
1827 0 : (u8)tmp);
1828
1829 if (last && rump) {
1830 pcache = &peasycap->cache[0];
1831 switch (bytesperpixel - rump) {
1832 case 1: {
1833 *p3 = b;
1834 *pcache++ = g;
1835 *pcache++ = r;
1836 break;
1837 }
1838 case 2: {
1839 *p3 = b;
1840 *(p3 + 1) = g;
1841 *pcache++ = r;
1842 break;
1843 }
1844 default: {
1845 SAM("MISTAKE: %i=rump\n",
1846 bytesperpixel - rump);
1847 return -EFAULT;
1848 }
1849 }
1850 } else {
1851 *p3 = b;
1852 *(p3 + 1) = g;
1853 *(p3 + 2) = r;
1854 }
1855 p2 += 2;
1856 if (isuy)
1857 isuy = false;
1858 else
1859 isuy = true;
1860 p3 += bytesperpixel;
1861 }
1862 }
1863 return 0;
1864 } else {
1865 if (!byteswaporder) {
1866 /* RGB DECIMATED */
1867 while (pz > p2) {
1868 if (pr <= (p3 + bytesperpixel))
1869 last = true;
1870 else
1871 last = false;
1872 y = *p2;
1873 if (last && (0x0C & mask)) {
1874 if (0x04 & mask) {
1875 if (isuy)
1876 v = margin;
1877 else
1878 u = margin;
1879 } else
1880 if (0x08 & mask)
1881 ;
1882 } else {
1883 if (isuy)
1884 v = *(p2 + 1);
1885 else
1886 u = *(p2 + 1);
1887 }
1888
1889 if (isuy) {
1890 tmp = ay[(int)y] + rv[(int)v];
1891 r = (255 < tmp) ? 255 : ((0 > tmp) ?
1892 0 : (u8)tmp);
1893 tmp = ay[(int)y] - gu[(int)u] -
1894 gv[(int)v];
1895 g = (255 < tmp) ? 255 : ((0 > tmp) ?
1896 0 : (u8)tmp);
1897 tmp = ay[(int)y] + bu[(int)u];
1898 b = (255 < tmp) ? 255 : ((0 > tmp) ?
1899 0 : (u8)tmp);
1900
1901 if (last && rump) {
1902 pcache = &peasycap->cache[0];
1903 switch (bytesperpixel - rump) {
1904 case 1: {
1905 *p3 = r;
1906 *pcache++ = g;
1907 *pcache++ = b;
1908 break;
1909 }
1910 case 2: {
1911 *p3 = r;
1912 *(p3 + 1) = g;
1913 *pcache++ = b;
1914 break;
1915 }
1916 default: {
1917 SAM("MISTAKE: "
1918 "%i=rump\n",
1919 bytesperpixel - rump);
1920 return -EFAULT;
1921 }
1922 }
1923 } else {
1924 *p3 = r;
1925 *(p3 + 1) = g;
1926 *(p3 + 2) = b;
1927 }
1928 isuy = false;
1929 p3 += bytesperpixel;
1930 } else {
1931 isuy = true;
1932 }
1933 p2 += 2;
1934 }
1935 return 0;
1936 } else {
1937 /* BGR DECIMATED */
1938 while (pz > p2) {
1939 if (pr <= (p3 + bytesperpixel))
1940 last = true;
1941 else
1942 last = false;
1943 y = *p2;
1944 if (last && (0x0C & mask)) {
1945 if (0x04 & mask) {
1946 if (isuy)
1947 v = margin;
1948 else
1949 u = margin;
1950 } else
1951 if (0x08 & mask)
1952 ;
1953 } else {
1954 if (isuy)
1955 v = *(p2 + 1);
1956 else
1957 u = *(p2 + 1);
1958 }
1959
1960 if (isuy) {
1961
1962 tmp = ay[(int)y] + rv[(int)v];
1963 r = (255 < tmp) ? 255 : ((0 > tmp) ?
1964 0 : (u8)tmp);
1965 tmp = ay[(int)y] - gu[(int)u] -
1966 gv[(int)v];
1967 g = (255 < tmp) ? 255 : ((0 > tmp) ?
1968 0 : (u8)tmp);
1969 tmp = ay[(int)y] + bu[(int)u];
1970 b = (255 < tmp) ? 255 : ((0 > tmp) ?
1971 0 : (u8)tmp);
1972
1973 if (last && rump) {
1974 pcache = &peasycap->cache[0];
1975 switch (bytesperpixel - rump) {
1976 case 1: {
1977 *p3 = b;
1978 *pcache++ = g;
1979 *pcache++ = r;
1980 break;
1981 }
1982 case 2: {
1983 *p3 = b;
1984 *(p3 + 1) = g;
1985 *pcache++ = r;
1986 break;
1987 }
1988 default: {
1989 SAM("MISTAKE: "
1990 "%i=rump\n",
1991 bytesperpixel - rump);
1992 return -EFAULT;
1993 }
1994 }
1995 } else {
1996 *p3 = b;
1997 *(p3 + 1) = g;
1998 *(p3 + 2) = r;
1999 }
2000 isuy = false;
2001 p3 += bytesperpixel;
2002 }
2003 else
2004 isuy = true;
2005 p2 += 2;
2006 }
2007 return 0;
2008 }
2009 }
2010 break;
2011 }
2012 case 4:
2013 {
2014 if (!decimatepixel) {
2015 if (!byteswaporder) {
2016 /* RGBA */
2017 while (pz > p2) {
2018 if (pr <= (p3 + bytesperpixel))
2019 last = true;
2020 else
2021 last = false;
2022 y = *p2;
2023 if (last && (0x0C & mask)) {
2024 if (0x04 & mask) {
2025 if (isuy)
2026 v = margin;
2027 else
2028 u = margin;
2029 } else
2030 if (0x08 & mask)
2031 ;
2032 } else {
2033 if (isuy)
2034 v = *(p2 + 1);
2035 else
2036 u = *(p2 + 1);
2037 }
2038
2039 tmp = ay[(int)y] + rv[(int)v];
2040 r = (255 < tmp) ? 255 : ((0 > tmp) ?
2041 0 : (u8)tmp);
2042 tmp = ay[(int)y] - gu[(int)u] - gv[(int)v];
2043 g = (255 < tmp) ? 255 : ((0 > tmp) ?
2044 0 : (u8)tmp);
2045 tmp = ay[(int)y] + bu[(int)u];
2046 b = (255 < tmp) ? 255 : ((0 > tmp) ?
2047 0 : (u8)tmp);
2048
2049 if (last && rump) {
2050 pcache = &peasycap->cache[0];
2051 switch (bytesperpixel - rump) {
2052 case 1: {
2053 *p3 = r;
2054 *pcache++ = g;
2055 *pcache++ = b;
2056 *pcache++ = 0;
2057 break;
2058 }
2059 case 2: {
2060 *p3 = r;
2061 *(p3 + 1) = g;
2062 *pcache++ = b;
2063 *pcache++ = 0;
2064 break;
2065 }
2066 case 3: {
2067 *p3 = r;
2068 *(p3 + 1) = g;
2069 *(p3 + 2) = b;
2070 *pcache++ = 0;
2071 break;
2072 }
2073 default: {
2074 SAM("MISTAKE: %i=rump\n",
2075 bytesperpixel - rump);
2076 return -EFAULT;
2077 }
2078 }
2079 } else {
2080 *p3 = r;
2081 *(p3 + 1) = g;
2082 *(p3 + 2) = b;
2083 *(p3 + 3) = 0;
2084 }
2085 p2 += 2;
2086 if (isuy)
2087 isuy = false;
2088 else
2089 isuy = true;
2090 p3 += bytesperpixel;
2091 }
2092 return 0;
2093 } else {
2094 /*
2095 * BGRA
2096 */
2097 while (pz > p2) {
2098 if (pr <= (p3 + bytesperpixel))
2099 last = true;
2100 else
2101 last = false;
2102 y = *p2;
2103 if (last && (0x0C & mask)) {
2104 if (0x04 & mask) {
2105 if (isuy)
2106 v = margin;
2107 else
2108 u = margin;
2109 } else
2110 if (0x08 & mask)
2111 ;
2112 } else {
2113 if (isuy)
2114 v = *(p2 + 1);
2115 else
2116 u = *(p2 + 1);
2117 }
2118
2119 tmp = ay[(int)y] + rv[(int)v];
2120 r = (255 < tmp) ? 255 : ((0 > tmp) ?
2121 0 : (u8)tmp);
2122 tmp = ay[(int)y] - gu[(int)u] - gv[(int)v];
2123 g = (255 < tmp) ? 255 : ((0 > tmp) ?
2124 0 : (u8)tmp);
2125 tmp = ay[(int)y] + bu[(int)u];
2126 b = (255 < tmp) ? 255 : ((0 > tmp) ?
2127 0 : (u8)tmp);
2128
2129 if (last && rump) {
2130 pcache = &peasycap->cache[0];
2131 switch (bytesperpixel - rump) {
2132 case 1: {
2133 *p3 = b;
2134 *pcache++ = g;
2135 *pcache++ = r;
2136 *pcache++ = 0;
2137 break;
2138 }
2139 case 2: {
2140 *p3 = b;
2141 *(p3 + 1) = g;
2142 *pcache++ = r;
2143 *pcache++ = 0;
2144 break;
2145 }
2146 case 3: {
2147 *p3 = b;
2148 *(p3 + 1) = g;
2149 *(p3 + 2) = r;
2150 *pcache++ = 0;
2151 break;
2152 }
2153 default:
2154 SAM("MISTAKE: %i=rump\n",
2155 bytesperpixel - rump);
2156 return -EFAULT;
2157 }
2158 } else {
2159 *p3 = b;
2160 *(p3 + 1) = g;
2161 *(p3 + 2) = r;
2162 *(p3 + 3) = 0;
2163 }
2164 p2 += 2;
2165 if (isuy)
2166 isuy = false;
2167 else
2168 isuy = true;
2169 p3 += bytesperpixel;
2170 }
2171 }
2172 return 0;
2173 } else {
2174 if (!byteswaporder) {
2175 /*
2176 * RGBA DECIMATED
2177 */
2178 while (pz > p2) {
2179 if (pr <= (p3 + bytesperpixel))
2180 last = true;
2181 else
2182 last = false;
2183 y = *p2;
2184 if (last && (0x0C & mask)) {
2185 if (0x04 & mask) {
2186 if (isuy)
2187 v = margin;
2188 else
2189 u = margin;
2190 } else
2191 if (0x08 & mask)
2192 ;
2193 } else {
2194 if (isuy)
2195 v = *(p2 + 1);
2196 else
2197 u = *(p2 + 1);
2198 }
2199
2200 if (isuy) {
2201
2202 tmp = ay[(int)y] + rv[(int)v];
2203 r = (255 < tmp) ? 255 : ((0 > tmp) ?
2204 0 : (u8)tmp);
2205 tmp = ay[(int)y] - gu[(int)u] -
2206 gv[(int)v];
2207 g = (255 < tmp) ? 255 : ((0 > tmp) ?
2208 0 : (u8)tmp);
2209 tmp = ay[(int)y] + bu[(int)u];
2210 b = (255 < tmp) ? 255 : ((0 > tmp) ?
2211 0 : (u8)tmp);
2212
2213 if (last && rump) {
2214 pcache = &peasycap->cache[0];
2215 switch (bytesperpixel - rump) {
2216 case 1: {
2217 *p3 = r;
2218 *pcache++ = g;
2219 *pcache++ = b;
2220 *pcache++ = 0;
2221 break;
2222 }
2223 case 2: {
2224 *p3 = r;
2225 *(p3 + 1) = g;
2226 *pcache++ = b;
2227 *pcache++ = 0;
2228 break;
2229 }
2230 case 3: {
2231 *p3 = r;
2232 *(p3 + 1) = g;
2233 *(p3 + 2) = b;
2234 *pcache++ = 0;
2235 break;
2236 }
2237 default: {
2238 SAM("MISTAKE: "
2239 "%i=rump\n",
2240 bytesperpixel -
2241 rump);
2242 return -EFAULT;
2243 }
2244 }
2245 } else {
2246 *p3 = r;
2247 *(p3 + 1) = g;
2248 *(p3 + 2) = b;
2249 *(p3 + 3) = 0;
2250 }
2251 isuy = false;
2252 p3 += bytesperpixel;
2253 } else
2254 isuy = true;
2255 p2 += 2;
2256 }
2257 return 0;
2258 } else {
2259 /*
2260 * BGRA DECIMATED
2261 */
2262 while (pz > p2) {
2263 if (pr <= (p3 + bytesperpixel))
2264 last = true;
2265 else
2266 last = false;
2267 y = *p2;
2268 if (last && (0x0C & mask)) {
2269 if (0x04 & mask) {
2270 if (isuy)
2271 v = margin;
2272 else
2273 u = margin;
2274 } else
2275 if (0x08 & mask)
2276 ;
2277 } else {
2278 if (isuy)
2279 v = *(p2 + 1);
2280 else
2281 u = *(p2 + 1);
2282 }
2283
2284 if (isuy) {
2285 tmp = ay[(int)y] + rv[(int)v];
2286 r = (255 < tmp) ? 255 : ((0 > tmp) ?
2287 0 : (u8)tmp);
2288 tmp = ay[(int)y] - gu[(int)u] -
2289 gv[(int)v];
2290 g = (255 < tmp) ? 255 : ((0 > tmp) ?
2291 0 : (u8)tmp);
2292 tmp = ay[(int)y] + bu[(int)u];
2293 b = (255 < tmp) ? 255 : ((0 > tmp) ?
2294 0 : (u8)tmp);
2295
2296 if (last && rump) {
2297 pcache = &peasycap->cache[0];
2298 switch (bytesperpixel - rump) {
2299 case 1: {
2300 *p3 = b;
2301 *pcache++ = g;
2302 *pcache++ = r;
2303 *pcache++ = 0;
2304 break;
2305 }
2306 case 2: {
2307 *p3 = b;
2308 *(p3 + 1) = g;
2309 *pcache++ = r;
2310 *pcache++ = 0;
2311 break;
2312 }
2313 case 3: {
2314 *p3 = b;
2315 *(p3 + 1) = g;
2316 *(p3 + 2) = r;
2317 *pcache++ = 0;
2318 break;
2319 }
2320 default: {
2321 SAM("MISTAKE: "
2322 "%i=rump\n",
2323 bytesperpixel - rump);
2324 return -EFAULT;
2325 }
2326 }
2327 } else {
2328 *p3 = b;
2329 *(p3 + 1) = g;
2330 *(p3 + 2) = r;
2331 *(p3 + 3) = 0;
2332 }
2333 isuy = false;
2334 p3 += bytesperpixel;
2335 } else
2336 isuy = true;
2337 p2 += 2;
2338 }
2339 return 0;
2340 }
2341 }
2342 break;
2343 }
2344 default: {
2345 SAM("MISTAKE: %i=bytesperpixel\n", bytesperpixel);
2346 return -EFAULT;
2347 }
2348 }
2349 return 0;
2350 }
2351 /*****************************************************************************/
2352 /*
2353 * SEE CORBET ET AL. "LINUX DEVICE DRIVERS", 3rd EDITION, PAGES 430-434
2354 */
2355 /*****************************************************************************/
easycap_vma_open(struct vm_area_struct * pvma)2356 static void easycap_vma_open(struct vm_area_struct *pvma)
2357 {
2358 struct easycap *peasycap;
2359
2360 peasycap = pvma->vm_private_data;
2361 if (!peasycap) {
2362 SAY("ERROR: peasycap is NULL\n");
2363 return;
2364 }
2365 peasycap->vma_many++;
2366 JOT(8, "%i=peasycap->vma_many\n", peasycap->vma_many);
2367 return;
2368 }
2369 /*****************************************************************************/
easycap_vma_close(struct vm_area_struct * pvma)2370 static void easycap_vma_close(struct vm_area_struct *pvma)
2371 {
2372 struct easycap *peasycap;
2373
2374 peasycap = pvma->vm_private_data;
2375 if (!peasycap) {
2376 SAY("ERROR: peasycap is NULL\n");
2377 return;
2378 }
2379 peasycap->vma_many--;
2380 JOT(8, "%i=peasycap->vma_many\n", peasycap->vma_many);
2381 return;
2382 }
2383 /*****************************************************************************/
easycap_vma_fault(struct vm_area_struct * pvma,struct vm_fault * pvmf)2384 static int easycap_vma_fault(struct vm_area_struct *pvma, struct vm_fault *pvmf)
2385 {
2386 int k, m, retcode;
2387 void *pbuf;
2388 struct page *page;
2389 struct easycap *peasycap;
2390
2391 retcode = VM_FAULT_NOPAGE;
2392
2393 if (!pvma) {
2394 SAY("pvma is NULL\n");
2395 return retcode;
2396 }
2397 if (!pvmf) {
2398 SAY("pvmf is NULL\n");
2399 return retcode;
2400 }
2401
2402 k = (pvmf->pgoff) / (FRAME_BUFFER_SIZE/PAGE_SIZE);
2403 m = (pvmf->pgoff) % (FRAME_BUFFER_SIZE/PAGE_SIZE);
2404
2405 if (!m)
2406 JOT(4, "%4i=k, %4i=m\n", k, m);
2407 else
2408 JOT(16, "%4i=k, %4i=m\n", k, m);
2409
2410 if ((0 > k) || (FRAME_BUFFER_MANY <= k)) {
2411 SAY("ERROR: buffer index %i out of range\n", k);
2412 return retcode;
2413 }
2414 if ((0 > m) || (FRAME_BUFFER_SIZE/PAGE_SIZE <= m)) {
2415 SAY("ERROR: page number %i out of range\n", m);
2416 return retcode;
2417 }
2418 peasycap = pvma->vm_private_data;
2419 if (!peasycap) {
2420 SAY("ERROR: peasycap is NULL\n");
2421 return retcode;
2422 }
2423 /*---------------------------------------------------------------------------*/
2424 pbuf = peasycap->frame_buffer[k][m].pgo;
2425 if (!pbuf) {
2426 SAM("ERROR: pbuf is NULL\n");
2427 return retcode;
2428 }
2429 page = virt_to_page(pbuf);
2430 if (!page) {
2431 SAM("ERROR: page is NULL\n");
2432 return retcode;
2433 }
2434 get_page(page);
2435 /*---------------------------------------------------------------------------*/
2436 if (!page) {
2437 SAM("ERROR: page is NULL after get_page(page)\n");
2438 } else {
2439 pvmf->page = page;
2440 retcode = VM_FAULT_MINOR;
2441 }
2442 return retcode;
2443 }
2444
2445 static const struct vm_operations_struct easycap_vm_ops = {
2446 .open = easycap_vma_open,
2447 .close = easycap_vma_close,
2448 .fault = easycap_vma_fault,
2449 };
2450
easycap_mmap(struct file * file,struct vm_area_struct * pvma)2451 static int easycap_mmap(struct file *file, struct vm_area_struct *pvma)
2452 {
2453 JOT(8, "\n");
2454
2455 pvma->vm_ops = &easycap_vm_ops;
2456 pvma->vm_flags |= VM_RESERVED;
2457 if (file)
2458 pvma->vm_private_data = file->private_data;
2459 easycap_vma_open(pvma);
2460 return 0;
2461 }
2462 /*****************************************************************************/
2463 /*---------------------------------------------------------------------------*/
2464 /*
2465 * ON COMPLETION OF A VIDEO URB ITS DATA IS COPIED TO THE FIELD BUFFERS
2466 * PROVIDED peasycap->video_idle IS ZERO. REGARDLESS OF THIS BEING TRUE,
2467 * IT IS RESUBMITTED PROVIDED peasycap->video_isoc_streaming IS NOT ZERO.
2468 *
2469 * THIS FUNCTION IS AN INTERRUPT SERVICE ROUTINE AND MUST NOT SLEEP.
2470 *
2471 * INFORMATION ABOUT THE VALIDITY OF THE CONTENTS OF THE FIELD BUFFER ARE
2472 * STORED IN THE TWO-BYTE STATUS PARAMETER
2473 * peasycap->field_buffer[peasycap->field_fill][0].kount
2474 * NOTICE THAT THE INFORMATION IS STORED ONLY WITH PAGE 0 OF THE FIELD BUFFER.
2475 *
2476 * THE LOWER BYTE CONTAINS THE FIELD PARITY BYTE FURNISHED BY THE SAA7113H
2477 * CHIP.
2478 *
2479 * THE UPPER BYTE IS ZERO IF NO PROBLEMS, OTHERWISE:
2480 * 0 != (kount & 0x8000) => AT LEAST ONE URB COMPLETED WITH ERRORS
2481 * 0 != (kount & 0x4000) => BUFFER HAS TOO MUCH DATA
2482 * 0 != (kount & 0x2000) => BUFFER HAS NOT ENOUGH DATA
2483 * 0 != (kount & 0x1000) => BUFFER HAS DATA FROM DISPARATE INPUTS
2484 * 0 != (kount & 0x0400) => RESERVED
2485 * 0 != (kount & 0x0200) => FIELD BUFFER NOT YET CHECKED
2486 * 0 != (kount & 0x0100) => BUFFER HAS TWO EXTRA BYTES - WHY?
2487 */
2488 /*---------------------------------------------------------------------------*/
easycap_complete(struct urb * purb)2489 static void easycap_complete(struct urb *purb)
2490 {
2491 struct easycap *peasycap;
2492 struct data_buffer *pfield_buffer;
2493 char errbuf[16];
2494 int i, more, much, leap, rc, last;
2495 int videofieldamount;
2496 unsigned int override, bad;
2497 int framestatus, framelength, frameactual, frameoffset;
2498 u8 *pu;
2499
2500 if (!purb) {
2501 SAY("ERROR: easycap_complete(): purb is NULL\n");
2502 return;
2503 }
2504 peasycap = purb->context;
2505 if (!peasycap) {
2506 SAY("ERROR: easycap_complete(): peasycap is NULL\n");
2507 return;
2508 }
2509 if (peasycap->video_eof)
2510 return;
2511 for (i = 0; i < VIDEO_ISOC_BUFFER_MANY; i++)
2512 if (purb->transfer_buffer == peasycap->video_isoc_buffer[i].pgo)
2513 break;
2514 JOM(16, "%2i=urb\n", i);
2515 last = peasycap->video_isoc_sequence;
2516 if ((((VIDEO_ISOC_BUFFER_MANY - 1) == last) && (0 != i)) ||
2517 (((VIDEO_ISOC_BUFFER_MANY - 1) != last) && ((last + 1) != i))) {
2518 JOM(16, "ERROR: out-of-order urbs %i,%i ... continuing\n",
2519 last, i);
2520 }
2521 peasycap->video_isoc_sequence = i;
2522
2523 if (peasycap->video_idle) {
2524 JOM(16, "%i=video_idle %i=video_isoc_streaming\n",
2525 peasycap->video_idle, peasycap->video_isoc_streaming);
2526 if (peasycap->video_isoc_streaming) {
2527 rc = usb_submit_urb(purb, GFP_ATOMIC);
2528 if (rc) {
2529 SAM("%s:%d ENOMEM\n", strerror(rc), rc);
2530 if (-ENODEV != rc)
2531 SAM("ERROR: while %i=video_idle, "
2532 "usb_submit_urb() "
2533 "failed with rc:\n",
2534 peasycap->video_idle);
2535 }
2536 }
2537 return;
2538 }
2539 override = 0;
2540 /*---------------------------------------------------------------------------*/
2541 if (FIELD_BUFFER_MANY <= peasycap->field_fill) {
2542 SAM("ERROR: bad peasycap->field_fill\n");
2543 return;
2544 }
2545 if (purb->status) {
2546 if ((-ESHUTDOWN == purb->status) || (-ENOENT == purb->status)) {
2547 JOM(8, "urb status -ESHUTDOWN or -ENOENT\n");
2548 return;
2549 }
2550
2551 (peasycap->field_buffer[peasycap->field_fill][0].kount) |= 0x8000 ;
2552 SAM("ERROR: bad urb status -%s: %d\n",
2553 strerror(purb->status), purb->status);
2554 /*---------------------------------------------------------------------------*/
2555 } else {
2556 for (i = 0; i < purb->number_of_packets; i++) {
2557 if (0 != purb->iso_frame_desc[i].status) {
2558 (peasycap->field_buffer
2559 [peasycap->field_fill][0].kount) |= 0x8000 ;
2560 /* FIXME: 1. missing '-' check boundaries */
2561 strcpy(&errbuf[0],
2562 strerror(purb->iso_frame_desc[i].status));
2563 }
2564 framestatus = purb->iso_frame_desc[i].status;
2565 framelength = purb->iso_frame_desc[i].length;
2566 frameactual = purb->iso_frame_desc[i].actual_length;
2567 frameoffset = purb->iso_frame_desc[i].offset;
2568
2569 JOM(16, "frame[%2i]:"
2570 "%4i=status "
2571 "%4i=actual "
2572 "%4i=length "
2573 "%5i=offset\n",
2574 i, framestatus, frameactual, framelength, frameoffset);
2575 if (!purb->iso_frame_desc[i].status) {
2576 more = purb->iso_frame_desc[i].actual_length;
2577 pfield_buffer = &peasycap->field_buffer
2578 [peasycap->field_fill][peasycap->field_page];
2579 videofieldamount = (peasycap->field_page *
2580 PAGE_SIZE) +
2581 (int)(pfield_buffer->pto - pfield_buffer->pgo);
2582 if (4 == more)
2583 peasycap->video_mt++;
2584 if (4 < more) {
2585 if (peasycap->video_mt) {
2586 JOM(8, "%4i empty video urb frames\n",
2587 peasycap->video_mt);
2588 peasycap->video_mt = 0;
2589 }
2590 if (FIELD_BUFFER_MANY <= peasycap->field_fill) {
2591 SAM("ERROR: bad peasycap->field_fill\n");
2592 return;
2593 }
2594 if (FIELD_BUFFER_SIZE/PAGE_SIZE <=
2595 peasycap->field_page) {
2596 SAM("ERROR: bad peasycap->field_page\n");
2597 return;
2598 }
2599 pfield_buffer = &peasycap->field_buffer
2600 [peasycap->field_fill][peasycap->field_page];
2601 pu = (u8 *)(purb->transfer_buffer +
2602 purb->iso_frame_desc[i].offset);
2603 if (0x80 & *pu)
2604 leap = 8;
2605 else
2606 leap = 4;
2607 /*--------------------------------------------------------------------------*/
2608 /*
2609 * EIGHT-BYTE END-OF-VIDEOFIELD MARKER.
2610 * NOTE: A SUCCESSION OF URB FRAMES FOLLOWING THIS ARE EMPTY,
2611 * CORRESPONDING TO THE FIELD FLYBACK (VERTICAL BLANKING) PERIOD.
2612 *
2613 * PROVIDED THE FIELD BUFFER CONTAINS GOOD DATA AS INDICATED BY A ZERO UPPER
2614 * BYTE OF
2615 * peasycap->field_buffer[peasycap->field_fill][0].kount
2616 * THE CONTENTS OF THE FIELD BUFFER ARE OFFERED TO dqbuf(), field_read IS
2617 * UPDATED AND field_fill IS BUMPED. IF THE FIELD BUFFER CONTAINS BAD DATA
2618 * NOTHING IS OFFERED TO dqbuf().
2619 *
2620 * THE DECISION ON WHETHER THE PARITY OF THE OFFERED FIELD BUFFER IS RIGHT
2621 * RESTS WITH dqbuf().
2622 */
2623 /*---------------------------------------------------------------------------*/
2624 if ((8 == more) || override) {
2625 if (videofieldamount >
2626 peasycap->videofieldamount) {
2627 if (2 == videofieldamount -
2628 peasycap->
2629 videofieldamount) {
2630 (peasycap->field_buffer
2631 [peasycap->field_fill]
2632 [0].kount) |= 0x0100;
2633 peasycap->video_junk += (1 +
2634 VIDEO_JUNK_TOLERATE);
2635 } else
2636 (peasycap->field_buffer
2637 [peasycap->field_fill]
2638 [0].kount) |= 0x4000;
2639 } else if (videofieldamount <
2640 peasycap->
2641 videofieldamount) {
2642 (peasycap->field_buffer
2643 [peasycap->field_fill]
2644 [0].kount) |= 0x2000;
2645 }
2646 bad = 0xFF00 & peasycap->field_buffer
2647 [peasycap->field_fill]
2648 [0].kount;
2649 if (!bad) {
2650 (peasycap->video_junk)--;
2651 if (-VIDEO_JUNK_TOLERATE >
2652 peasycap->video_junk)
2653 peasycap->video_junk =
2654 -VIDEO_JUNK_TOLERATE;
2655 peasycap->field_read =
2656 (peasycap->
2657 field_fill)++;
2658 if (FIELD_BUFFER_MANY <=
2659 peasycap->
2660 field_fill)
2661 peasycap->
2662 field_fill = 0;
2663 peasycap->field_page = 0;
2664 pfield_buffer = &peasycap->
2665 field_buffer
2666 [peasycap->
2667 field_fill]
2668 [peasycap->
2669 field_page];
2670 pfield_buffer->pto =
2671 pfield_buffer->pgo;
2672 JOM(8, "bumped to: %i="
2673 "peasycap->"
2674 "field_fill %i="
2675 "parity\n",
2676 peasycap->field_fill,
2677 0x00FF &
2678 pfield_buffer->kount);
2679 JOM(8, "field buffer %i has "
2680 "%i bytes fit to be "
2681 "read\n",
2682 peasycap->field_read,
2683 videofieldamount);
2684 JOM(8, "wakeup call to "
2685 "wq_video, "
2686 "%i=field_read "
2687 "%i=field_fill "
2688 "%i=parity\n",
2689 peasycap->field_read,
2690 peasycap->field_fill,
2691 0x00FF & peasycap->
2692 field_buffer
2693 [peasycap->
2694 field_read][0].kount);
2695 wake_up_interruptible
2696 (&(peasycap->
2697 wq_video));
2698 } else {
2699 peasycap->video_junk++;
2700 if (bad & 0x0010)
2701 peasycap->video_junk +=
2702 (1 + VIDEO_JUNK_TOLERATE/2);
2703 JOM(8, "field buffer %i had %i "
2704 "bytes, now discarded: "
2705 "0x%04X\n",
2706 peasycap->field_fill,
2707 videofieldamount,
2708 (0xFF00 &
2709 peasycap->field_buffer
2710 [peasycap->field_fill][0].
2711 kount));
2712 (peasycap->field_fill)++;
2713
2714 if (FIELD_BUFFER_MANY <=
2715 peasycap->field_fill)
2716 peasycap->field_fill = 0;
2717 peasycap->field_page = 0;
2718 pfield_buffer =
2719 &peasycap->field_buffer
2720 [peasycap->field_fill]
2721 [peasycap->field_page];
2722 pfield_buffer->pto =
2723 pfield_buffer->pgo;
2724
2725 JOM(8, "bumped to: %i=peasycap->"
2726 "field_fill %i=parity\n",
2727 peasycap->field_fill,
2728 0x00FF & pfield_buffer->kount);
2729 }
2730 if (8 == more) {
2731 JOM(8, "end-of-field: received "
2732 "parity byte 0x%02X\n",
2733 (0xFF & *pu));
2734 if (0x40 & *pu)
2735 pfield_buffer->kount = 0x0000;
2736 else
2737 pfield_buffer->kount = 0x0001;
2738 pfield_buffer->input = 0x08 |
2739 (0x07 & peasycap->input);
2740 JOM(8, "end-of-field: 0x%02X=kount\n",
2741 0xFF & pfield_buffer->kount);
2742 }
2743 }
2744 /*---------------------------------------------------------------------------*/
2745 /*
2746 * COPY more BYTES FROM ISOC BUFFER TO FIELD BUFFER
2747 */
2748 /*---------------------------------------------------------------------------*/
2749 pu += leap;
2750 more -= leap;
2751
2752 if (FIELD_BUFFER_MANY <= peasycap->field_fill) {
2753 SAM("ERROR: bad peasycap->field_fill\n");
2754 return;
2755 }
2756 if (FIELD_BUFFER_SIZE/PAGE_SIZE <= peasycap->field_page) {
2757 SAM("ERROR: bad peasycap->field_page\n");
2758 return;
2759 }
2760 pfield_buffer = &peasycap->field_buffer
2761 [peasycap->field_fill][peasycap->field_page];
2762 while (more) {
2763 pfield_buffer = &peasycap->field_buffer
2764 [peasycap->field_fill]
2765 [peasycap->field_page];
2766 if (PAGE_SIZE < (pfield_buffer->pto -
2767 pfield_buffer->pgo)) {
2768 SAM("ERROR: bad pfield_buffer->pto\n");
2769 return;
2770 }
2771 if (PAGE_SIZE == (pfield_buffer->pto -
2772 pfield_buffer->pgo)) {
2773 (peasycap->field_page)++;
2774 if (FIELD_BUFFER_SIZE/PAGE_SIZE <=
2775 peasycap->field_page) {
2776 JOM(16, "wrapping peasycap->"
2777 "field_page\n");
2778 peasycap->field_page = 0;
2779 }
2780 pfield_buffer = &peasycap->
2781 field_buffer
2782 [peasycap->field_fill]
2783 [peasycap->field_page];
2784 pfield_buffer->pto = pfield_buffer->pgo;
2785 pfield_buffer->input = 0x08 |
2786 (0x07 & peasycap->input);
2787 if ((peasycap->field_buffer[peasycap->
2788 field_fill][0]).
2789 input !=
2790 pfield_buffer->input)
2791 (peasycap->field_buffer
2792 [peasycap->field_fill]
2793 [0]).kount |= 0x1000;
2794 }
2795
2796 much = PAGE_SIZE -
2797 (int)(pfield_buffer->pto -
2798 pfield_buffer->pgo);
2799
2800 if (much > more)
2801 much = more;
2802 memcpy(pfield_buffer->pto, pu, much);
2803 pu += much;
2804 (pfield_buffer->pto) += much;
2805 more -= much;
2806 }
2807 }
2808 }
2809 }
2810 }
2811 /*---------------------------------------------------------------------------*/
2812 /*
2813 * RESUBMIT THIS URB, UNLESS A SEVERE PERSISTENT ERROR CONDITION EXISTS.
2814 *
2815 * IF THE WAIT QUEUES ARE NOT CLEARED IN RESPONSE TO AN ERROR CONDITION
2816 * THE USERSPACE PROGRAM, E.G. mplayer, MAY HANG ON EXIT. BEWARE.
2817 */
2818 /*---------------------------------------------------------------------------*/
2819 if (VIDEO_ISOC_BUFFER_MANY <= peasycap->video_junk) {
2820 SAM("easycap driver shutting down on condition green\n");
2821 peasycap->status = 1;
2822 peasycap->video_eof = 1;
2823 peasycap->video_junk = 0;
2824 wake_up_interruptible(&peasycap->wq_video);
2825 #if !defined(PERSEVERE)
2826 peasycap->audio_eof = 1;
2827 wake_up_interruptible(&peasycap->wq_audio);
2828 #endif /*PERSEVERE*/
2829 return;
2830 }
2831 if (peasycap->video_isoc_streaming) {
2832 rc = usb_submit_urb(purb, GFP_ATOMIC);
2833 if (rc) {
2834 SAM("%s: %d\n", strerror(rc), rc);
2835 if (-ENODEV != rc)
2836 SAM("ERROR: while %i=video_idle, "
2837 "usb_submit_urb() "
2838 "failed with rc:\n",
2839 peasycap->video_idle);
2840 }
2841 }
2842 return;
2843 }
2844
2845 static const struct v4l2_file_operations v4l2_fops = {
2846 .owner = THIS_MODULE,
2847 .open = easycap_open_noinode,
2848 .unlocked_ioctl = easycap_unlocked_ioctl,
2849 .poll = easycap_poll,
2850 .mmap = easycap_mmap,
2851 };
2852
2853 /*
2854 * When the device is plugged, this function is called three times,
2855 * one for each interface.
2856 */
easycap_usb_probe(struct usb_interface * intf,const struct usb_device_id * id)2857 static int easycap_usb_probe(struct usb_interface *intf,
2858 const struct usb_device_id *id)
2859 {
2860 struct usb_device *usbdev;
2861 struct usb_host_interface *alt;
2862 struct usb_endpoint_descriptor *ep;
2863 struct usb_interface_descriptor *interface;
2864 struct urb *purb;
2865 struct easycap *peasycap;
2866 int ndong;
2867 struct data_urb *pdata_urb;
2868 int i, j, k, m, rc;
2869 u8 bInterfaceNumber;
2870 u8 bInterfaceClass;
2871 u8 bInterfaceSubClass;
2872 void *pbuf;
2873 int okalt[8], isokalt;
2874 int okepn[8];
2875 int okmps[8];
2876 int maxpacketsize;
2877 u16 mask;
2878 s32 value;
2879 struct easycap_format *peasycap_format;
2880 int fmtidx;
2881 struct inputset *inputset;
2882
2883 usbdev = interface_to_usbdev(intf);
2884
2885 alt = usb_altnum_to_altsetting(intf, 0);
2886 if (!alt) {
2887 SAY("ERROR: usb_host_interface not found\n");
2888 return -EFAULT;
2889 }
2890
2891 interface = &alt->desc;
2892 if (!interface) {
2893 SAY("ERROR: intf_descriptor is NULL\n");
2894 return -EFAULT;
2895 }
2896
2897 /* Get properties of probed interface */
2898 bInterfaceNumber = interface->bInterfaceNumber;
2899 bInterfaceClass = interface->bInterfaceClass;
2900 bInterfaceSubClass = interface->bInterfaceSubClass;
2901
2902 JOT(4, "intf[%i]: num_altsetting=%i\n",
2903 bInterfaceNumber, intf->num_altsetting);
2904 JOT(4, "intf[%i]: cur_altsetting - altsetting=%li\n",
2905 bInterfaceNumber,
2906 (long int)(intf->cur_altsetting - intf->altsetting));
2907 JOT(4, "intf[%i]: bInterfaceClass=0x%02X bInterfaceSubClass=0x%02X\n",
2908 bInterfaceNumber, bInterfaceClass, bInterfaceSubClass);
2909
2910 /*
2911 * A new struct easycap is always allocated when interface 0 is probed.
2912 * It is not possible here to free any existing struct easycap.
2913 * This should have been done by easycap_delete() when the device was
2914 * physically unplugged.
2915 * The allocated struct easycap is saved for later usage when
2916 * interfaces 1 and 2 are probed.
2917 */
2918 if (0 == bInterfaceNumber) {
2919 peasycap = kzalloc(sizeof(struct easycap), GFP_KERNEL);
2920 if (!peasycap) {
2921 SAY("ERROR: Could not allocate peasycap\n");
2922 return -ENOMEM;
2923 }
2924
2925 /* Perform urgent initializations */
2926 peasycap->minor = -1;
2927 kref_init(&peasycap->kref);
2928 JOM(8, "intf[%i]: after kref_init(..._video) "
2929 "%i=peasycap->kref.refcount.counter\n",
2930 bInterfaceNumber, peasycap->kref.refcount.counter);
2931
2932 /* module params */
2933 peasycap->gain = (s8)clamp(easycap_gain, 0, 31);
2934
2935 init_waitqueue_head(&peasycap->wq_video);
2936 init_waitqueue_head(&peasycap->wq_audio);
2937 init_waitqueue_head(&peasycap->wq_trigger);
2938
2939 if (mutex_lock_interruptible(&mutex_dongle)) {
2940 SAY("ERROR: cannot down mutex_dongle\n");
2941 return -ERESTARTSYS;
2942 }
2943
2944 for (ndong = 0; ndong < DONGLE_MANY; ndong++) {
2945 if ((!easycapdc60_dongle[ndong].peasycap) &&
2946 (!mutex_is_locked(&easycapdc60_dongle
2947 [ndong].mutex_video)) &&
2948 (!mutex_is_locked(&easycapdc60_dongle
2949 [ndong].mutex_audio))) {
2950 easycapdc60_dongle[ndong].peasycap = peasycap;
2951 peasycap->isdongle = ndong;
2952 JOM(8, "intf[%i]: peasycap-->easycap"
2953 "_dongle[%i].peasycap\n",
2954 bInterfaceNumber, ndong);
2955 break;
2956 }
2957 }
2958
2959 if (DONGLE_MANY <= ndong) {
2960 SAM("ERROR: too many dongles\n");
2961 mutex_unlock(&mutex_dongle);
2962 return -ENOMEM;
2963 }
2964 mutex_unlock(&mutex_dongle);
2965
2966 peasycap->allocation_video_struct = sizeof(struct easycap);
2967
2968 /* and further initialize the structure */
2969 peasycap->pusb_device = usbdev;
2970 peasycap->pusb_interface = intf;
2971
2972 peasycap->microphone = false;
2973
2974 peasycap->video_interface = -1;
2975 peasycap->video_altsetting_on = -1;
2976 peasycap->video_altsetting_off = -1;
2977 peasycap->video_endpointnumber = -1;
2978 peasycap->video_isoc_maxframesize = -1;
2979 peasycap->video_isoc_buffer_size = -1;
2980
2981 peasycap->audio_interface = -1;
2982 peasycap->audio_altsetting_on = -1;
2983 peasycap->audio_altsetting_off = -1;
2984 peasycap->audio_endpointnumber = -1;
2985 peasycap->audio_isoc_maxframesize = -1;
2986 peasycap->audio_isoc_buffer_size = -1;
2987
2988 peasycap->frame_buffer_many = FRAME_BUFFER_MANY;
2989
2990 /* Dynamically fill in the available formats */
2991 rc = easycap_video_fillin_formats();
2992 if (0 > rc) {
2993 SAM("ERROR: fillin_formats() rc = %i\n", rc);
2994 return -EFAULT;
2995 }
2996 JOM(4, "%i formats available\n", rc);
2997
2998 /* Populate easycap.inputset[] */
2999 inputset = peasycap->inputset;
3000 fmtidx = peasycap->ntsc ? NTSC_M : PAL_BGHIN;
3001 m = 0;
3002 mask = 0;
3003 for (i = 0; 0xFFFF != easycap_standard[i].mask; i++) {
3004 if (fmtidx == easycap_standard[i].v4l2_standard.index) {
3005 m++;
3006 for (k = 0; k < INPUT_MANY; k++)
3007 inputset[k].standard_offset = i;
3008
3009 mask = easycap_standard[i].mask;
3010 }
3011 }
3012 if (1 != m) {
3013 SAM("ERROR: "
3014 "inputset->standard_offset unpopulated, %i=m\n", m);
3015 return -ENOENT;
3016 }
3017
3018 peasycap_format = &easycap_format[0];
3019 m = 0;
3020 for (i = 0; peasycap_format->v4l2_format.fmt.pix.width; i++) {
3021 struct v4l2_pix_format *pix =
3022 &peasycap_format->v4l2_format.fmt.pix;
3023 if (((peasycap_format->mask & 0x0F) == (mask & 0x0F)) &&
3024 pix->field == V4L2_FIELD_NONE &&
3025 pix->pixelformat == V4L2_PIX_FMT_UYVY &&
3026 pix->width == 640 && pix->height == 480) {
3027 m++;
3028 for (k = 0; k < INPUT_MANY; k++)
3029 inputset[k].format_offset = i;
3030 break;
3031 }
3032 peasycap_format++;
3033 }
3034 if (1 != m) {
3035 SAM("ERROR: inputset[]->format_offset unpopulated\n");
3036 return -ENOENT;
3037 }
3038
3039 m = 0;
3040 for (i = 0; 0xFFFFFFFF != easycap_control[i].id; i++) {
3041 value = easycap_control[i].default_value;
3042 if (V4L2_CID_BRIGHTNESS == easycap_control[i].id) {
3043 m++;
3044 for (k = 0; k < INPUT_MANY; k++)
3045 inputset[k].brightness = value;
3046 } else if (V4L2_CID_CONTRAST == easycap_control[i].id) {
3047 m++;
3048 for (k = 0; k < INPUT_MANY; k++)
3049 inputset[k].contrast = value;
3050 } else if (V4L2_CID_SATURATION == easycap_control[i].id) {
3051 m++;
3052 for (k = 0; k < INPUT_MANY; k++)
3053 inputset[k].saturation = value;
3054 } else if (V4L2_CID_HUE == easycap_control[i].id) {
3055 m++;
3056 for (k = 0; k < INPUT_MANY; k++)
3057 inputset[k].hue = value;
3058 }
3059 }
3060
3061 if (4 != m) {
3062 SAM("ERROR: inputset[]->brightness underpopulated\n");
3063 return -ENOENT;
3064 }
3065 for (k = 0; k < INPUT_MANY; k++)
3066 inputset[k].input = k;
3067 JOM(4, "populated inputset[]\n");
3068 JOM(4, "finished initialization\n");
3069 } else {
3070
3071 /*
3072 * FIXME: Identify the appropriate pointer
3073 * peasycap for interfaces 1 and 2.
3074 * The address of peasycap->pusb_device
3075 * is reluctantly used for this purpose.
3076 */
3077 for (ndong = 0; ndong < DONGLE_MANY; ndong++) {
3078 if (usbdev == easycapdc60_dongle[ndong].peasycap->
3079 pusb_device) {
3080 peasycap = easycapdc60_dongle[ndong].peasycap;
3081 JOT(8, "intf[%i]: dongle[%i].peasycap\n",
3082 bInterfaceNumber, ndong);
3083 break;
3084 }
3085 }
3086 if (DONGLE_MANY <= ndong) {
3087 SAY("ERROR: peasycap is unknown when probing interface %i\n",
3088 bInterfaceNumber);
3089 return -ENODEV;
3090 }
3091 if (!peasycap) {
3092 SAY("ERROR: peasycap is NULL when probing interface %i\n",
3093 bInterfaceNumber);
3094 return -ENODEV;
3095 }
3096 }
3097
3098 if ((USB_CLASS_VIDEO == bInterfaceClass) ||
3099 (USB_CLASS_VENDOR_SPEC == bInterfaceClass)) {
3100 if (-1 == peasycap->video_interface) {
3101 peasycap->video_interface = bInterfaceNumber;
3102 JOM(4, "setting peasycap->video_interface=%i\n",
3103 peasycap->video_interface);
3104 } else {
3105 if (peasycap->video_interface != bInterfaceNumber) {
3106 SAM("ERROR: attempting to reset "
3107 "peasycap->video_interface\n");
3108 SAM("...... continuing with "
3109 "%i=peasycap->video_interface\n",
3110 peasycap->video_interface);
3111 }
3112 }
3113 } else if ((USB_CLASS_AUDIO == bInterfaceClass) &&
3114 (USB_SUBCLASS_AUDIOSTREAMING == bInterfaceSubClass)) {
3115 if (-1 == peasycap->audio_interface) {
3116 peasycap->audio_interface = bInterfaceNumber;
3117 JOM(4, "setting peasycap->audio_interface=%i\n",
3118 peasycap->audio_interface);
3119 } else {
3120 if (peasycap->audio_interface != bInterfaceNumber) {
3121 SAM("ERROR: attempting to reset "
3122 "peasycap->audio_interface\n");
3123 SAM("...... continuing with "
3124 "%i=peasycap->audio_interface\n",
3125 peasycap->audio_interface);
3126 }
3127 }
3128 }
3129
3130 /*
3131 * Investigate all altsettings. This is done in detail
3132 * because USB device 05e1:0408 has disparate incarnations.
3133 */
3134 isokalt = 0;
3135 for (i = 0; i < intf->num_altsetting; i++) {
3136 alt = usb_altnum_to_altsetting(intf, i);
3137 if (!alt) {
3138 SAM("ERROR: alt is NULL\n");
3139 return -EFAULT;
3140 }
3141 interface = &alt->desc;
3142 if (!interface) {
3143 SAM("ERROR: intf_descriptor is NULL\n");
3144 return -EFAULT;
3145 }
3146
3147 if (0 == interface->bNumEndpoints)
3148 JOM(4, "intf[%i]alt[%i] has no endpoints\n",
3149 bInterfaceNumber, i);
3150 for (j = 0; j < interface->bNumEndpoints; j++) {
3151 ep = &alt->endpoint[j].desc;
3152 if (!ep) {
3153 SAM("ERROR: ep is NULL.\n");
3154 SAM("...... skipping\n");
3155 continue;
3156 }
3157
3158 if (!usb_endpoint_is_isoc_in(ep)) {
3159 JOM(4, "intf[%i]alt[%i]end[%i] is a %d endpoint\n",
3160 bInterfaceNumber,
3161 i, j, ep->bmAttributes);
3162 if (usb_endpoint_dir_out(ep)) {
3163 SAM("ERROR: OUT endpoint unexpected\n");
3164 SAM("...... continuing\n");
3165 }
3166 continue;
3167 }
3168 switch (bInterfaceClass) {
3169 case USB_CLASS_VIDEO:
3170 case USB_CLASS_VENDOR_SPEC: {
3171 if (ep->wMaxPacketSize) {
3172 if (8 > isokalt) {
3173 okalt[isokalt] = i;
3174 JOM(4,
3175 "%i=okalt[%i]\n",
3176 okalt[isokalt],
3177 isokalt);
3178 okepn[isokalt] =
3179 ep->
3180 bEndpointAddress &
3181 0x0F;
3182 JOM(4,
3183 "%i=okepn[%i]\n",
3184 okepn[isokalt],
3185 isokalt);
3186 okmps[isokalt] =
3187 le16_to_cpu(ep->
3188 wMaxPacketSize);
3189 JOM(4,
3190 "%i=okmps[%i]\n",
3191 okmps[isokalt],
3192 isokalt);
3193 isokalt++;
3194 }
3195 } else {
3196 if (-1 == peasycap->
3197 video_altsetting_off) {
3198 peasycap->
3199 video_altsetting_off =
3200 i;
3201 JOM(4, "%i=video_"
3202 "altsetting_off "
3203 "<====\n",
3204 peasycap->
3205 video_altsetting_off);
3206 } else {
3207 SAM("ERROR: peasycap"
3208 "->video_altsetting_"
3209 "off already set\n");
3210 SAM("...... "
3211 "continuing with "
3212 "%i=peasycap->video_"
3213 "altsetting_off\n",
3214 peasycap->
3215 video_altsetting_off);
3216 }
3217 }
3218 break;
3219 }
3220 case USB_CLASS_AUDIO: {
3221 if (bInterfaceSubClass !=
3222 USB_SUBCLASS_AUDIOSTREAMING)
3223 break;
3224 if (!peasycap) {
3225 SAM("MISTAKE: "
3226 "peasycap is NULL\n");
3227 return -EFAULT;
3228 }
3229 if (ep->wMaxPacketSize) {
3230 if (8 > isokalt) {
3231 okalt[isokalt] = i ;
3232 JOM(4,
3233 "%i=okalt[%i]\n",
3234 okalt[isokalt],
3235 isokalt);
3236 okepn[isokalt] =
3237 ep->
3238 bEndpointAddress &
3239 0x0F;
3240 JOM(4,
3241 "%i=okepn[%i]\n",
3242 okepn[isokalt],
3243 isokalt);
3244 okmps[isokalt] =
3245 le16_to_cpu(ep->
3246 wMaxPacketSize);
3247 JOM(4,
3248 "%i=okmps[%i]\n",
3249 okmps[isokalt],
3250 isokalt);
3251 isokalt++;
3252 }
3253 } else {
3254 if (-1 == peasycap->
3255 audio_altsetting_off) {
3256 peasycap->
3257 audio_altsetting_off =
3258 i;
3259 JOM(4, "%i=audio_"
3260 "altsetting_off "
3261 "<====\n",
3262 peasycap->
3263 audio_altsetting_off);
3264 } else {
3265 SAM("ERROR: peasycap"
3266 "->audio_altsetting_"
3267 "off already set\n");
3268 SAM("...... "
3269 "continuing with "
3270 "%i=peasycap->"
3271 "audio_altsetting_"
3272 "off\n",
3273 peasycap->
3274 audio_altsetting_off);
3275 }
3276 }
3277 break;
3278 }
3279 default:
3280 break;
3281 }
3282 if (0 == ep->wMaxPacketSize) {
3283 JOM(4, "intf[%i]alt[%i]end[%i] "
3284 "has zero packet size\n",
3285 bInterfaceNumber, i, j);
3286 }
3287 }
3288 }
3289
3290 /* Perform initialization of the probed interface */
3291 JOM(4, "initialization begins for interface %i\n",
3292 interface->bInterfaceNumber);
3293 switch (bInterfaceNumber) {
3294 /* 0: Video interface */
3295 case 0: {
3296 if (!peasycap) {
3297 SAM("MISTAKE: peasycap is NULL\n");
3298 return -EFAULT;
3299 }
3300 if (!isokalt) {
3301 SAM("ERROR: no viable video_altsetting_on\n");
3302 return -ENOENT;
3303 }
3304 peasycap->video_altsetting_on = okalt[isokalt - 1];
3305 JOM(4, "%i=video_altsetting_on <====\n",
3306 peasycap->video_altsetting_on);
3307
3308 /* Decide video streaming parameters */
3309 peasycap->video_endpointnumber = okepn[isokalt - 1];
3310 JOM(4, "%i=video_endpointnumber\n", peasycap->video_endpointnumber);
3311 maxpacketsize = okmps[isokalt - 1];
3312
3313 peasycap->video_isoc_maxframesize =
3314 min(maxpacketsize, USB_2_0_MAXPACKETSIZE);
3315 if (0 >= peasycap->video_isoc_maxframesize) {
3316 SAM("ERROR: bad video_isoc_maxframesize\n");
3317 SAM(" possibly because port is USB 1.1\n");
3318 return -ENOENT;
3319 }
3320 JOM(4, "%i=video_isoc_maxframesize\n",
3321 peasycap->video_isoc_maxframesize);
3322
3323 peasycap->video_isoc_framesperdesc = VIDEO_ISOC_FRAMESPERDESC;
3324 JOM(4, "%i=video_isoc_framesperdesc\n",
3325 peasycap->video_isoc_framesperdesc);
3326 if (0 >= peasycap->video_isoc_framesperdesc) {
3327 SAM("ERROR: bad video_isoc_framesperdesc\n");
3328 return -ENOENT;
3329 }
3330 peasycap->video_isoc_buffer_size =
3331 peasycap->video_isoc_maxframesize *
3332 peasycap->video_isoc_framesperdesc;
3333 JOM(4, "%i=video_isoc_buffer_size\n",
3334 peasycap->video_isoc_buffer_size);
3335 if ((PAGE_SIZE << VIDEO_ISOC_ORDER) <
3336 peasycap->video_isoc_buffer_size) {
3337 SAM("MISTAKE: peasycap->video_isoc_buffer_size too big\n");
3338 return -EFAULT;
3339 }
3340 if (-1 == peasycap->video_interface) {
3341 SAM("MISTAKE: video_interface is unset\n");
3342 return -EFAULT;
3343 }
3344 if (-1 == peasycap->video_altsetting_on) {
3345 SAM("MISTAKE: video_altsetting_on is unset\n");
3346 return -EFAULT;
3347 }
3348 if (-1 == peasycap->video_altsetting_off) {
3349 SAM("MISTAKE: video_interface_off is unset\n");
3350 return -EFAULT;
3351 }
3352 if (-1 == peasycap->video_endpointnumber) {
3353 SAM("MISTAKE: video_endpointnumber is unset\n");
3354 return -EFAULT;
3355 }
3356 if (-1 == peasycap->video_isoc_maxframesize) {
3357 SAM("MISTAKE: video_isoc_maxframesize is unset\n");
3358 return -EFAULT;
3359 }
3360 if (-1 == peasycap->video_isoc_buffer_size) {
3361 SAM("MISTAKE: video_isoc_buffer_size is unset\n");
3362 return -EFAULT;
3363 }
3364
3365 /*
3366 * Allocate memory for video buffers.
3367 * Lists must be initialized first.
3368 */
3369 INIT_LIST_HEAD(&(peasycap->urb_video_head));
3370 peasycap->purb_video_head = &(peasycap->urb_video_head);
3371 JOM(4, "allocating %i frame buffers of size %li\n",
3372 FRAME_BUFFER_MANY, (long int)FRAME_BUFFER_SIZE);
3373 JOM(4, ".... each scattered over %li pages\n",
3374 FRAME_BUFFER_SIZE/PAGE_SIZE);
3375
3376 for (k = 0; k < FRAME_BUFFER_MANY; k++) {
3377 for (m = 0; m < FRAME_BUFFER_SIZE/PAGE_SIZE; m++) {
3378 if (peasycap->frame_buffer[k][m].pgo)
3379 SAM("attempting to reallocate frame "
3380 " buffers\n");
3381 else {
3382 pbuf = (void *)__get_free_page(GFP_KERNEL);
3383 if (!pbuf) {
3384 SAM("ERROR: Could not allocate frame "
3385 "buffer %i page %i\n", k, m);
3386 return -ENOMEM;
3387 }
3388
3389 peasycap->allocation_video_page += 1;
3390 peasycap->frame_buffer[k][m].pgo = pbuf;
3391 }
3392 peasycap->frame_buffer[k][m].pto =
3393 peasycap->frame_buffer[k][m].pgo;
3394 }
3395 }
3396
3397 peasycap->frame_fill = 0;
3398 peasycap->frame_read = 0;
3399 JOM(4, "allocation of frame buffers done: %i pages\n", k *
3400 m);
3401 JOM(4, "allocating %i field buffers of size %li\n",
3402 FIELD_BUFFER_MANY, (long int)FIELD_BUFFER_SIZE);
3403 JOM(4, ".... each scattered over %li pages\n",
3404 FIELD_BUFFER_SIZE/PAGE_SIZE);
3405
3406 for (k = 0; k < FIELD_BUFFER_MANY; k++) {
3407 for (m = 0; m < FIELD_BUFFER_SIZE/PAGE_SIZE; m++) {
3408 if (peasycap->field_buffer[k][m].pgo) {
3409 SAM("ERROR: attempting to reallocate "
3410 "field buffers\n");
3411 } else {
3412 pbuf = (void *) __get_free_page(GFP_KERNEL);
3413 if (!pbuf) {
3414 SAM("ERROR: Could not allocate field"
3415 " buffer %i page %i\n", k, m);
3416 return -ENOMEM;
3417 }
3418
3419 peasycap->allocation_video_page += 1;
3420 peasycap->field_buffer[k][m].pgo = pbuf;
3421 }
3422 peasycap->field_buffer[k][m].pto =
3423 peasycap->field_buffer[k][m].pgo;
3424 }
3425 peasycap->field_buffer[k][0].kount = 0x0200;
3426 }
3427 peasycap->field_fill = 0;
3428 peasycap->field_page = 0;
3429 peasycap->field_read = 0;
3430 JOM(4, "allocation of field buffers done: %i pages\n", k *
3431 m);
3432 JOM(4, "allocating %i isoc video buffers of size %i\n",
3433 VIDEO_ISOC_BUFFER_MANY,
3434 peasycap->video_isoc_buffer_size);
3435 JOM(4, ".... each occupying contiguous memory pages\n");
3436
3437 for (k = 0; k < VIDEO_ISOC_BUFFER_MANY; k++) {
3438 pbuf = (void *)__get_free_pages(GFP_KERNEL,
3439 VIDEO_ISOC_ORDER);
3440 if (!pbuf) {
3441 SAM("ERROR: Could not allocate isoc video buffer "
3442 "%i\n", k);
3443 return -ENOMEM;
3444 }
3445 peasycap->allocation_video_page +=
3446 BIT(VIDEO_ISOC_ORDER);
3447
3448 peasycap->video_isoc_buffer[k].pgo = pbuf;
3449 peasycap->video_isoc_buffer[k].pto =
3450 pbuf + peasycap->video_isoc_buffer_size;
3451 peasycap->video_isoc_buffer[k].kount = k;
3452 }
3453 JOM(4, "allocation of isoc video buffers done: %i pages\n",
3454 k * (0x01 << VIDEO_ISOC_ORDER));
3455
3456 /* Allocate and initialize multiple struct usb */
3457 JOM(4, "allocating %i struct urb.\n", VIDEO_ISOC_BUFFER_MANY);
3458 JOM(4, "using %i=peasycap->video_isoc_framesperdesc\n",
3459 peasycap->video_isoc_framesperdesc);
3460 JOM(4, "using %i=peasycap->video_isoc_maxframesize\n",
3461 peasycap->video_isoc_maxframesize);
3462 JOM(4, "using %i=peasycap->video_isoc_buffer_sizen",
3463 peasycap->video_isoc_buffer_size);
3464
3465 for (k = 0; k < VIDEO_ISOC_BUFFER_MANY; k++) {
3466 purb = usb_alloc_urb(peasycap->video_isoc_framesperdesc,
3467 GFP_KERNEL);
3468 if (!purb) {
3469 SAM("ERROR: usb_alloc_urb returned NULL for buffer "
3470 "%i\n", k);
3471 return -ENOMEM;
3472 }
3473
3474 peasycap->allocation_video_urb += 1;
3475 pdata_urb = kzalloc(sizeof(struct data_urb), GFP_KERNEL);
3476 if (!pdata_urb) {
3477 SAM("ERROR: Could not allocate struct data_urb.\n");
3478 return -ENOMEM;
3479 }
3480
3481 peasycap->allocation_video_struct +=
3482 sizeof(struct data_urb);
3483
3484 pdata_urb->purb = purb;
3485 pdata_urb->isbuf = k;
3486 pdata_urb->length = 0;
3487 list_add_tail(&(pdata_urb->list_head),
3488 peasycap->purb_video_head);
3489
3490 /* Initialize allocated urbs */
3491 if (!k) {
3492 JOM(4, "initializing video urbs thus:\n");
3493 JOM(4, " purb->interval = 1;\n");
3494 JOM(4, " purb->dev = peasycap->pusb_device;\n");
3495 JOM(4, " purb->pipe = usb_rcvisocpipe"
3496 "(peasycap->pusb_device,%i);\n",
3497 peasycap->video_endpointnumber);
3498 JOM(4, " purb->transfer_flags = URB_ISO_ASAP;\n");
3499 JOM(4, " purb->transfer_buffer = peasycap->"
3500 "video_isoc_buffer[.].pgo;\n");
3501 JOM(4, " purb->transfer_buffer_length = %i;\n",
3502 peasycap->video_isoc_buffer_size);
3503 JOM(4, " purb->complete = easycap_complete;\n");
3504 JOM(4, " purb->context = peasycap;\n");
3505 JOM(4, " purb->start_frame = 0;\n");
3506 JOM(4, " purb->number_of_packets = %i;\n",
3507 peasycap->video_isoc_framesperdesc);
3508 JOM(4, " for (j = 0; j < %i; j++)\n",
3509 peasycap->video_isoc_framesperdesc);
3510 JOM(4, " {\n");
3511 JOM(4, " purb->iso_frame_desc[j].offset = j*%i;\n",
3512 peasycap->video_isoc_maxframesize);
3513 JOM(4, " purb->iso_frame_desc[j].length = %i;\n",
3514 peasycap->video_isoc_maxframesize);
3515 JOM(4, " }\n");
3516 }
3517
3518 purb->interval = 1;
3519 purb->dev = peasycap->pusb_device;
3520 purb->pipe = usb_rcvisocpipe(peasycap->pusb_device,
3521 peasycap->video_endpointnumber);
3522 purb->transfer_flags = URB_ISO_ASAP;
3523 purb->transfer_buffer = peasycap->video_isoc_buffer[k].pgo;
3524 purb->transfer_buffer_length =
3525 peasycap->video_isoc_buffer_size;
3526 purb->complete = easycap_complete;
3527 purb->context = peasycap;
3528 purb->start_frame = 0;
3529 purb->number_of_packets = peasycap->video_isoc_framesperdesc;
3530 for (j = 0; j < peasycap->video_isoc_framesperdesc; j++) {
3531 purb->iso_frame_desc[j].offset = j *
3532 peasycap->video_isoc_maxframesize;
3533 purb->iso_frame_desc[j].length =
3534 peasycap->video_isoc_maxframesize;
3535 }
3536 }
3537 JOM(4, "allocation of %i struct urb done.\n", k);
3538
3539 /* Save pointer peasycap in this interface */
3540 usb_set_intfdata(intf, peasycap);
3541
3542 /*
3543 * It is essential to initialize the hardware before,
3544 * rather than after, the device is registered,
3545 * because some udev rules triggers easycap_open()
3546 * immediately after registration, causing a clash.
3547 */
3548 peasycap->ntsc = easycap_ntsc;
3549 JOM(8, "defaulting initially to %s\n",
3550 easycap_ntsc ? "NTSC" : "PAL");
3551 rc = reset(peasycap);
3552 if (rc) {
3553 SAM("ERROR: reset() rc = %i\n", rc);
3554 return -EFAULT;
3555 }
3556
3557 /* The video device can now be registered */
3558 if (v4l2_device_register(&intf->dev, &peasycap->v4l2_device)) {
3559 SAM("v4l2_device_register() failed\n");
3560 return -ENODEV;
3561 }
3562 JOM(4, "registered device instance: %s\n",
3563 peasycap->v4l2_device.name);
3564
3565 /*
3566 * FIXME: This is believed to be harmless,
3567 * but may well be unnecessary or wrong.
3568 */
3569 peasycap->video_device.v4l2_dev = NULL;
3570
3571
3572 strcpy(&peasycap->video_device.name[0], "easycapdc60");
3573 peasycap->video_device.fops = &v4l2_fops;
3574 peasycap->video_device.minor = -1;
3575 peasycap->video_device.release = (void *)(&videodev_release);
3576
3577 video_set_drvdata(&(peasycap->video_device), (void *)peasycap);
3578
3579 if (0 != (video_register_device(&(peasycap->video_device),
3580 VFL_TYPE_GRABBER, -1))) {
3581 err("Not able to register with videodev");
3582 videodev_release(&(peasycap->video_device));
3583 return -ENODEV;
3584 }
3585
3586 peasycap->registered_video++;
3587 SAM("registered with videodev: %i=minor\n",
3588 peasycap->video_device.minor);
3589 peasycap->minor = peasycap->video_device.minor;
3590
3591 break;
3592 }
3593 /* 1: Audio control */
3594 case 1: {
3595 if (!peasycap) {
3596 SAM("MISTAKE: peasycap is NULL\n");
3597 return -EFAULT;
3598 }
3599 /* Save pointer peasycap in this interface */
3600 usb_set_intfdata(intf, peasycap);
3601 JOM(4, "no initialization required for interface %i\n",
3602 interface->bInterfaceNumber);
3603 break;
3604 }
3605 /* 2: Audio streaming */
3606 case 2: {
3607 if (!peasycap) {
3608 SAM("MISTAKE: peasycap is NULL\n");
3609 return -EFAULT;
3610 }
3611 if (!isokalt) {
3612 SAM("ERROR: no viable audio_altsetting_on\n");
3613 return -ENOENT;
3614 }
3615 peasycap->audio_altsetting_on = okalt[isokalt - 1];
3616 JOM(4, "%i=audio_altsetting_on <====\n",
3617 peasycap->audio_altsetting_on);
3618
3619 peasycap->audio_endpointnumber = okepn[isokalt - 1];
3620 JOM(4, "%i=audio_endpointnumber\n", peasycap->audio_endpointnumber);
3621
3622 peasycap->audio_isoc_maxframesize = okmps[isokalt - 1];
3623 JOM(4, "%i=audio_isoc_maxframesize\n",
3624 peasycap->audio_isoc_maxframesize);
3625 if (0 >= peasycap->audio_isoc_maxframesize) {
3626 SAM("ERROR: bad audio_isoc_maxframesize\n");
3627 return -ENOENT;
3628 }
3629 if (9 == peasycap->audio_isoc_maxframesize) {
3630 peasycap->ilk |= 0x02;
3631 SAM("audio hardware is microphone\n");
3632 peasycap->microphone = true;
3633 peasycap->audio_pages_per_fragment =
3634 PAGES_PER_AUDIO_FRAGMENT;
3635 } else if (256 == peasycap->audio_isoc_maxframesize) {
3636 peasycap->ilk &= ~0x02;
3637 SAM("audio hardware is AC'97\n");
3638 peasycap->microphone = false;
3639 peasycap->audio_pages_per_fragment =
3640 PAGES_PER_AUDIO_FRAGMENT;
3641 } else {
3642 SAM("hardware is unidentified:\n");
3643 SAM("%i=audio_isoc_maxframesize\n",
3644 peasycap->audio_isoc_maxframesize);
3645 return -ENOENT;
3646 }
3647
3648 peasycap->audio_bytes_per_fragment =
3649 peasycap->audio_pages_per_fragment * PAGE_SIZE;
3650 peasycap->audio_buffer_page_many = (AUDIO_FRAGMENT_MANY *
3651 peasycap->audio_pages_per_fragment);
3652
3653 JOM(4, "%6i=AUDIO_FRAGMENT_MANY\n", AUDIO_FRAGMENT_MANY);
3654 JOM(4, "%6i=audio_pages_per_fragment\n",
3655 peasycap->audio_pages_per_fragment);
3656 JOM(4, "%6i=audio_bytes_per_fragment\n",
3657 peasycap->audio_bytes_per_fragment);
3658 JOM(4, "%6i=audio_buffer_page_many\n",
3659 peasycap->audio_buffer_page_many);
3660
3661 peasycap->audio_isoc_framesperdesc = AUDIO_ISOC_FRAMESPERDESC;
3662
3663 JOM(4, "%i=audio_isoc_framesperdesc\n",
3664 peasycap->audio_isoc_framesperdesc);
3665 if (0 >= peasycap->audio_isoc_framesperdesc) {
3666 SAM("ERROR: bad audio_isoc_framesperdesc\n");
3667 return -ENOENT;
3668 }
3669
3670 peasycap->audio_isoc_buffer_size =
3671 peasycap->audio_isoc_maxframesize *
3672 peasycap->audio_isoc_framesperdesc;
3673 JOM(4, "%i=audio_isoc_buffer_size\n",
3674 peasycap->audio_isoc_buffer_size);
3675 if (AUDIO_ISOC_BUFFER_SIZE < peasycap->audio_isoc_buffer_size) {
3676 SAM("MISTAKE: audio_isoc_buffer_size bigger "
3677 "than %li=AUDIO_ISOC_BUFFER_SIZE\n",
3678 AUDIO_ISOC_BUFFER_SIZE);
3679 return -EFAULT;
3680 }
3681 if (-1 == peasycap->audio_interface) {
3682 SAM("MISTAKE: audio_interface is unset\n");
3683 return -EFAULT;
3684 }
3685 if (-1 == peasycap->audio_altsetting_on) {
3686 SAM("MISTAKE: audio_altsetting_on is unset\n");
3687 return -EFAULT;
3688 }
3689 if (-1 == peasycap->audio_altsetting_off) {
3690 SAM("MISTAKE: audio_interface_off is unset\n");
3691 return -EFAULT;
3692 }
3693 if (-1 == peasycap->audio_endpointnumber) {
3694 SAM("MISTAKE: audio_endpointnumber is unset\n");
3695 return -EFAULT;
3696 }
3697 if (-1 == peasycap->audio_isoc_maxframesize) {
3698 SAM("MISTAKE: audio_isoc_maxframesize is unset\n");
3699 return -EFAULT;
3700 }
3701 if (-1 == peasycap->audio_isoc_buffer_size) {
3702 SAM("MISTAKE: audio_isoc_buffer_size is unset\n");
3703 return -EFAULT;
3704 }
3705
3706 /*
3707 * Allocate memory for audio buffers.
3708 * Lists must be initialized first.
3709 */
3710 INIT_LIST_HEAD(&(peasycap->urb_audio_head));
3711 peasycap->purb_audio_head = &(peasycap->urb_audio_head);
3712
3713 JOM(4, "allocating %i isoc audio buffers of size %i\n",
3714 AUDIO_ISOC_BUFFER_MANY,
3715 peasycap->audio_isoc_buffer_size);
3716 JOM(4, ".... each occupying contiguous memory pages\n");
3717
3718 for (k = 0; k < AUDIO_ISOC_BUFFER_MANY; k++) {
3719 pbuf = (void *)__get_free_pages(GFP_KERNEL,
3720 AUDIO_ISOC_ORDER);
3721 if (!pbuf) {
3722 SAM("ERROR: Could not allocate isoc audio buffer "
3723 "%i\n", k);
3724 return -ENOMEM;
3725 }
3726 peasycap->allocation_audio_page +=
3727 BIT(AUDIO_ISOC_ORDER);
3728
3729 peasycap->audio_isoc_buffer[k].pgo = pbuf;
3730 peasycap->audio_isoc_buffer[k].pto = pbuf +
3731 peasycap->audio_isoc_buffer_size;
3732 peasycap->audio_isoc_buffer[k].kount = k;
3733 }
3734 JOM(4, "allocation of isoc audio buffers done.\n");
3735
3736 /* Allocate and initialize urbs */
3737 JOM(4, "allocating %i struct urb.\n", AUDIO_ISOC_BUFFER_MANY);
3738 JOM(4, "using %i=peasycap->audio_isoc_framesperdesc\n",
3739 peasycap->audio_isoc_framesperdesc);
3740 JOM(4, "using %i=peasycap->audio_isoc_maxframesize\n",
3741 peasycap->audio_isoc_maxframesize);
3742 JOM(4, "using %i=peasycap->audio_isoc_buffer_size\n",
3743 peasycap->audio_isoc_buffer_size);
3744
3745 for (k = 0; k < AUDIO_ISOC_BUFFER_MANY; k++) {
3746 purb = usb_alloc_urb(peasycap->audio_isoc_framesperdesc,
3747 GFP_KERNEL);
3748 if (!purb) {
3749 SAM("ERROR: usb_alloc_urb returned NULL for buffer "
3750 "%i\n", k);
3751 return -ENOMEM;
3752 }
3753 peasycap->allocation_audio_urb += 1 ;
3754 pdata_urb = kzalloc(sizeof(struct data_urb), GFP_KERNEL);
3755 if (!pdata_urb) {
3756 usb_free_urb(purb);
3757 SAM("ERROR: Could not allocate struct data_urb.\n");
3758 return -ENOMEM;
3759 }
3760 peasycap->allocation_audio_struct +=
3761 sizeof(struct data_urb);
3762
3763 pdata_urb->purb = purb;
3764 pdata_urb->isbuf = k;
3765 pdata_urb->length = 0;
3766 list_add_tail(&(pdata_urb->list_head),
3767 peasycap->purb_audio_head);
3768
3769 if (!k) {
3770 JOM(4, "initializing audio urbs thus:\n");
3771 JOM(4, " purb->interval = 1;\n");
3772 JOM(4, " purb->dev = peasycap->pusb_device;\n");
3773 JOM(4, " purb->pipe = usb_rcvisocpipe(peasycap->"
3774 "pusb_device,%i);\n",
3775 peasycap->audio_endpointnumber);
3776 JOM(4, " purb->transfer_flags = URB_ISO_ASAP;\n");
3777 JOM(4, " purb->transfer_buffer = "
3778 "peasycap->audio_isoc_buffer[.].pgo;\n");
3779 JOM(4, " purb->transfer_buffer_length = %i;\n",
3780 peasycap->audio_isoc_buffer_size);
3781 JOM(4, " purb->complete = easycap_alsa_complete;\n");
3782 JOM(4, " purb->context = peasycap;\n");
3783 JOM(4, " purb->start_frame = 0;\n");
3784 JOM(4, " purb->number_of_packets = %i;\n",
3785 peasycap->audio_isoc_framesperdesc);
3786 JOM(4, " for (j = 0; j < %i; j++)\n",
3787 peasycap->audio_isoc_framesperdesc);
3788 JOM(4, " {\n");
3789 JOM(4, " purb->iso_frame_desc[j].offset = j*%i;\n",
3790 peasycap->audio_isoc_maxframesize);
3791 JOM(4, " purb->iso_frame_desc[j].length = %i;\n",
3792 peasycap->audio_isoc_maxframesize);
3793 JOM(4, " }\n");
3794 }
3795
3796 purb->interval = 1;
3797 purb->dev = peasycap->pusb_device;
3798 purb->pipe = usb_rcvisocpipe(peasycap->pusb_device,
3799 peasycap->audio_endpointnumber);
3800 purb->transfer_flags = URB_ISO_ASAP;
3801 purb->transfer_buffer = peasycap->audio_isoc_buffer[k].pgo;
3802 purb->transfer_buffer_length =
3803 peasycap->audio_isoc_buffer_size;
3804 purb->complete = easycap_alsa_complete;
3805 purb->context = peasycap;
3806 purb->start_frame = 0;
3807 purb->number_of_packets = peasycap->audio_isoc_framesperdesc;
3808 for (j = 0; j < peasycap->audio_isoc_framesperdesc; j++) {
3809 purb->iso_frame_desc[j].offset = j *
3810 peasycap->audio_isoc_maxframesize;
3811 purb->iso_frame_desc[j].length =
3812 peasycap->audio_isoc_maxframesize;
3813 }
3814 }
3815 JOM(4, "allocation of %i struct urb done.\n", k);
3816
3817 /* Save pointer peasycap in this interface */
3818 usb_set_intfdata(intf, peasycap);
3819
3820 /* The audio device can now be registered */
3821 JOM(4, "initializing ALSA card\n");
3822
3823 rc = easycap_alsa_probe(peasycap);
3824 if (rc) {
3825 err("easycap_alsa_probe() rc = %i\n", rc);
3826 return -ENODEV;
3827 }
3828
3829
3830 JOM(8, "kref_get() with %i=kref.refcount.counter\n",
3831 peasycap->kref.refcount.counter);
3832 kref_get(&peasycap->kref);
3833 peasycap->registered_audio++;
3834 break;
3835 }
3836 /* Interfaces other than 0,1,2 are unexpected */
3837 default:
3838 JOM(4, "ERROR: unexpected interface %i\n", bInterfaceNumber);
3839 return -EINVAL;
3840 }
3841 SAM("ends successfully for interface %i\n", bInterfaceNumber);
3842 return 0;
3843 }
3844 /*****************************************************************************/
3845 /*---------------------------------------------------------------------------*/
3846 /*
3847 * WHEN THIS FUNCTION IS CALLED THE EasyCAP HAS ALREADY BEEN PHYSICALLY
3848 * UNPLUGGED. HENCE peasycap->pusb_device IS NO LONGER VALID.
3849 *
3850 * THIS FUNCTION AFFECTS ALSA. BEWARE.
3851 */
3852 /*---------------------------------------------------------------------------*/
easycap_usb_disconnect(struct usb_interface * pusb_interface)3853 static void easycap_usb_disconnect(struct usb_interface *pusb_interface)
3854 {
3855 struct usb_host_interface *pusb_host_interface;
3856 struct usb_interface_descriptor *pusb_interface_descriptor;
3857 struct easycap *peasycap;
3858 int minor, kd;
3859 u8 bInterfaceNumber;
3860
3861 JOT(4, "\n");
3862
3863 pusb_host_interface = pusb_interface->cur_altsetting;
3864 if (!pusb_host_interface) {
3865 JOT(4, "ERROR: pusb_host_interface is NULL\n");
3866 return;
3867 }
3868 pusb_interface_descriptor = &(pusb_host_interface->desc);
3869 if (!pusb_interface_descriptor) {
3870 JOT(4, "ERROR: pusb_interface_descriptor is NULL\n");
3871 return;
3872 }
3873 bInterfaceNumber = pusb_interface_descriptor->bInterfaceNumber;
3874 minor = pusb_interface->minor;
3875 JOT(4, "intf[%i]: minor=%i\n", bInterfaceNumber, minor);
3876
3877 if (1 == bInterfaceNumber)
3878 return;
3879
3880 peasycap = usb_get_intfdata(pusb_interface);
3881 if (!peasycap) {
3882 SAY("ERROR: peasycap is NULL\n");
3883 return;
3884 }
3885 /*---------------------------------------------------------------------------*/
3886 /*
3887 * IF THE WAIT QUEUES ARE NOT CLEARED A DEADLOCK IS POSSIBLE. BEWARE.
3888 */
3889 /*---------------------------------------------------------------------------*/
3890 peasycap->video_eof = 1;
3891 peasycap->audio_eof = 1;
3892 wake_up_interruptible(&(peasycap->wq_video));
3893 wake_up_interruptible(&(peasycap->wq_audio));
3894
3895 switch (bInterfaceNumber) {
3896 case 0:
3897 easycap_video_kill_urbs(peasycap);
3898 break;
3899 case 2:
3900 easycap_audio_kill_urbs(peasycap);
3901 break;
3902 default:
3903 break;
3904 }
3905 /*--------------------------------------------------------------------------*/
3906 /*
3907 * DEREGISTER
3908 *
3909 * THIS PROCEDURE WILL BLOCK UNTIL easycap_poll(), VIDEO IOCTL AND AUDIO
3910 * IOCTL ARE ALL UNLOCKED. IF THIS IS NOT DONE AN Oops CAN OCCUR WHEN
3911 * AN EasyCAP IS UNPLUGGED WHILE THE URBS ARE RUNNING. BEWARE.
3912 */
3913 /*--------------------------------------------------------------------------*/
3914 kd = easycap_isdongle(peasycap);
3915 switch (bInterfaceNumber) {
3916 case 0: {
3917 if (0 <= kd && DONGLE_MANY > kd) {
3918 wake_up_interruptible(&peasycap->wq_video);
3919 JOM(4, "about to lock dongle[%i].mutex_video\n", kd);
3920 if (mutex_lock_interruptible(&easycapdc60_dongle[kd].
3921 mutex_video)) {
3922 SAY("ERROR: "
3923 "cannot lock dongle[%i].mutex_video\n", kd);
3924 return;
3925 }
3926 JOM(4, "locked dongle[%i].mutex_video\n", kd);
3927 } else {
3928 SAY("ERROR: %i=kd is bad: cannot lock dongle\n", kd);
3929 }
3930 /*---------------------------------------------------------------------------*/
3931 if (!peasycap->v4l2_device.name[0]) {
3932 SAM("ERROR: peasycap->v4l2_device.name is empty\n");
3933 if (0 <= kd && DONGLE_MANY > kd)
3934 mutex_unlock(&easycapdc60_dongle[kd].mutex_video);
3935 return;
3936 }
3937 v4l2_device_disconnect(&peasycap->v4l2_device);
3938 JOM(4, "v4l2_device_disconnect() OK\n");
3939 v4l2_device_unregister(&peasycap->v4l2_device);
3940 JOM(4, "v4l2_device_unregister() OK\n");
3941
3942 video_unregister_device(&peasycap->video_device);
3943 JOM(4, "intf[%i]: video_unregister_device() minor=%i\n",
3944 bInterfaceNumber, minor);
3945 peasycap->registered_video--;
3946 /*^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^*/
3947
3948 if (0 <= kd && DONGLE_MANY > kd) {
3949 mutex_unlock(&easycapdc60_dongle[kd].mutex_video);
3950 JOM(4, "unlocked dongle[%i].mutex_video\n", kd);
3951 }
3952 break;
3953 }
3954 case 2: {
3955 if (0 <= kd && DONGLE_MANY > kd) {
3956 wake_up_interruptible(&peasycap->wq_audio);
3957 JOM(4, "about to lock dongle[%i].mutex_audio\n", kd);
3958 if (mutex_lock_interruptible(&easycapdc60_dongle[kd].
3959 mutex_audio)) {
3960 SAY("ERROR: "
3961 "cannot lock dongle[%i].mutex_audio\n", kd);
3962 return;
3963 }
3964 JOM(4, "locked dongle[%i].mutex_audio\n", kd);
3965 } else
3966 SAY("ERROR: %i=kd is bad: cannot lock dongle\n", kd);
3967 if (0 != snd_card_free(peasycap->psnd_card)) {
3968 SAY("ERROR: snd_card_free() failed\n");
3969 } else {
3970 peasycap->psnd_card = NULL;
3971 (peasycap->registered_audio)--;
3972 }
3973 if (0 <= kd && DONGLE_MANY > kd) {
3974 mutex_unlock(&easycapdc60_dongle[kd].mutex_audio);
3975 JOM(4, "unlocked dongle[%i].mutex_audio\n", kd);
3976 }
3977 break;
3978 }
3979 default:
3980 break;
3981 }
3982 /*---------------------------------------------------------------------------*/
3983 /*
3984 * CALL easycap_delete() IF NO REMAINING REFERENCES TO peasycap
3985 * (ALSO WHEN ALSA HAS BEEN IN USE)
3986 */
3987 /*---------------------------------------------------------------------------*/
3988 if (!peasycap->kref.refcount.counter) {
3989 SAM("ERROR: peasycap->kref.refcount.counter is zero "
3990 "so cannot call kref_put()\n");
3991 SAM("ending unsuccessfully: may cause memory leak\n");
3992 return;
3993 }
3994 if (0 <= kd && DONGLE_MANY > kd) {
3995 JOM(4, "about to lock dongle[%i].mutex_video\n", kd);
3996 if (mutex_lock_interruptible(&easycapdc60_dongle[kd].mutex_video)) {
3997 SAY("ERROR: cannot lock dongle[%i].mutex_video\n", kd);
3998 SAM("ending unsuccessfully: may cause memory leak\n");
3999 return;
4000 }
4001 JOM(4, "locked dongle[%i].mutex_video\n", kd);
4002 JOM(4, "about to lock dongle[%i].mutex_audio\n", kd);
4003 if (mutex_lock_interruptible(&easycapdc60_dongle[kd].mutex_audio)) {
4004 SAY("ERROR: cannot lock dongle[%i].mutex_audio\n", kd);
4005 mutex_unlock(&(easycapdc60_dongle[kd].mutex_video));
4006 JOM(4, "unlocked dongle[%i].mutex_video\n", kd);
4007 SAM("ending unsuccessfully: may cause memory leak\n");
4008 return;
4009 }
4010 JOM(4, "locked dongle[%i].mutex_audio\n", kd);
4011 }
4012 JOM(4, "intf[%i]: %i=peasycap->kref.refcount.counter\n",
4013 bInterfaceNumber, (int)peasycap->kref.refcount.counter);
4014 kref_put(&peasycap->kref, easycap_delete);
4015 JOT(4, "intf[%i]: kref_put() done.\n", bInterfaceNumber);
4016 if (0 <= kd && DONGLE_MANY > kd) {
4017 mutex_unlock(&(easycapdc60_dongle[kd].mutex_audio));
4018 JOT(4, "unlocked dongle[%i].mutex_audio\n", kd);
4019 mutex_unlock(&easycapdc60_dongle[kd].mutex_video);
4020 JOT(4, "unlocked dongle[%i].mutex_video\n", kd);
4021 }
4022 /*---------------------------------------------------------------------------*/
4023 JOM(4, "ends\n");
4024 return;
4025 }
4026 /*****************************************************************************/
4027
4028 /*---------------------------------------------------------------------------*/
4029 /*
4030 * PARAMETERS APPLICABLE TO ENTIRE DRIVER, I.E. BOTH VIDEO AND AUDIO
4031 */
4032 /*---------------------------------------------------------------------------*/
4033 static struct usb_device_id easycap_usb_device_id_table[] = {
4034 {USB_DEVICE(USB_EASYCAP_VENDOR_ID, USB_EASYCAP_PRODUCT_ID)},
4035 { }
4036 };
4037
4038 MODULE_DEVICE_TABLE(usb, easycap_usb_device_id_table);
4039 static struct usb_driver easycap_usb_driver = {
4040 .name = "easycap",
4041 .id_table = easycap_usb_device_id_table,
4042 .probe = easycap_usb_probe,
4043 .disconnect = easycap_usb_disconnect,
4044 };
4045
easycap_module_init(void)4046 static int __init easycap_module_init(void)
4047 {
4048 int k, rc;
4049
4050 printk(KERN_INFO "Easycap version: "EASYCAP_DRIVER_VERSION "\n");
4051
4052 JOT(4, "begins. %i=debug %i=bars %i=gain\n",
4053 easycap_debug, easycap_bars, easycap_gain);
4054
4055 mutex_init(&mutex_dongle);
4056 for (k = 0; k < DONGLE_MANY; k++) {
4057 easycapdc60_dongle[k].peasycap = NULL;
4058 mutex_init(&easycapdc60_dongle[k].mutex_video);
4059 mutex_init(&easycapdc60_dongle[k].mutex_audio);
4060 }
4061 rc = usb_register(&easycap_usb_driver);
4062 if (rc)
4063 printk(KERN_ERR "Easycap: usb_register failed rc=%d\n", rc);
4064
4065 return rc;
4066 }
4067 /*****************************************************************************/
easycap_module_exit(void)4068 static void __exit easycap_module_exit(void)
4069 {
4070 usb_deregister(&easycap_usb_driver);
4071 }
4072 /*****************************************************************************/
4073
4074 module_init(easycap_module_init);
4075 module_exit(easycap_module_exit);
4076
4077 /*****************************************************************************/
4078