projects / deliverable / linux.git / blob
? search:


ba3709bec3f0a42d84d34d2ba88e8bd62feb104a
[deliverable/linux.git] / drivers / media / video / dabusb.c
1 /*****************************************************************************/
2
3 /*
4 * dabusb.c -- dab usb driver.
5 *
6 * Copyright (C) 1999 Deti Fliegl (deti@fliegl.de)
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 *
22 *
23 *
24 * $Id: dabusb.c,v 1.54 2000/07/24 21:39:39 deti Exp $
25 *
26 */
27
28 /*****************************************************************************/
29
30 #include <linux/module.h>
31 #include <linux/socket.h>
32 #include <linux/list.h>
33 #include <linux/vmalloc.h>
34 #include <linux/slab.h>
35 #include <linux/init.h>
36 #include <asm/uaccess.h>
37 #include <asm/atomic.h>
38 #include <linux/delay.h>
39 #include <linux/usb.h>
40 #include <linux/mutex.h>
41 #include <linux/firmware.h>
42 #include <linux/ihex.h>
43
44 #include "dabusb.h"
45
46 /*
47 * Version Information
48 */
49 #define DRIVER_VERSION "v1.54"
50 #define DRIVER_AUTHOR "Deti Fliegl, deti@fliegl.de"
51 #define DRIVER_DESC "DAB-USB Interface Driver for Linux (c)1999"
52
53 /* --------------------------------------------------------------------- */
54
55 #ifdef CONFIG_USB_DYNAMIC_MINORS
56 #define NRDABUSB 256
57 #else
58 #define NRDABUSB 4
59 #endif
60
61 /*-------------------------------------------------------------------*/
62
63 static dabusb_t dabusb[NRDABUSB];
64 static int buffers = 256;
65 static struct usb_driver dabusb_driver;
66
67 /*-------------------------------------------------------------------*/
68
69 static int dabusb_add_buf_tail (pdabusb_t s, struct list_head *dst, struct list_head *src)
70 {
71 unsigned long flags;
72 struct list_head *tmp;
73 int ret = 0;
74
75 spin_lock_irqsave (&s->lock, flags);
76
77 if (list_empty (src)) {
78 // no elements in source buffer
79 ret = -1;
80 goto err;
81 }
82 tmp = src->next;
83 list_move_tail (tmp, dst);
84
85 err: spin_unlock_irqrestore (&s->lock, flags);
86 return ret;
87 }
88 /*-------------------------------------------------------------------*/
89 #ifdef DEBUG
90 static void dump_urb (struct urb *urb)
91 {
92 dbg("urb :%p", urb);
93 dbg("dev :%p", urb->dev);
94 dbg("pipe :%08X", urb->pipe);
95 dbg("status :%d", urb->status);
96 dbg("transfer_flags :%08X", urb->transfer_flags);
97 dbg("transfer_buffer :%p", urb->transfer_buffer);
98 dbg("transfer_buffer_length:%d", urb->transfer_buffer_length);
99 dbg("actual_length :%d", urb->actual_length);
100 dbg("setup_packet :%p", urb->setup_packet);
101 dbg("start_frame :%d", urb->start_frame);
102 dbg("number_of_packets :%d", urb->number_of_packets);
103 dbg("interval :%d", urb->interval);
104 dbg("error_count :%d", urb->error_count);
105 dbg("context :%p", urb->context);
106 dbg("complete :%p", urb->complete);
107 }
108 #endif
109 /*-------------------------------------------------------------------*/
110 static int dabusb_cancel_queue (pdabusb_t s, struct list_head *q)
111 {
112 unsigned long flags;
113 pbuff_t b;
114
115 dbg("dabusb_cancel_queue");
116
117 spin_lock_irqsave (&s->lock, flags);
118
119 list_for_each_entry(b, q, buff_list) {
120 #ifdef DEBUG
121 dump_urb(b->purb);
122 #endif
123 usb_unlink_urb (b->purb);
124 }
125 spin_unlock_irqrestore (&s->lock, flags);
126 return 0;
127 }
128 /*-------------------------------------------------------------------*/
129 static int dabusb_free_queue (struct list_head *q)
130 {
131 struct list_head *tmp;
132 struct list_head *p;
133 pbuff_t b;
134
135 dbg("dabusb_free_queue");
136 for (p = q->next; p != q;) {
137 b = list_entry (p, buff_t, buff_list);
138
139 #ifdef DEBUG
140 dump_urb(b->purb);
141 #endif
142 kfree(b->purb->transfer_buffer);
143 usb_free_urb(b->purb);
144 tmp = p->next;
145 list_del (p);
146 kfree (b);
147 p = tmp;
148 }
149
150 return 0;
151 }
152 /*-------------------------------------------------------------------*/
153 static int dabusb_free_buffers (pdabusb_t s)
154 {
155 unsigned long flags;
156 dbg("dabusb_free_buffers");
157
158 spin_lock_irqsave(&s->lock, flags);
159
160 dabusb_free_queue (&s->free_buff_list);
161 dabusb_free_queue (&s->rec_buff_list);
162
163 spin_unlock_irqrestore(&s->lock, flags);
164
165 s->got_mem = 0;
166 return 0;
167 }
168 /*-------------------------------------------------------------------*/
169 static void dabusb_iso_complete (struct urb *purb)
170 {
171 pbuff_t b = purb->context;
172 pdabusb_t s = b->s;
173 int i;
174 int len;
175 int dst = 0;
176 void *buf = purb->transfer_buffer;
177
178 dbg("dabusb_iso_complete");
179
180 // process if URB was not killed
181 if (purb->status != -ENOENT) {
182 unsigned int pipe = usb_rcvisocpipe (purb->dev, _DABUSB_ISOPIPE);
183 int pipesize = usb_maxpacket (purb->dev, pipe, usb_pipeout (pipe));
184 for (i = 0; i < purb->number_of_packets; i++)
185 if (!purb->iso_frame_desc[i].status) {
186 len = purb->iso_frame_desc[i].actual_length;
187 if (len <= pipesize) {
188 memcpy (buf + dst, buf + purb->iso_frame_desc[i].offset, len);
189 dst += len;
190 }
191 else
192 dev_err(&purb->dev->dev,
193 "dabusb_iso_complete: invalid len %d\n", len);
194 }
195 else
196 dev_warn(&purb->dev->dev, "dabusb_iso_complete: corrupted packet status: %d\n", purb->iso_frame_desc[i].status);
197 if (dst != purb->actual_length)
198 dev_err(&purb->dev->dev,
199 "dst!=purb->actual_length:%d!=%d\n",
200 dst, purb->actual_length);
201 }
202
203 if (atomic_dec_and_test (&s->pending_io) && !s->remove_pending && s->state != _stopped) {
204 s->overruns++;
205 dev_err(&purb->dev->dev, "overrun (%d)\n", s->overruns);
206 }
207 wake_up (&s->wait);
208 }
209 /*-------------------------------------------------------------------*/
210 static int dabusb_alloc_buffers (pdabusb_t s)
211 {
212 int transfer_len = 0;
213 pbuff_t b;
214 unsigned int pipe = usb_rcvisocpipe (s->usbdev, _DABUSB_ISOPIPE);
215 int pipesize = usb_maxpacket (s->usbdev, pipe, usb_pipeout (pipe));
216 int packets = _ISOPIPESIZE / pipesize;
217 int transfer_buffer_length = packets * pipesize;
218 int i;
219
220 dbg("dabusb_alloc_buffers pipesize:%d packets:%d transfer_buffer_len:%d",
221 pipesize, packets, transfer_buffer_length);
222
223 while (transfer_len < (s->total_buffer_size << 10)) {
224 b = kzalloc(sizeof (buff_t), GFP_KERNEL);
225 if (!b) {
226 dev_err(&s->usbdev->dev,
227 "kzalloc(sizeof(buff_t))==NULL\n");
228 goto err;
229 }
230 b->s = s;
231 b->purb = usb_alloc_urb(packets, GFP_KERNEL);
232 if (!b->purb) {
233 dev_err(&s->usbdev->dev, "usb_alloc_urb == NULL\n");
234 kfree (b);
235 goto err;
236 }
237
238 b->purb->transfer_buffer = kmalloc (transfer_buffer_length, GFP_KERNEL);
239 if (!b->purb->transfer_buffer) {
240 kfree (b->purb);
241 kfree (b);
242 dev_err(&s->usbdev->dev,
243 "kmalloc(%d)==NULL\n", transfer_buffer_length);
244 goto err;
245 }
246
247 b->purb->transfer_buffer_length = transfer_buffer_length;
248 b->purb->number_of_packets = packets;
249 b->purb->complete = dabusb_iso_complete;
250 b->purb->context = b;
251 b->purb->dev = s->usbdev;
252 b->purb->pipe = pipe;
253 b->purb->transfer_flags = URB_ISO_ASAP;
254
255 for (i = 0; i < packets; i++) {
256 b->purb->iso_frame_desc[i].offset = i * pipesize;
257 b->purb->iso_frame_desc[i].length = pipesize;
258 }
259
260 transfer_len += transfer_buffer_length;
261 list_add_tail (&b->buff_list, &s->free_buff_list);
262 }
263 s->got_mem = transfer_len;
264
265 return 0;
266
267 err:
268 dabusb_free_buffers (s);
269 return -ENOMEM;
270 }
271 /*-------------------------------------------------------------------*/
272 static int dabusb_bulk (pdabusb_t s, pbulk_transfer_t pb)
273 {
274 int ret;
275 unsigned int pipe;
276 int actual_length;
277
278 dbg("dabusb_bulk");
279
280 if (!pb->pipe)
281 pipe = usb_rcvbulkpipe (s->usbdev, 2);
282 else
283 pipe = usb_sndbulkpipe (s->usbdev, 2);
284
285 ret=usb_bulk_msg(s->usbdev, pipe, pb->data, pb->size, &actual_length, 100);
286 if(ret<0) {
287 dev_err(&s->usbdev->dev,
288 "usb_bulk_msg failed(%d)\n", ret);
289
290 if (usb_set_interface (s->usbdev, _DABUSB_IF, 1) < 0) {
291 dev_err(&s->usbdev->dev, "set_interface failed\n");
292 return -EINVAL;
293 }
294
295 }
296
297 if( ret == -EPIPE ) {
298 dev_warn(&s->usbdev->dev, "CLEAR_FEATURE request to remove STALL condition.\n");
299 if(usb_clear_halt(s->usbdev, usb_pipeendpoint(pipe)))
300 dev_err(&s->usbdev->dev, "request failed\n");
301 }
302
303 pb->size = actual_length;
304 return ret;
305 }
306 /* --------------------------------------------------------------------- */
307 static int dabusb_writemem (pdabusb_t s, int pos, const unsigned char *data,
308 int len)
309 {
310 int ret;
311 unsigned char *transfer_buffer = kmalloc (len, GFP_KERNEL);
312
313 if (!transfer_buffer) {
314 dev_err(&s->usbdev->dev,
315 "dabusb_writemem: kmalloc(%d) failed.\n", len);
316 return -ENOMEM;
317 }
318
319 memcpy (transfer_buffer, data, len);
320
321 ret=usb_control_msg(s->usbdev, usb_sndctrlpipe( s->usbdev, 0 ), 0xa0, 0x40, pos, 0, transfer_buffer, len, 300);
322
323 kfree (transfer_buffer);
324 return ret;
325 }
326 /* --------------------------------------------------------------------- */
327 static int dabusb_8051_reset (pdabusb_t s, unsigned char reset_bit)
328 {
329 dbg("dabusb_8051_reset: %d",reset_bit);
330 return dabusb_writemem (s, CPUCS_REG, &reset_bit, 1);
331 }
332 /* --------------------------------------------------------------------- */
333 static int dabusb_loadmem (pdabusb_t s, const char *fname)
334 {
335 int ret;
336 const struct ihex_binrec *rec;
337 const struct firmware *uninitialized_var(fw);
338
339 dbg("Enter dabusb_loadmem (internal)");
340
341 ret = request_ihex_firmware(&fw, "dabusb/firmware.fw", &s->usbdev->dev);
342 if (ret) {
343 dev_err(&s->usbdev->dev,
344 "Failed to load \"dabusb/firmware.fw\": %d\n", ret);
345 goto out;
346 }
347 ret = dabusb_8051_reset (s, 1);
348
349 for (rec = (const struct ihex_binrec *)fw->data; rec;
350 rec = ihex_next_binrec(rec)) {
351 dbg("dabusb_writemem: %04X %p %d)", be32_to_cpu(rec->addr),
352 rec->data, be16_to_cpu(rec->len));
353
354 ret = dabusb_writemem(s, be32_to_cpu(rec->addr), rec->data,
355 be16_to_cpu(rec->len));
356 if (ret < 0) {
357 dev_err(&s->usbdev->dev,
358 "dabusb_writemem failed (%d %04X %p %d)\n",
359 ret, be32_to_cpu(rec->addr),
360 rec->data, be16_to_cpu(rec->len));
361 break;
362 }
363 }
364 ret = dabusb_8051_reset (s, 0);
365 release_firmware(fw);
366 out:
367 dbg("dabusb_loadmem: exit");
368
369 return ret;
370 }
371 /* --------------------------------------------------------------------- */
372 static int dabusb_fpga_clear (pdabusb_t s, pbulk_transfer_t b)
373 {
374 b->size = 4;
375 b->data[0] = 0x2a;
376 b->data[1] = 0;
377 b->data[2] = 0;
378 b->data[3] = 0;
379
380 dbg("dabusb_fpga_clear");
381
382 return dabusb_bulk (s, b);
383 }
384 /* --------------------------------------------------------------------- */
385 static int dabusb_fpga_init (pdabusb_t s, pbulk_transfer_t b)
386 {
387 b->size = 4;
388 b->data[0] = 0x2c;
389 b->data[1] = 0;
390 b->data[2] = 0;
391 b->data[3] = 0;
392
393 dbg("dabusb_fpga_init");
394
395 return dabusb_bulk (s, b);
396 }
397 /* --------------------------------------------------------------------- */
398 static int dabusb_fpga_download (pdabusb_t s, const char *fname)
399 {
400 pbulk_transfer_t b = kmalloc (sizeof (bulk_transfer_t), GFP_KERNEL);
401 const struct firmware *fw;
402 unsigned int blen, n;
403 int ret;
404
405 dbg("Enter dabusb_fpga_download (internal)");
406
407 if (!b) {
408 dev_err(&s->usbdev->dev,
409 "kmalloc(sizeof(bulk_transfer_t))==NULL\n");
410 return -ENOMEM;
411 }
412
413 ret = request_firmware(&fw, "dabusb/bitstream.bin", &s->usbdev->dev);
414 if (ret) {
415 dev_err(&s->usbdev->dev,
416 "Failed to load \"dabusb/bitstream.bin\": %d\n", ret);
417 kfree(b);
418 return ret;
419 }
420
421 b->pipe = 1;
422 ret = dabusb_fpga_clear (s, b);
423 mdelay (10);
424 blen = fw->data[73] + (fw->data[72] << 8);
425
426 dbg("Bitstream len: %i", blen);
427
428 b->data[0] = 0x2b;
429 b->data[1] = 0;
430 b->data[2] = 0;
431 b->data[3] = 60;
432
433 for (n = 0; n <= blen + 60; n += 60) {
434 // some cclks for startup
435 b->size = 64;
436 memcpy (b->data + 4, fw->data + 74 + n, 60);
437 ret = dabusb_bulk (s, b);
438 if (ret < 0) {
439 dev_err(&s->usbdev->dev, "dabusb_bulk failed.\n");
440 break;
441 }
442 mdelay (1);
443 }
444
445 ret = dabusb_fpga_init (s, b);
446 kfree (b);
447 release_firmware(fw);
448
449 dbg("exit dabusb_fpga_download");
450
451 return ret;
452 }
453
454 static int dabusb_stop (pdabusb_t s)
455 {
456 dbg("dabusb_stop");
457
458 s->state = _stopped;
459 dabusb_cancel_queue (s, &s->rec_buff_list);
460
461 dbg("pending_io: %d", s->pending_io.counter);
462
463 s->pending_io.counter = 0;
464 return 0;
465 }
466
467 static int dabusb_startrek (pdabusb_t s)
468 {
469 if (!s->got_mem && s->state != _started) {
470
471 dbg("dabusb_startrek");
472
473 if (dabusb_alloc_buffers (s) < 0)
474 return -ENOMEM;
475 dabusb_stop (s);
476 s->state = _started;
477 s->readptr = 0;
478 }
479
480 if (!list_empty (&s->free_buff_list)) {
481 pbuff_t end;
482 int ret;
483
484 while (!dabusb_add_buf_tail (s, &s->rec_buff_list, &s->free_buff_list)) {
485
486 dbg("submitting: end:%p s->rec_buff_list:%p", s->rec_buff_list.prev, &s->rec_buff_list);
487
488 end = list_entry (s->rec_buff_list.prev, buff_t, buff_list);
489
490 ret = usb_submit_urb (end->purb, GFP_KERNEL);
491 if (ret) {
492 dev_err(&s->usbdev->dev,
493 "usb_submit_urb returned:%d\n", ret);
494 if (dabusb_add_buf_tail (s, &s->free_buff_list, &s->rec_buff_list))
495 dev_err(&s->usbdev->dev,
496 "startrek: dabusb_add_buf_tail failed\n");
497 break;
498 }
499 else
500 atomic_inc (&s->pending_io);
501 }
502 dbg("pending_io: %d",s->pending_io.counter);
503 }
504
505 return 0;
506 }
507
508 static ssize_t dabusb_read (struct file *file, char __user *buf, size_t count, loff_t * ppos)
509 {
510 pdabusb_t s = (pdabusb_t) file->private_data;
511 unsigned long flags;
512 unsigned ret = 0;
513 int rem;
514 int cnt;
515 pbuff_t b;
516 struct urb *purb = NULL;
517
518 dbg("dabusb_read");
519
520 if (*ppos)
521 return -ESPIPE;
522
523 if (s->remove_pending)
524 return -EIO;
525
526
527 if (!s->usbdev)
528 return -EIO;
529
530 while (count > 0) {
531 dabusb_startrek (s);
532
533 spin_lock_irqsave (&s->lock, flags);
534
535 if (list_empty (&s->rec_buff_list)) {
536
537 spin_unlock_irqrestore(&s->lock, flags);
538
539 dev_err(&s->usbdev->dev,
540 "error: rec_buf_list is empty\n");
541 goto err;
542 }
543
544 b = list_entry (s->rec_buff_list.next, buff_t, buff_list);
545 purb = b->purb;
546
547 spin_unlock_irqrestore(&s->lock, flags);
548
549 if (purb->status == -EINPROGRESS) {
550 if (file->f_flags & O_NONBLOCK) // return nonblocking
551 {
552 if (!ret)
553 ret = -EAGAIN;
554 goto err;
555 }
556
557 interruptible_sleep_on (&s->wait);
558
559 if (signal_pending (current)) {
560 if (!ret)
561 ret = -ERESTARTSYS;
562 goto err;
563 }
564
565 spin_lock_irqsave (&s->lock, flags);
566
567 if (list_empty (&s->rec_buff_list)) {
568 spin_unlock_irqrestore(&s->lock, flags);
569 dev_err(&s->usbdev->dev,
570 "error: still no buffer available.\n");
571 goto err;
572 }
573 spin_unlock_irqrestore(&s->lock, flags);
574 s->readptr = 0;
575 }
576 if (s->remove_pending) {
577 ret = -EIO;
578 goto err;
579 }
580
581 rem = purb->actual_length - s->readptr; // set remaining bytes to copy
582
583 if (count >= rem)
584 cnt = rem;
585 else
586 cnt = count;
587
588 dbg("copy_to_user:%p %p %d",buf, purb->transfer_buffer + s->readptr, cnt);
589
590 if (copy_to_user (buf, purb->transfer_buffer + s->readptr, cnt)) {
591 dev_err(&s->usbdev->dev, "read: copy_to_user failed\n");
592 if (!ret)
593 ret = -EFAULT;
594 goto err;
595 }
596
597 s->readptr += cnt;
598 count -= cnt;
599 buf += cnt;
600 ret += cnt;
601
602 if (s->readptr == purb->actual_length) {
603 // finished, take next buffer
604 if (dabusb_add_buf_tail (s, &s->free_buff_list, &s->rec_buff_list))
605 dev_err(&s->usbdev->dev,
606 "read: dabusb_add_buf_tail failed\n");
607 s->readptr = 0;
608 }
609 }
610 err: //mutex_unlock(&s->mutex);
611 return ret;
612 }
613
614 static int dabusb_open (struct inode *inode, struct file *file)
615 {
616 int devnum = iminor(inode);
617 pdabusb_t s;
618
619 if (devnum < DABUSB_MINOR || devnum >= (DABUSB_MINOR + NRDABUSB))
620 return -EIO;
621
622 s = &dabusb[devnum - DABUSB_MINOR];
623
624 dbg("dabusb_open");
625 mutex_lock(&s->mutex);
626
627 while (!s->usbdev || s->opened) {
628 mutex_unlock(&s->mutex);
629
630 if (file->f_flags & O_NONBLOCK) {
631 return -EBUSY;
632 }
633 msleep_interruptible(500);
634
635 if (signal_pending (current)) {
636 return -EAGAIN;
637 }
638 mutex_lock(&s->mutex);
639 }
640 if (usb_set_interface (s->usbdev, _DABUSB_IF, 1) < 0) {
641 mutex_unlock(&s->mutex);
642 dev_err(&s->usbdev->dev, "set_interface failed\n");
643 return -EINVAL;
644 }
645 s->opened = 1;
646 mutex_unlock(&s->mutex);
647
648 file->f_pos = 0;
649 file->private_data = s;
650
651 return nonseekable_open(inode, file);
652 }
653
654 static int dabusb_release (struct inode *inode, struct file *file)
655 {
656 pdabusb_t s = (pdabusb_t) file->private_data;
657
658 dbg("dabusb_release");
659
660 mutex_lock(&s->mutex);
661 dabusb_stop (s);
662 dabusb_free_buffers (s);
663 mutex_unlock(&s->mutex);
664
665 if (!s->remove_pending) {
666 if (usb_set_interface (s->usbdev, _DABUSB_IF, 0) < 0)
667 dev_err(&s->usbdev->dev, "set_interface failed\n");
668 }
669 else
670 wake_up (&s->remove_ok);
671
672 s->opened = 0;
673 return 0;
674 }
675
676 static long dabusb_ioctl (struct file *file, unsigned int cmd, unsigned long arg)
677 {
678 pdabusb_t s = (pdabusb_t) file->private_data;
679 pbulk_transfer_t pbulk;
680 int ret = 0;
681 int version = DABUSB_VERSION;
682
683 dbg("dabusb_ioctl");
684
685 lock_kernel();
686 if (s->remove_pending) {
687 unlock_kernel();
688 return -EIO;
689 }
690
691 mutex_lock(&s->mutex);
692
693 if (!s->usbdev) {
694 mutex_unlock(&s->mutex);
695 unlock_kernel();
696 return -EIO;
697 }
698
699 switch (cmd) {
700
701 case IOCTL_DAB_BULK:
702 pbulk = kmalloc(sizeof (bulk_transfer_t), GFP_KERNEL);
703
704 if (!pbulk) {
705 ret = -ENOMEM;
706 break;
707 }
708
709 if (copy_from_user (pbulk, (void __user *) arg, sizeof (bulk_transfer_t))) {
710 ret = -EFAULT;
711 kfree (pbulk);
712 break;
713 }
714
715 ret=dabusb_bulk (s, pbulk);
716 if(ret==0)
717 if (copy_to_user((void __user *)arg, pbulk,
718 sizeof(bulk_transfer_t)))
719 ret = -EFAULT;
720 kfree (pbulk);
721 break;
722
723 case IOCTL_DAB_OVERRUNS:
724 ret = put_user (s->overruns, (unsigned int __user *) arg);
725 break;
726
727 case IOCTL_DAB_VERSION:
728 ret = put_user (version, (unsigned int __user *) arg);
729 break;
730
731 default:
732 ret = -ENOIOCTLCMD;
733 break;
734 }
735 mutex_unlock(&s->mutex);
736 unlock_kernel();
737 return ret;
738 }
739
740 static const struct file_operations dabusb_fops =
741 {
742 .owner = THIS_MODULE,
743 .llseek = no_llseek,
744 .read = dabusb_read,
745 .unlocked_ioctl = dabusb_ioctl,
746 .open = dabusb_open,
747 .release = dabusb_release,
748 };
749
750 static struct usb_class_driver dabusb_class = {
751 .name = "dabusb%d",
752 .fops = &dabusb_fops,
753 .minor_base = DABUSB_MINOR,
754 };
755
756
757 /* --------------------------------------------------------------------- */
758 static int dabusb_probe (struct usb_interface *intf,
759 const struct usb_device_id *id)
760 {
761 struct usb_device *usbdev = interface_to_usbdev(intf);
762 int retval;
763 pdabusb_t s;
764
765 dbg("dabusb: probe: vendor id 0x%x, device id 0x%x ifnum:%d",
766 le16_to_cpu(usbdev->descriptor.idVendor),
767 le16_to_cpu(usbdev->descriptor.idProduct),
768 intf->altsetting->desc.bInterfaceNumber);
769
770 /* We don't handle multiple configurations */
771 if (usbdev->descriptor.bNumConfigurations != 1)
772 return -ENODEV;
773
774 if (intf->altsetting->desc.bInterfaceNumber != _DABUSB_IF &&
775 le16_to_cpu(usbdev->descriptor.idProduct) == 0x9999)
776 return -ENODEV;
777
778
779
780 s = &dabusb[intf->minor];
781
782 mutex_lock(&s->mutex);
783 s->remove_pending = 0;
784 s->usbdev = usbdev;
785 s->devnum = intf->minor;
786
787 if (usb_reset_configuration (usbdev) < 0) {
788 dev_err(&intf->dev, "reset_configuration failed\n");
789 goto reject;
790 }
791 if (le16_to_cpu(usbdev->descriptor.idProduct) == 0x2131) {
792 dabusb_loadmem (s, NULL);
793 goto reject;
794 }
795 else {
796 dabusb_fpga_download (s, NULL);
797
798 if (usb_set_interface (s->usbdev, _DABUSB_IF, 0) < 0) {
799 dev_err(&intf->dev, "set_interface failed\n");
800 goto reject;
801 }
802 }
803 dbg("bound to interface: %d", intf->altsetting->desc.bInterfaceNumber);
804 usb_set_intfdata (intf, s);
805 mutex_unlock(&s->mutex);
806
807 retval = usb_register_dev(intf, &dabusb_class);
808 if (retval) {
809 usb_set_intfdata (intf, NULL);
810 return -ENOMEM;
811 }
812
813 return 0;
814
815 reject:
816 mutex_unlock(&s->mutex);
817 s->usbdev = NULL;
818 return -ENODEV;
819 }
820
821 static void dabusb_disconnect (struct usb_interface *intf)
822 {
823 wait_queue_t __wait;
824 pdabusb_t s = usb_get_intfdata (intf);
825
826 dbg("dabusb_disconnect");
827
828 init_waitqueue_entry(&__wait, current);
829
830 usb_set_intfdata (intf, NULL);
831 if (s) {
832 usb_deregister_dev (intf, &dabusb_class);
833 s->remove_pending = 1;
834 wake_up (&s->wait);
835 add_wait_queue(&s->remove_ok, &__wait);
836 set_current_state(TASK_UNINTERRUPTIBLE);
837 if (s->state == _started)
838 schedule();
839 current->state = TASK_RUNNING;
840 remove_wait_queue(&s->remove_ok, &__wait);
841
842 s->usbdev = NULL;
843 s->overruns = 0;
844 }
845 }
846
847 static struct usb_device_id dabusb_ids [] = {
848 // { USB_DEVICE(0x0547, 0x2131) }, /* An2131 chip, no boot ROM */
849 { USB_DEVICE(0x0547, 0x9999) },
850 { } /* Terminating entry */
851 };
852
853 MODULE_DEVICE_TABLE (usb, dabusb_ids);
854
855 static struct usb_driver dabusb_driver = {
856 .name = "dabusb",
857 .probe = dabusb_probe,
858 .disconnect = dabusb_disconnect,
859 .id_table = dabusb_ids,
860 };
861
862 /* --------------------------------------------------------------------- */
863
864 static int __init dabusb_init (void)
865 {
866 int retval;
867 unsigned u;
868
869 /* initialize struct */
870 for (u = 0; u < NRDABUSB; u++) {
871 pdabusb_t s = &dabusb[u];
872 memset (s, 0, sizeof (dabusb_t));
873 mutex_init (&s->mutex);
874 s->usbdev = NULL;
875 s->total_buffer_size = buffers;
876 init_waitqueue_head (&s->wait);
877 init_waitqueue_head (&s->remove_ok);
878 spin_lock_init (&s->lock);
879 INIT_LIST_HEAD (&s->free_buff_list);
880 INIT_LIST_HEAD (&s->rec_buff_list);
881 }
882
883 /* register misc device */
884 retval = usb_register(&dabusb_driver);
885 if (retval)
886 goto out;
887
888 dbg("dabusb_init: driver registered");
889
890 printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
891 DRIVER_DESC "\n");
892
893 out:
894 return retval;
895 }
896
897 static void __exit dabusb_cleanup (void)
898 {
899 dbg("dabusb_cleanup");
900
901 usb_deregister (&dabusb_driver);
902 }
903
904 /* --------------------------------------------------------------------- */
905
906 MODULE_AUTHOR( DRIVER_AUTHOR );
907 MODULE_DESCRIPTION( DRIVER_DESC );
908 MODULE_LICENSE("GPL");
909
910 module_param(buffers, int, 0);
911 MODULE_PARM_DESC (buffers, "Number of buffers (default=256)");
912
913 module_init (dabusb_init);
914 module_exit (dabusb_cleanup);
915
916 /* --------------------------------------------------------------------- */
Linux kernel - Deliverables
This page took 0.050018 seconds and 4 git commands to generate.