1 /*****************************************************************************/
4 * dabusb.c -- dab usb driver.
6 * Copyright (C) 1999 Deti Fliegl (deti@fliegl.de)
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.
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.
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.
24 * $Id: dabusb.c,v 1.54 2000/07/24 21:39:39 deti Exp $
28 /*****************************************************************************/
30 #include <linux/module.h>
31 #include <linux/socket.h>
32 #include <linux/miscdevice.h>
33 #include <linux/list.h>
34 #include <linux/vmalloc.h>
35 #include <linux/slab.h>
36 #include <linux/init.h>
37 #include <asm/uaccess.h>
38 #include <asm/atomic.h>
39 #include <linux/delay.h>
40 #include <linux/usb.h>
41 #include <linux/smp_lock.h>
44 #include "dabfirmware.h"
46 /* --------------------------------------------------------------------- */
50 /*-------------------------------------------------------------------*/
52 static dabusb_t dabusb
[NRDABUSB
];
53 static int buffers
= 256;
55 /*-------------------------------------------------------------------*/
57 static int dabusb_add_buf_tail (pdabusb_t s
, struct list_head
*dst
, struct list_head
*src
)
60 struct list_head
*tmp
;
63 spin_lock_irqsave (&s
->lock
, flags
);
65 if (list_empty (src
)) {
66 // no elements in source buffer
72 list_add_tail (tmp
, dst
);
74 err
: spin_unlock_irqrestore (&s
->lock
, flags
);
77 /*-------------------------------------------------------------------*/
79 static void dump_urb (purb_t purb
)
82 dbg("next :%p", purb
->next
);
83 dbg("dev :%p", purb
->dev
);
84 dbg("pipe :%08X", purb
->pipe
);
85 dbg("status :%d", purb
->status
);
86 dbg("transfer_flags :%08X", purb
->transfer_flags
);
87 dbg("transfer_buffer :%p", purb
->transfer_buffer
);
88 dbg("transfer_buffer_length:%d", purb
->transfer_buffer_length
);
89 dbg("actual_length :%d", purb
->actual_length
);
90 dbg("setup_packet :%p", purb
->setup_packet
);
91 dbg("start_frame :%d", purb
->start_frame
);
92 dbg("number_of_packets :%d", purb
->number_of_packets
);
93 dbg("interval :%d", purb
->interval
);
94 dbg("error_count :%d", purb
->error_count
);
95 dbg("context :%p", purb
->context
);
96 dbg("complete :%p", purb
->complete
);
99 /*-------------------------------------------------------------------*/
100 static int dabusb_cancel_queue (pdabusb_t s
, struct list_head
*q
)
106 dbg("dabusb_cancel_queue");
108 spin_lock_irqsave (&s
->lock
, flags
);
110 for (p
= q
->next
; p
!= q
; p
= p
->next
) {
111 b
= list_entry (p
, buff_t
, buff_list
);
116 usb_unlink_urb (b
->purb
);
118 spin_unlock_irqrestore (&s
->lock
, flags
);
121 /*-------------------------------------------------------------------*/
122 static int dabusb_free_queue (struct list_head
*q
)
124 struct list_head
*tmp
;
128 dbg("dabusb_free_queue");
129 for (p
= q
->next
; p
!= q
;) {
130 b
= list_entry (p
, buff_t
, buff_list
);
135 if (b
->purb
->transfer_buffer
)
136 kfree (b
->purb
->transfer_buffer
);
137 usb_free_urb(b
->purb
);
146 /*-------------------------------------------------------------------*/
147 static int dabusb_free_buffers (pdabusb_t s
)
150 dbg("dabusb_free_buffers");
152 spin_lock_irqsave(&s
->lock
, flags
);
154 dabusb_free_queue (&s
->free_buff_list
);
155 dabusb_free_queue (&s
->rec_buff_list
);
157 spin_unlock_irqrestore(&s
->lock
, flags
);
162 /*-------------------------------------------------------------------*/
163 static void dabusb_iso_complete (purb_t purb
)
165 pbuff_t b
= purb
->context
;
170 void *buf
= purb
->transfer_buffer
;
172 dbg("dabusb_iso_complete");
174 // process if URB was not killed
175 if (purb
->status
!= -ENOENT
) {
176 unsigned int pipe
= usb_rcvisocpipe (purb
->dev
, _DABUSB_ISOPIPE
);
177 int pipesize
= usb_maxpacket (purb
->dev
, pipe
, usb_pipeout (pipe
));
178 for (i
= 0; i
< purb
->number_of_packets
; i
++)
179 if (!purb
->iso_frame_desc
[i
].status
) {
180 len
= purb
->iso_frame_desc
[i
].actual_length
;
181 if (len
<= pipesize
) {
182 memcpy (buf
+ dst
, buf
+ purb
->iso_frame_desc
[i
].offset
, len
);
186 err("dabusb_iso_complete: invalid len %d", len
);
189 warn("dabusb_iso_complete: corrupted packet status: %d", purb
->iso_frame_desc
[i
].status
);
190 if (dst
!= purb
->actual_length
)
191 err("dst!=purb->actual_length:%d!=%d", dst
, purb
->actual_length
);
194 if (atomic_dec_and_test (&s
->pending_io
) && !s
->remove_pending
&& s
->state
!= _stopped
) {
196 err("overrun (%d)", s
->overruns
);
200 /*-------------------------------------------------------------------*/
201 static int dabusb_alloc_buffers (pdabusb_t s
)
205 unsigned int pipe
= usb_rcvisocpipe (s
->usbdev
, _DABUSB_ISOPIPE
);
206 int pipesize
= usb_maxpacket (s
->usbdev
, pipe
, usb_pipeout (pipe
));
207 int packets
= _ISOPIPESIZE
/ pipesize
;
208 int transfer_buffer_length
= packets
* pipesize
;
211 dbg("dabusb_alloc_buffers pipesize:%d packets:%d transfer_buffer_len:%d",
212 pipesize
, packets
, transfer_buffer_length
);
214 while (buffers
< (s
->total_buffer_size
<< 10)) {
215 b
= (pbuff_t
) kmalloc (sizeof (buff_t
), GFP_KERNEL
);
217 err("kmalloc(sizeof(buff_t))==NULL");
220 memset (b
, sizeof (buff_t
), 0);
222 b
->purb
= usb_alloc_urb(packets
);
224 err("usb_alloc_urb == NULL");
229 b
->purb
->transfer_buffer
= kmalloc (transfer_buffer_length
, GFP_KERNEL
);
230 if (!b
->purb
->transfer_buffer
) {
233 err("kmalloc(%d)==NULL", transfer_buffer_length
);
237 b
->purb
->transfer_buffer_length
= transfer_buffer_length
;
238 b
->purb
->number_of_packets
= packets
;
239 b
->purb
->complete
= dabusb_iso_complete
;
240 b
->purb
->context
= b
;
241 b
->purb
->dev
= s
->usbdev
;
242 b
->purb
->pipe
= pipe
;
243 b
->purb
->transfer_flags
= USB_ISO_ASAP
;
245 for (i
= 0; i
< packets
; i
++) {
246 b
->purb
->iso_frame_desc
[i
].offset
= i
* pipesize
;
247 b
->purb
->iso_frame_desc
[i
].length
= pipesize
;
250 buffers
+= transfer_buffer_length
;
251 list_add_tail (&b
->buff_list
, &s
->free_buff_list
);
253 s
->got_mem
= buffers
;
258 dabusb_free_buffers (s
);
261 /*-------------------------------------------------------------------*/
262 static int dabusb_bulk (pdabusb_t s
, pbulk_transfer_t pb
)
271 pipe
= usb_rcvbulkpipe (s
->usbdev
, 2);
273 pipe
= usb_sndbulkpipe (s
->usbdev
, 2);
275 ret
=usb_bulk_msg(s
->usbdev
, pipe
, pb
->data
, pb
->size
, &actual_length
, 100);
277 err("dabusb: usb_bulk_msg failed(%d)",ret
);
279 if (usb_set_interface (s
->usbdev
, _DABUSB_IF
, 1) < 0) {
280 err("set_interface failed");
286 if( ret
== -EPIPE
) {
287 warn("CLEAR_FEATURE request to remove STALL condition.");
288 if(usb_clear_halt(s
->usbdev
, usb_pipeendpoint(pipe
)))
289 err("request failed");
292 pb
->size
= actual_length
;
295 /* --------------------------------------------------------------------- */
296 static int dabusb_writemem (pdabusb_t s
, int pos
, unsigned char *data
, int len
)
299 unsigned char *transfer_buffer
= kmalloc (len
, GFP_KERNEL
);
301 if (!transfer_buffer
) {
302 err("dabusb_writemem: kmalloc(%d) failed.", len
);
306 memcpy (transfer_buffer
, data
, len
);
308 ret
=usb_control_msg(s
->usbdev
, usb_sndctrlpipe( s
->usbdev
, 0 ), 0xa0, 0x40, pos
, 0, transfer_buffer
, len
, 300);
310 kfree (transfer_buffer
);
313 /* --------------------------------------------------------------------- */
314 static int dabusb_8051_reset (pdabusb_t s
, unsigned char reset_bit
)
316 dbg("dabusb_8051_reset: %d",reset_bit
);
317 return dabusb_writemem (s
, CPUCS_REG
, &reset_bit
, 1);
319 /* --------------------------------------------------------------------- */
320 static int dabusb_loadmem (pdabusb_t s
, const char *fname
)
323 PINTEL_HEX_RECORD ptr
= firmware
;
325 dbg("Enter dabusb_loadmem (internal)");
327 ret
= dabusb_8051_reset (s
, 1);
328 while (ptr
->Type
== 0) {
330 dbg("dabusb_writemem: %04X %p %d)", ptr
->Address
, ptr
->Data
, ptr
->Length
);
332 ret
= dabusb_writemem (s
, ptr
->Address
, ptr
->Data
, ptr
->Length
);
334 err("dabusb_writemem failed (%d %04X %p %d)", ret
, ptr
->Address
, ptr
->Data
, ptr
->Length
);
339 ret
= dabusb_8051_reset (s
, 0);
341 dbg("dabusb_loadmem: exit");
345 /* --------------------------------------------------------------------- */
346 static int dabusb_fpga_clear (pdabusb_t s
, pbulk_transfer_t b
)
354 dbg("dabusb_fpga_clear");
356 return dabusb_bulk (s
, b
);
358 /* --------------------------------------------------------------------- */
359 static int dabusb_fpga_init (pdabusb_t s
, pbulk_transfer_t b
)
367 dbg("dabusb_fpga_init");
369 return dabusb_bulk (s
, b
);
371 /* --------------------------------------------------------------------- */
372 static int dabusb_fpga_download (pdabusb_t s
, const char *fname
)
374 pbulk_transfer_t b
= kmalloc (sizeof (bulk_transfer_t
), GFP_KERNEL
);
375 unsigned int blen
, n
;
377 unsigned char *buf
= bitstream
;
379 dbg("Enter dabusb_fpga_download (internal)");
382 err("kmalloc(sizeof(bulk_transfer_t))==NULL");
387 ret
= dabusb_fpga_clear (s
, b
);
389 blen
= buf
[73] + (buf
[72] << 8);
391 dbg("Bitstream len: %i", blen
);
398 for (n
= 0; n
<= blen
+ 60; n
+= 60) {
399 // some cclks for startup
401 memcpy (b
->data
+ 4, buf
+ 74 + n
, 60);
402 ret
= dabusb_bulk (s
, b
);
404 err("dabusb_bulk failed.");
410 ret
= dabusb_fpga_init (s
, b
);
413 dbg("exit dabusb_fpga_download");
418 static loff_t
dabusb_llseek (struct file
*file
, loff_t offset
, int origin
)
423 static int dabusb_stop (pdabusb_t s
)
428 dabusb_cancel_queue (s
, &s
->rec_buff_list
);
430 dbg("pending_io: %d", s
->pending_io
.counter
);
432 s
->pending_io
.counter
= 0;
436 static int dabusb_startrek (pdabusb_t s
)
438 if (!s
->got_mem
&& s
->state
!= _started
) {
440 dbg("dabusb_startrek");
442 if (dabusb_alloc_buffers (s
) < 0)
449 if (!list_empty (&s
->free_buff_list
)) {
453 while (!dabusb_add_buf_tail (s
, &s
->rec_buff_list
, &s
->free_buff_list
)) {
455 dbg("submitting: end:%p s->rec_buff_list:%p", s
->rec_buff_list
.prev
, &s
->rec_buff_list
);
457 end
= list_entry (s
->rec_buff_list
.prev
, buff_t
, buff_list
);
459 ret
= usb_submit_urb (end
->purb
);
461 err("usb_submit_urb returned:%d", ret
);
462 if (dabusb_add_buf_tail (s
, &s
->free_buff_list
, &s
->rec_buff_list
))
463 err("startrek: dabusb_add_buf_tail failed");
467 atomic_inc (&s
->pending_io
);
469 dbg("pending_io: %d",s
->pending_io
.counter
);
475 static ssize_t
dabusb_read (struct file
*file
, char *buf
, size_t count
, loff_t
* ppos
)
477 pdabusb_t s
= (pdabusb_t
) file
->private_data
;
490 if (s
->remove_pending
)
500 spin_lock_irqsave (&s
->lock
, flags
);
502 if (list_empty (&s
->rec_buff_list
)) {
504 spin_unlock_irqrestore(&s
->lock
, flags
);
506 err("error: rec_buf_list is empty");
510 b
= list_entry (s
->rec_buff_list
.next
, buff_t
, buff_list
);
513 spin_unlock_irqrestore(&s
->lock
, flags
);
515 if (purb
->status
== -EINPROGRESS
) {
516 if (file
->f_flags
& O_NONBLOCK
) // return nonblocking
523 interruptible_sleep_on (&s
->wait
);
525 if (signal_pending (current
)) {
531 spin_lock_irqsave (&s
->lock
, flags
);
533 if (list_empty (&s
->rec_buff_list
)) {
534 spin_unlock_irqrestore(&s
->lock
, flags
);
535 err("error: still no buffer available.");
538 spin_unlock_irqrestore(&s
->lock
, flags
);
541 if (s
->remove_pending
) {
546 rem
= purb
->actual_length
- s
->readptr
; // set remaining bytes to copy
553 dbg("copy_to_user:%p %p %d",buf
, purb
->transfer_buffer
+ s
->readptr
, cnt
);
555 if (copy_to_user (buf
, purb
->transfer_buffer
+ s
->readptr
, cnt
)) {
556 err("read: copy_to_user failed");
567 if (s
->readptr
== purb
->actual_length
) {
568 // finished, take next buffer
569 if (dabusb_add_buf_tail (s
, &s
->free_buff_list
, &s
->rec_buff_list
))
570 err("read: dabusb_add_buf_tail failed");
574 err
: //up(&s->mutex);
578 static int dabusb_open (struct inode
*inode
, struct file
*file
)
580 int devnum
= MINOR (inode
->i_rdev
);
583 if (devnum
< DABUSB_MINOR
|| devnum
>= (DABUSB_MINOR
+ NRDABUSB
))
586 s
= &dabusb
[devnum
- DABUSB_MINOR
];
591 while (!s
->usbdev
|| s
->opened
) {
594 if (file
->f_flags
& O_NONBLOCK
) {
597 schedule_timeout (HZ
/ 2);
599 if (signal_pending (current
)) {
604 if (usb_set_interface (s
->usbdev
, _DABUSB_IF
, 1) < 0) {
605 err("set_interface failed");
612 file
->private_data
= s
;
617 static int dabusb_release (struct inode
*inode
, struct file
*file
)
619 pdabusb_t s
= (pdabusb_t
) file
->private_data
;
621 dbg("dabusb_release");
626 dabusb_free_buffers (s
);
629 if (!s
->remove_pending
) {
630 if (usb_set_interface (s
->usbdev
, _DABUSB_IF
, 0) < 0)
631 err("set_interface failed");
634 wake_up (&s
->remove_ok
);
641 static int dabusb_ioctl (struct inode
*inode
, struct file
*file
, unsigned int cmd
, unsigned long arg
)
643 pdabusb_t s
= (pdabusb_t
) file
->private_data
;
644 pbulk_transfer_t pbulk
;
646 int version
= DABUSB_VERSION
;
650 if (s
->remove_pending
)
663 pbulk
= (pbulk_transfer_t
) kmalloc (sizeof (bulk_transfer_t
), GFP_KERNEL
);
670 if (copy_from_user (pbulk
, (void *) arg
, sizeof (bulk_transfer_t
))) {
676 ret
=dabusb_bulk (s
, pbulk
);
678 ret
= copy_to_user ((void *) arg
, pbulk
, sizeof (bulk_transfer_t
));
682 case IOCTL_DAB_OVERRUNS
:
683 ret
= put_user (s
->overruns
, (unsigned int *) arg
);
686 case IOCTL_DAB_VERSION
:
687 ret
= put_user (version
, (unsigned int *) arg
);
698 static struct file_operations dabusb_fops
=
701 llseek
: dabusb_llseek
,
705 release
: dabusb_release
,
708 static int dabusb_find_struct (void)
712 for (u
= 0; u
< NRDABUSB
; u
++) {
713 pdabusb_t s
= &dabusb
[u
];
720 /* --------------------------------------------------------------------- */
721 static void *dabusb_probe (struct usb_device
*usbdev
, unsigned int ifnum
)
726 dbg("dabusb: probe: vendor id 0x%x, device id 0x%x ifnum:%d",
727 usbdev
->descriptor
.idVendor
, usbdev
->descriptor
.idProduct
, ifnum
);
729 /* the 1234:5678 is just a self assigned test ID */
730 if ((usbdev
->descriptor
.idVendor
!= 0x0547 || usbdev
->descriptor
.idProduct
!= 0x2131) &&
731 (usbdev
->descriptor
.idVendor
!= 0x0547 || usbdev
->descriptor
.idProduct
!= 0x9999))
734 /* We don't handle multiple configurations */
735 if (usbdev
->descriptor
.bNumConfigurations
!= 1)
738 if (ifnum
!= _DABUSB_IF
&& usbdev
->descriptor
.idProduct
== 0x9999)
741 devnum
= dabusb_find_struct ();
748 s
->remove_pending
= 0;
751 if (usb_set_configuration (usbdev
, usbdev
->config
[0].bConfigurationValue
) < 0) {
752 err("set_configuration failed");
755 if (usbdev
->descriptor
.idProduct
== 0x2131) {
756 dabusb_loadmem (s
, NULL
);
760 dabusb_fpga_download (s
, NULL
);
762 if (usb_set_interface (s
->usbdev
, _DABUSB_IF
, 0) < 0) {
763 err("set_interface failed");
767 dbg("bound to interface: %d", ifnum
);
778 static void dabusb_disconnect (struct usb_device
*usbdev
, void *ptr
)
780 pdabusb_t s
= (pdabusb_t
) ptr
;
782 dbg("dabusb_disconnect");
784 s
->remove_pending
= 1;
786 if (s
->state
== _started
)
787 sleep_on (&s
->remove_ok
);
793 static struct usb_driver dabusb_driver
=
803 /* --------------------------------------------------------------------- */
805 static int __init
dabusb_init (void)
809 /* initialize struct */
810 for (u
= 0; u
< NRDABUSB
; u
++) {
811 pdabusb_t s
= &dabusb
[u
];
812 memset (s
, 0, sizeof (dabusb_t
));
813 init_MUTEX (&s
->mutex
);
815 s
->total_buffer_size
= buffers
;
816 init_waitqueue_head (&s
->wait
);
817 init_waitqueue_head (&s
->remove_ok
);
818 spin_lock_init (&s
->lock
);
819 INIT_LIST_HEAD (&s
->free_buff_list
);
820 INIT_LIST_HEAD (&s
->rec_buff_list
);
823 /* register misc device */
824 if (usb_register(&dabusb_driver
))
827 dbg("dabusb_init: driver registered");
831 static void __exit
dabusb_cleanup (void)
833 dbg("dabusb_cleanup");
835 usb_deregister (&dabusb_driver
);
838 /* --------------------------------------------------------------------- */
841 MODULE_AUTHOR ("Deti Fliegl, deti@fliegl.de");
842 MODULE_DESCRIPTION ("DAB-USB Interface Driver for Linux (c)1999");
843 MODULE_PARM (buffers
, "i");
844 MODULE_PARM_DESC (buffers
, "Number of buffers (default=256)");
846 module_init (dabusb_init
);
847 module_exit (dabusb_cleanup
);
852 /* --------------------------------------------------------------------- */