2 * USB Empeg empeg-car player driver
4 * Copyright (C) 2000, 2001
5 * Gary Brubaker (xavyer@ix.netcom.com)
7 * Copyright (C) 1999 - 2001
8 * Greg Kroah-Hartman (greg@kroah.com)
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License, as published by
12 * the Free Software Foundation, version 2.
14 * See Documentation/usb/usb-serial.txt for more information on using this driver
17 * remove unused code in empeg_close() (thanks to Oliver Neukum for pointing this
18 * out) and rewrote empeg_set_termios().
21 * switched from using spinlock to a semaphore, which fixes lots of problems.
24 * Identify version on module load.
27 * Added write_room() and chars_in_buffer() support.
30 * Moved termio stuff inside the port->active check.
31 * Moved MOD_DEC_USE_COUNT to end of empeg_close().
34 * Added port->tty->ldisc.set_termios(port->tty, NULL) to empeg_open()
35 * This notifies the tty driver that the termios have changed.
38 * Moved tty->low_latency = 1 from empeg_read_bulk_callback() to empeg_open()
39 * (It only needs to be set once - Doh!)
42 * Updated to work with id_table structure.
45 * Forked this from visor.c, and hacked it up to work with an
46 * Empeg ltd. empeg-car player. Constructive criticism welcomed.
47 * I would like to say, 'Thank You' to Greg Kroah-Hartman for the
48 * use of his code, and for his guidance, advice and patience. :)
49 * A 'Thank You' is in order for John Ripley of Empeg ltd for his
50 * advice, and patience too.
54 #include <linux/kernel.h>
55 #include <linux/errno.h>
56 #include <linux/init.h>
57 #include <linux/slab.h>
58 #include <linux/tty.h>
59 #include <linux/tty_driver.h>
60 #include <linux/tty_flip.h>
61 #include <linux/module.h>
62 #include <linux/spinlock.h>
63 #include <asm/uaccess.h>
64 #include <linux/usb.h>
65 #include <linux/usb/serial.h>
72 #define DRIVER_VERSION "v1.2"
73 #define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com>, Gary Brubaker <xavyer@ix.netcom.com>"
74 #define DRIVER_DESC "USB Empeg Mark I/II Driver"
76 #define EMPEG_VENDOR_ID 0x084f
77 #define EMPEG_PRODUCT_ID 0x0001
79 /* function prototypes for an empeg-car player */
80 static int empeg_open (struct usb_serial_port
*port
, struct file
*filp
);
81 static void empeg_close (struct usb_serial_port
*port
, struct file
*filp
);
82 static int empeg_write (struct usb_serial_port
*port
,
83 const unsigned char *buf
,
85 static int empeg_write_room (struct usb_serial_port
*port
);
86 static int empeg_chars_in_buffer (struct usb_serial_port
*port
);
87 static void empeg_throttle (struct usb_serial_port
*port
);
88 static void empeg_unthrottle (struct usb_serial_port
*port
);
89 static int empeg_startup (struct usb_serial
*serial
);
90 static void empeg_shutdown (struct usb_serial
*serial
);
91 static int empeg_ioctl (struct usb_serial_port
*port
,
95 static void empeg_set_termios (struct usb_serial_port
*port
, struct termios
*old_termios
);
96 static void empeg_write_bulk_callback (struct urb
*urb
, struct pt_regs
*regs
);
97 static void empeg_read_bulk_callback (struct urb
*urb
, struct pt_regs
*regs
);
99 static struct usb_device_id id_table
[] = {
100 { USB_DEVICE(EMPEG_VENDOR_ID
, EMPEG_PRODUCT_ID
) },
101 { } /* Terminating entry */
104 MODULE_DEVICE_TABLE (usb
, id_table
);
106 static struct usb_driver empeg_driver
= {
108 .probe
= usb_serial_probe
,
109 .disconnect
= usb_serial_disconnect
,
110 .id_table
= id_table
,
114 static struct usb_serial_driver empeg_device
= {
116 .owner
= THIS_MODULE
,
119 .id_table
= id_table
,
120 .num_interrupt_in
= 0,
125 .close
= empeg_close
,
126 .throttle
= empeg_throttle
,
127 .unthrottle
= empeg_unthrottle
,
128 .attach
= empeg_startup
,
129 .shutdown
= empeg_shutdown
,
130 .ioctl
= empeg_ioctl
,
131 .set_termios
= empeg_set_termios
,
132 .write
= empeg_write
,
133 .write_room
= empeg_write_room
,
134 .chars_in_buffer
= empeg_chars_in_buffer
,
135 .write_bulk_callback
= empeg_write_bulk_callback
,
136 .read_bulk_callback
= empeg_read_bulk_callback
,
140 #define URB_TRANSFER_BUFFER_SIZE 4096
142 static struct urb
*write_urb_pool
[NUM_URBS
];
143 static spinlock_t write_urb_pool_lock
;
145 static int bytes_out
;
147 /******************************************************************************
148 * Empeg specific driver functions
149 ******************************************************************************/
150 static int empeg_open (struct usb_serial_port
*port
, struct file
*filp
)
152 struct usb_serial
*serial
= port
->serial
;
155 dbg("%s - port %d", __FUNCTION__
, port
->number
);
157 /* Force default termio settings */
158 empeg_set_termios (port
, NULL
) ;
163 /* Start reading from the device */
167 usb_rcvbulkpipe(serial
->dev
,
168 port
->bulk_in_endpointAddress
),
169 port
->read_urb
->transfer_buffer
,
170 port
->read_urb
->transfer_buffer_length
,
171 empeg_read_bulk_callback
,
174 result
= usb_submit_urb(port
->read_urb
, GFP_KERNEL
);
177 dev_err(&port
->dev
, "%s - failed submitting read urb, error %d\n", __FUNCTION__
, result
);
183 static void empeg_close (struct usb_serial_port
*port
, struct file
* filp
)
185 dbg("%s - port %d", __FUNCTION__
, port
->number
);
187 /* shutdown our bulk read */
188 usb_kill_urb(port
->read_urb
);
189 /* Uncomment the following line if you want to see some statistics in your syslog */
190 /* dev_info (&port->dev, "Bytes In = %d Bytes Out = %d\n", bytes_in, bytes_out); */
194 static int empeg_write (struct usb_serial_port
*port
, const unsigned char *buf
, int count
)
196 struct usb_serial
*serial
= port
->serial
;
198 const unsigned char *current_position
= buf
;
205 dbg("%s - port %d", __FUNCTION__
, port
->number
);
209 /* try to find a free urb in our list of them */
212 spin_lock_irqsave (&write_urb_pool_lock
, flags
);
214 for (i
= 0; i
< NUM_URBS
; ++i
) {
215 if (write_urb_pool
[i
]->status
!= -EINPROGRESS
) {
216 urb
= write_urb_pool
[i
];
221 spin_unlock_irqrestore (&write_urb_pool_lock
, flags
);
224 dbg("%s - no more free urbs", __FUNCTION__
);
228 if (urb
->transfer_buffer
== NULL
) {
229 urb
->transfer_buffer
= kmalloc (URB_TRANSFER_BUFFER_SIZE
, GFP_ATOMIC
);
230 if (urb
->transfer_buffer
== NULL
) {
231 dev_err(&port
->dev
, "%s no more kernel memory...\n", __FUNCTION__
);
236 transfer_size
= min (count
, URB_TRANSFER_BUFFER_SIZE
);
238 memcpy (urb
->transfer_buffer
, current_position
, transfer_size
);
240 usb_serial_debug_data(debug
, &port
->dev
, __FUNCTION__
, transfer_size
, urb
->transfer_buffer
);
242 /* build up our urb */
246 usb_sndbulkpipe(serial
->dev
,
247 port
->bulk_out_endpointAddress
),
248 urb
->transfer_buffer
,
250 empeg_write_bulk_callback
,
253 /* send it down the pipe */
254 status
= usb_submit_urb(urb
, GFP_ATOMIC
);
256 dev_err(&port
->dev
, "%s - usb_submit_urb(write bulk) failed with status = %d\n", __FUNCTION__
, status
);
261 current_position
+= transfer_size
;
262 bytes_sent
+= transfer_size
;
263 count
-= transfer_size
;
264 bytes_out
+= transfer_size
;
274 static int empeg_write_room (struct usb_serial_port
*port
)
280 dbg("%s - port %d", __FUNCTION__
, port
->number
);
282 spin_lock_irqsave (&write_urb_pool_lock
, flags
);
284 /* tally up the number of bytes available */
285 for (i
= 0; i
< NUM_URBS
; ++i
) {
286 if (write_urb_pool
[i
]->status
!= -EINPROGRESS
) {
287 room
+= URB_TRANSFER_BUFFER_SIZE
;
291 spin_unlock_irqrestore (&write_urb_pool_lock
, flags
);
293 dbg("%s - returns %d", __FUNCTION__
, room
);
300 static int empeg_chars_in_buffer (struct usb_serial_port
*port
)
306 dbg("%s - port %d", __FUNCTION__
, port
->number
);
308 spin_lock_irqsave (&write_urb_pool_lock
, flags
);
310 /* tally up the number of bytes waiting */
311 for (i
= 0; i
< NUM_URBS
; ++i
) {
312 if (write_urb_pool
[i
]->status
== -EINPROGRESS
) {
313 chars
+= URB_TRANSFER_BUFFER_SIZE
;
317 spin_unlock_irqrestore (&write_urb_pool_lock
, flags
);
319 dbg("%s - returns %d", __FUNCTION__
, chars
);
326 static void empeg_write_bulk_callback (struct urb
*urb
, struct pt_regs
*regs
)
328 struct usb_serial_port
*port
= (struct usb_serial_port
*)urb
->context
;
330 dbg("%s - port %d", __FUNCTION__
, port
->number
);
333 dbg("%s - nonzero write bulk status received: %d", __FUNCTION__
, urb
->status
);
337 usb_serial_port_softint(port
);
341 static void empeg_read_bulk_callback (struct urb
*urb
, struct pt_regs
*regs
)
343 struct usb_serial_port
*port
= (struct usb_serial_port
*)urb
->context
;
344 struct tty_struct
*tty
;
345 unsigned char *data
= urb
->transfer_buffer
;
348 dbg("%s - port %d", __FUNCTION__
, port
->number
);
351 dbg("%s - nonzero read bulk status received: %d", __FUNCTION__
, urb
->status
);
355 usb_serial_debug_data(debug
, &port
->dev
, __FUNCTION__
, urb
->actual_length
, data
);
359 if (urb
->actual_length
) {
360 tty_buffer_request_room(tty
, urb
->actual_length
);
361 tty_insert_flip_string(tty
, data
, urb
->actual_length
);
362 tty_flip_buffer_push(tty
);
363 bytes_in
+= urb
->actual_length
;
366 /* Continue trying to always read */
370 usb_rcvbulkpipe(port
->serial
->dev
,
371 port
->bulk_in_endpointAddress
),
372 port
->read_urb
->transfer_buffer
,
373 port
->read_urb
->transfer_buffer_length
,
374 empeg_read_bulk_callback
,
377 result
= usb_submit_urb(port
->read_urb
, GFP_ATOMIC
);
380 dev_err(&urb
->dev
->dev
, "%s - failed resubmitting read urb, error %d\n", __FUNCTION__
, result
);
387 static void empeg_throttle (struct usb_serial_port
*port
)
389 dbg("%s - port %d", __FUNCTION__
, port
->number
);
390 usb_kill_urb(port
->read_urb
);
394 static void empeg_unthrottle (struct usb_serial_port
*port
)
398 dbg("%s - port %d", __FUNCTION__
, port
->number
);
400 port
->read_urb
->dev
= port
->serial
->dev
;
402 result
= usb_submit_urb(port
->read_urb
, GFP_ATOMIC
);
405 dev_err(&port
->dev
, "%s - failed submitting read urb, error %d\n", __FUNCTION__
, result
);
411 static int empeg_startup (struct usb_serial
*serial
)
415 dbg("%s", __FUNCTION__
);
417 if (serial
->dev
->actconfig
->desc
.bConfigurationValue
!= 1) {
418 err("active config #%d != 1 ??",
419 serial
->dev
->actconfig
->desc
.bConfigurationValue
);
422 dbg("%s - reset config", __FUNCTION__
);
423 r
= usb_reset_configuration (serial
->dev
);
425 /* continue on with initialization */
431 static void empeg_shutdown (struct usb_serial
*serial
)
433 dbg ("%s", __FUNCTION__
);
437 static int empeg_ioctl (struct usb_serial_port
*port
, struct file
* file
, unsigned int cmd
, unsigned long arg
)
439 dbg("%s - port %d, cmd 0x%.4x", __FUNCTION__
, port
->number
, cmd
);
445 static void empeg_set_termios (struct usb_serial_port
*port
, struct termios
*old_termios
)
448 dbg("%s - port %d", __FUNCTION__
, port
->number
);
450 if ((!port
->tty
) || (!port
->tty
->termios
)) {
451 dbg("%s - no tty structures", __FUNCTION__
);
456 * The empeg-car player wants these particular tty settings.
457 * You could, for example, change the baud rate, however the
458 * player only supports 115200 (currently), so there is really
459 * no point in support for changes to the tty settings.
462 * The default requirements for this device are:
464 port
->tty
->termios
->c_iflag
465 &= ~(IGNBRK
/* disable ignore break */
466 | BRKINT
/* disable break causes interrupt */
467 | PARMRK
/* disable mark parity errors */
468 | ISTRIP
/* disable clear high bit of input characters */
469 | INLCR
/* disable translate NL to CR */
470 | IGNCR
/* disable ignore CR */
471 | ICRNL
/* disable translate CR to NL */
472 | IXON
); /* disable enable XON/XOFF flow control */
474 port
->tty
->termios
->c_oflag
475 &= ~OPOST
; /* disable postprocess output characters */
477 port
->tty
->termios
->c_lflag
478 &= ~(ECHO
/* disable echo input characters */
479 | ECHONL
/* disable echo new line */
480 | ICANON
/* disable erase, kill, werase, and rprnt special characters */
481 | ISIG
/* disable interrupt, quit, and suspend special characters */
482 | IEXTEN
); /* disable non-POSIX special characters */
484 port
->tty
->termios
->c_cflag
485 &= ~(CSIZE
/* no size */
486 | PARENB
/* disable parity bit */
487 | CBAUD
); /* clear current baud rate */
489 port
->tty
->termios
->c_cflag
490 |= (CS8
/* character size 8 bits */
491 | B115200
); /* baud rate 115200 */
494 * Force low_latency on; otherwise the pushes are scheduled;
495 * this is bad as it opens up the possibility of dropping bytes
496 * on the floor. We don't want to drop bytes on the floor. :)
498 port
->tty
->low_latency
= 1;
504 static int __init
empeg_init (void)
509 /* create our write urb pool and transfer buffers */
510 spin_lock_init (&write_urb_pool_lock
);
511 for (i
= 0; i
< NUM_URBS
; ++i
) {
512 urb
= usb_alloc_urb(0, GFP_KERNEL
);
513 write_urb_pool
[i
] = urb
;
515 err("No more urbs???");
519 urb
->transfer_buffer
= kmalloc (URB_TRANSFER_BUFFER_SIZE
, GFP_KERNEL
);
520 if (!urb
->transfer_buffer
) {
521 err("%s - out of memory for urb buffers.",
527 retval
= usb_serial_register(&empeg_device
);
529 goto failed_usb_serial_register
;
530 retval
= usb_register(&empeg_driver
);
532 goto failed_usb_register
;
534 info(DRIVER_VERSION
":" DRIVER_DESC
);
538 usb_serial_deregister(&empeg_device
);
539 failed_usb_serial_register
:
540 for (i
= 0; i
< NUM_URBS
; ++i
) {
541 if (write_urb_pool
[i
]) {
542 kfree(write_urb_pool
[i
]->transfer_buffer
);
543 usb_free_urb(write_urb_pool
[i
]);
550 static void __exit
empeg_exit (void)
555 usb_deregister(&empeg_driver
);
556 usb_serial_deregister (&empeg_device
);
558 spin_lock_irqsave (&write_urb_pool_lock
, flags
);
560 for (i
= 0; i
< NUM_URBS
; ++i
) {
561 if (write_urb_pool
[i
]) {
562 /* FIXME - uncomment the following usb_kill_urb call when
563 * the host controllers get fixed to set urb->dev = NULL after
564 * the urb is finished. Otherwise this call oopses. */
565 /* usb_kill_urb(write_urb_pool[i]); */
566 kfree(write_urb_pool
[i
]->transfer_buffer
);
567 usb_free_urb (write_urb_pool
[i
]);
571 spin_unlock_irqrestore (&write_urb_pool_lock
, flags
);
575 module_init(empeg_init
);
576 module_exit(empeg_exit
);
578 MODULE_AUTHOR( DRIVER_AUTHOR
);
579 MODULE_DESCRIPTION( DRIVER_DESC
);
580 MODULE_LICENSE("GPL");
582 module_param(debug
, bool, S_IRUGO
| S_IWUSR
);
583 MODULE_PARM_DESC(debug
, "Debug enabled or not");