2 * Infinity Unlimited USB Phoenix driver
4 * Copyright (C) 2007 Alain Degreffe (eczema@ecze.com)
6 * Original code taken from iuutool (Copyright (C) 2006 Juan Carlos Borrás)
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 * And tested with help of WB Electronics
16 #include <linux/kernel.h>
17 #include <linux/errno.h>
18 #include <linux/init.h>
19 #include <linux/slab.h>
20 #include <linux/tty.h>
21 #include <linux/tty_driver.h>
22 #include <linux/tty_flip.h>
23 #include <linux/serial.h>
24 #include <linux/module.h>
25 #include <linux/moduleparam.h>
26 #include <linux/spinlock.h>
27 #include <linux/uaccess.h>
28 #include <linux/usb.h>
29 #include <linux/usb/serial.h>
30 #include "iuu_phoenix.h"
31 #include <linux/random.h>
34 #ifdef CONFIG_USB_SERIAL_DEBUG
43 #define DRIVER_VERSION "v0.5"
44 #define DRIVER_DESC "Infinity USB Unlimited Phoenix driver"
46 static struct usb_device_id id_table
[] = {
47 {USB_DEVICE(IUU_USB_VENDOR_ID
, IUU_USB_PRODUCT_ID
)},
48 {} /* Terminating entry */
50 MODULE_DEVICE_TABLE(usb
, id_table
);
52 static struct usb_driver iuu_driver
= {
53 .name
= "iuu_phoenix",
54 .probe
= usb_serial_probe
,
55 .disconnect
= usb_serial_disconnect
,
61 static int boost
= 100;
62 static int clockmode
= 1;
63 static int cdmode
= 1;
64 static int iuu_cardin
;
65 static int iuu_cardout
;
68 static void read_rxcmd_callback(struct urb
*urb
);
71 spinlock_t lock
; /* store irq state */
72 wait_queue_head_t delta_msr_wait
;
75 u8 termios_initialized
;
76 int tiostatus
; /* store IUART SIGNAL for tiocmget call */
77 u8 reset
; /* if 1 reset is needed */
78 int poll
; /* number of poll */
79 u8
*writebuf
; /* buffer for writing to device */
80 int writelen
; /* num of byte to write to device */
81 u8
*buf
; /* used for initialize speed */
82 u8
*dbgbuf
; /* debug buffer */
87 static void iuu_free_buf(struct iuu_private
*priv
)
91 kfree(priv
->writebuf
);
94 static int iuu_alloc_buf(struct iuu_private
*priv
)
96 priv
->buf
= kzalloc(256, GFP_KERNEL
);
97 priv
->dbgbuf
= kzalloc(256, GFP_KERNEL
);
98 priv
->writebuf
= kzalloc(256, GFP_KERNEL
);
99 if (!priv
->buf
|| !priv
->dbgbuf
|| !priv
->writebuf
) {
101 dbg("%s problem allocation buffer", __func__
);
104 dbg("%s - Privates buffers allocation success", __func__
);
108 static int iuu_startup(struct usb_serial
*serial
)
110 struct iuu_private
*priv
;
111 priv
= kzalloc(sizeof(struct iuu_private
), GFP_KERNEL
);
112 dbg("%s- priv allocation success", __func__
);
115 if (iuu_alloc_buf(priv
)) {
119 spin_lock_init(&priv
->lock
);
120 init_waitqueue_head(&priv
->delta_msr_wait
);
121 usb_set_serial_port_data(serial
->port
[0], priv
);
125 /* Shutdown function */
126 static void iuu_shutdown(struct usb_serial
*serial
)
128 struct usb_serial_port
*port
= serial
->port
[0];
129 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
137 dbg("%s - I will free all", __func__
);
138 usb_set_serial_port_data(port
, NULL
);
140 dbg("%s - priv is not anymore in port structure", __func__
);
143 dbg("%s priv is now kfree", __func__
);
147 static int iuu_tiocmset(struct usb_serial_port
*port
, struct file
*file
,
148 unsigned int set
, unsigned int clear
)
150 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
153 /* FIXME: locking on tiomstatus */
154 dbg("%s (%d) msg : SET = 0x%04x, CLEAR = 0x%04x ", __func__
,
155 port
->number
, set
, clear
);
157 spin_lock_irqsave(&priv
->lock
, flags
);
159 priv
->tiostatus
= TIOCM_RTS
;
161 if (!(set
& TIOCM_RTS
) && priv
->tiostatus
== TIOCM_RTS
) {
162 dbg("%s TIOCMSET RESET called !!!", __func__
);
165 spin_unlock_irqrestore(&priv
->lock
, flags
);
169 /* This is used to provide a carrier detect mechanism
170 * When a card is present, the response is 0x00
171 * When no card , the reader respond with TIOCM_CD
172 * This is known as CD autodetect mechanism
174 static int iuu_tiocmget(struct usb_serial_port
*port
, struct file
*file
)
176 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
180 spin_lock_irqsave(&priv
->lock
, flags
);
181 rc
= priv
->tiostatus
;
182 spin_unlock_irqrestore(&priv
->lock
, flags
);
187 static void iuu_rxcmd(struct urb
*urb
)
189 struct usb_serial_port
*port
= urb
->context
;
191 dbg("%s - enter", __func__
);
194 dbg("%s - urb->status = %d", __func__
, urb
->status
);
200 memset(port
->write_urb
->transfer_buffer
, IUU_UART_RX
, 1);
201 usb_fill_bulk_urb(port
->write_urb
, port
->serial
->dev
,
202 usb_sndbulkpipe(port
->serial
->dev
,
203 port
->bulk_out_endpointAddress
),
204 port
->write_urb
->transfer_buffer
, 1,
205 read_rxcmd_callback
, port
);
206 result
= usb_submit_urb(port
->write_urb
, GFP_ATOMIC
);
209 static int iuu_reset(struct usb_serial_port
*port
, u8 wt
)
211 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
213 char *buf_ptr
= port
->write_urb
->transfer_buffer
;
214 dbg("%s - enter", __func__
);
216 /* Prepare the reset sequence */
218 *buf_ptr
++ = IUU_RST_SET
;
219 *buf_ptr
++ = IUU_DELAY_MS
;
221 *buf_ptr
= IUU_RST_CLEAR
;
223 /* send the sequence */
225 usb_fill_bulk_urb(port
->write_urb
,
227 usb_sndbulkpipe(port
->serial
->dev
,
228 port
->bulk_out_endpointAddress
),
229 port
->write_urb
->transfer_buffer
, 4, iuu_rxcmd
, port
);
230 result
= usb_submit_urb(port
->write_urb
, GFP_ATOMIC
);
241 static void iuu_update_status_callback(struct urb
*urb
)
243 struct usb_serial_port
*port
= urb
->context
;
244 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
246 dbg("%s - enter", __func__
);
249 dbg("%s - urb->status = %d", __func__
, urb
->status
);
254 st
= urb
->transfer_buffer
;
255 dbg("%s - enter", __func__
);
256 if (urb
->actual_length
== 1) {
259 priv
->tiostatus
= iuu_cardout
;
262 priv
->tiostatus
= iuu_cardin
;
265 priv
->tiostatus
= iuu_cardin
;
271 static void iuu_status_callback(struct urb
*urb
)
273 struct usb_serial_port
*port
= urb
->context
;
275 dbg("%s - enter", __func__
);
277 dbg("%s - urb->status = %d", __func__
, urb
->status
);
278 usb_fill_bulk_urb(port
->read_urb
, port
->serial
->dev
,
279 usb_rcvbulkpipe(port
->serial
->dev
,
280 port
->bulk_in_endpointAddress
),
281 port
->read_urb
->transfer_buffer
, 256,
282 iuu_update_status_callback
, port
);
283 result
= usb_submit_urb(port
->read_urb
, GFP_ATOMIC
);
286 static int iuu_status(struct usb_serial_port
*port
)
290 dbg("%s - enter", __func__
);
292 memset(port
->write_urb
->transfer_buffer
, IUU_GET_STATE_REGISTER
, 1);
293 usb_fill_bulk_urb(port
->write_urb
, port
->serial
->dev
,
294 usb_sndbulkpipe(port
->serial
->dev
,
295 port
->bulk_out_endpointAddress
),
296 port
->write_urb
->transfer_buffer
, 1,
297 iuu_status_callback
, port
);
298 result
= usb_submit_urb(port
->write_urb
, GFP_ATOMIC
);
303 static int bulk_immediate(struct usb_serial_port
*port
, u8
*buf
, u8 count
)
306 struct usb_serial
*serial
= port
->serial
;
309 dbg("%s - enter", __func__
);
311 /* send the data out the bulk port */
314 usb_bulk_msg(serial
->dev
,
315 usb_sndbulkpipe(serial
->dev
,
316 port
->bulk_out_endpointAddress
), buf
,
317 count
, &actual
, HZ
* 1);
319 if (status
!= IUU_OPERATION_OK
) {
320 dbg("%s - error = %2x", __func__
, status
);
322 dbg("%s - write OK !", __func__
);
327 static int read_immediate(struct usb_serial_port
*port
, u8
*buf
, u8 count
)
330 struct usb_serial
*serial
= port
->serial
;
333 dbg("%s - enter", __func__
);
335 /* send the data out the bulk port */
338 usb_bulk_msg(serial
->dev
,
339 usb_rcvbulkpipe(serial
->dev
,
340 port
->bulk_in_endpointAddress
), buf
,
341 count
, &actual
, HZ
* 1);
343 if (status
!= IUU_OPERATION_OK
) {
344 dbg("%s - error = %2x", __func__
, status
);
346 dbg("%s - read OK !", __func__
);
352 static int iuu_led(struct usb_serial_port
*port
, unsigned int R
,
353 unsigned int G
, unsigned int B
, u8 f
)
357 buf
= kmalloc(8, GFP_KERNEL
);
361 dbg("%s - enter", __func__
);
363 buf
[0] = IUU_SET_LED
;
365 buf
[2] = (R
>> 8) & 0xFF;
367 buf
[4] = (G
>> 8) & 0xFF;
369 buf
[6] = (B
>> 8) & 0xFF;
371 status
= bulk_immediate(port
, buf
, 8);
373 if (status
!= IUU_OPERATION_OK
)
374 dbg("%s - led error status = %2x", __func__
, status
);
376 dbg("%s - led OK !", __func__
);
377 return IUU_OPERATION_OK
;
380 static void iuu_rgbf_fill_buffer(u8
*buf
, u8 r1
, u8 r2
, u8 g1
, u8 g2
, u8 b1
,
383 *buf
++ = IUU_SET_LED
;
393 static void iuu_led_activity_on(struct urb
*urb
)
395 struct usb_serial_port
*port
= urb
->context
;
397 char *buf_ptr
= port
->write_urb
->transfer_buffer
;
398 *buf_ptr
++ = IUU_SET_LED
;
400 get_random_bytes(buf_ptr
, 6);
403 iuu_rgbf_fill_buffer(buf_ptr
, 255, 255, 0, 0, 0, 0, 255);
406 usb_fill_bulk_urb(port
->write_urb
, port
->serial
->dev
,
407 usb_sndbulkpipe(port
->serial
->dev
,
408 port
->bulk_out_endpointAddress
),
409 port
->write_urb
->transfer_buffer
, 8 ,
411 result
= usb_submit_urb(port
->write_urb
, GFP_ATOMIC
);
414 static void iuu_led_activity_off(struct urb
*urb
)
416 struct usb_serial_port
*port
= urb
->context
;
418 char *buf_ptr
= port
->write_urb
->transfer_buffer
;
423 *buf_ptr
++ = IUU_SET_LED
;
424 iuu_rgbf_fill_buffer(buf_ptr
, 0, 0, 255, 255, 0, 0, 255);
426 usb_fill_bulk_urb(port
->write_urb
, port
->serial
->dev
,
427 usb_sndbulkpipe(port
->serial
->dev
,
428 port
->bulk_out_endpointAddress
),
429 port
->write_urb
->transfer_buffer
, 8 ,
431 result
= usb_submit_urb(port
->write_urb
, GFP_ATOMIC
);
436 static int iuu_clk(struct usb_serial_port
*port
, int dwFrq
)
439 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
442 u8 DIV
= 0; /* 8bit */
443 u8 XDRV
= 0; /* 8bit */
444 u8 PUMP
= 0; /* 3bit */
445 u8 PBmsb
= 0; /* 2bit */
446 u8 PBlsb
= 0; /* 8bit */
447 u8 PO
= 0; /* 1bit */
452 int frq
= (int)dwFrq
;
454 dbg("%s - enter", __func__
);
457 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
;
458 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
459 priv
->buf
[Count
++] = 0x09;
460 priv
->buf
[Count
++] = 0x00;
462 status
= bulk_immediate(port
, (u8
*) priv
->buf
, Count
);
464 dbg("%s - write error ", __func__
);
467 } else if (frq
== 3579000) {
472 } else if (frq
== 3680000) {
477 } else if (frq
== 6000000) {
483 unsigned int result
= 0;
484 unsigned int tmp
= 0;
489 unsigned int lP
= 2055;
490 unsigned int lDiv
= 4;
492 for (lQ
= 2; lQ
<= 47 && !found
; lQ
++)
493 for (lP
= 2055; lP
>= 8 && !found
; lP
--)
494 for (lDiv
= 4; lDiv
<= 127 && !found
; lDiv
++) {
495 tmp
= (12000000 / lDiv
) * (lP
/ lQ
);
496 if (abs((int)(tmp
- frq
)) <
497 abs((int)(frq
- result
))) {
498 check2
= (12000000 / lQ
);
501 check
= (12000000 / lQ
) * lP
;
502 if (check
> 400000000)
504 if (check
< 100000000)
506 if (lDiv
< 4 || lDiv
> 127)
517 P2
= ((P
- PO
) / 2) - 4;
520 PBmsb
= (P2
>> 8 & 0x03);
522 PO
= (P
>> 10) & 0x01;
525 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
526 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
527 priv
->buf
[Count
++] = 0x09;
528 priv
->buf
[Count
++] = 0x20; /* Adr = 0x09 */
529 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
530 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
531 priv
->buf
[Count
++] = 0x0C;
532 priv
->buf
[Count
++] = DIV
; /* Adr = 0x0C */
533 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
534 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
535 priv
->buf
[Count
++] = 0x12;
536 priv
->buf
[Count
++] = XDRV
; /* Adr = 0x12 */
537 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
538 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
539 priv
->buf
[Count
++] = 0x13;
540 priv
->buf
[Count
++] = 0x6B; /* Adr = 0x13 */
541 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
542 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
543 priv
->buf
[Count
++] = 0x40;
544 priv
->buf
[Count
++] = (0xC0 | ((PUMP
& 0x07) << 2)) |
545 (PBmsb
& 0x03); /* Adr = 0x40 */
546 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
547 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
548 priv
->buf
[Count
++] = 0x41;
549 priv
->buf
[Count
++] = PBlsb
; /* Adr = 0x41 */
550 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
551 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
552 priv
->buf
[Count
++] = 0x42;
553 priv
->buf
[Count
++] = Q
| (((PO
& 0x01) << 7)); /* Adr = 0x42 */
554 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
555 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
556 priv
->buf
[Count
++] = 0x44;
557 priv
->buf
[Count
++] = (char)0xFF; /* Adr = 0x44 */
558 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
559 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
560 priv
->buf
[Count
++] = 0x45;
561 priv
->buf
[Count
++] = (char)0xFE; /* Adr = 0x45 */
562 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
563 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
564 priv
->buf
[Count
++] = 0x46;
565 priv
->buf
[Count
++] = 0x7F; /* Adr = 0x46 */
566 priv
->buf
[Count
++] = IUU_UART_WRITE_I2C
; /* 0x4C */
567 priv
->buf
[Count
++] = FrqGenAdr
<< 1;
568 priv
->buf
[Count
++] = 0x47;
569 priv
->buf
[Count
++] = (char)0x84; /* Adr = 0x47 */
571 status
= bulk_immediate(port
, (u8
*) priv
->buf
, Count
);
572 if (status
!= IUU_OPERATION_OK
)
573 dbg("%s - write error ", __func__
);
577 static int iuu_uart_flush(struct usb_serial_port
*port
)
581 u8 rxcmd
= IUU_UART_RX
;
582 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
584 dbg("%s - enter", __func__
);
586 if (iuu_led(port
, 0xF000, 0, 0, 0xFF) < 0)
589 for (i
= 0; i
< 2; i
++) {
590 status
= bulk_immediate(port
, &rxcmd
, 1);
591 if (status
!= IUU_OPERATION_OK
) {
592 dbg("%s - uart_flush_write error", __func__
);
596 status
= read_immediate(port
, &priv
->len
, 1);
597 if (status
!= IUU_OPERATION_OK
) {
598 dbg("%s - uart_flush_read error", __func__
);
603 dbg("%s - uart_flush datalen is : %i ", __func__
,
605 status
= read_immediate(port
, priv
->buf
, priv
->len
);
606 if (status
!= IUU_OPERATION_OK
) {
607 dbg("%s - uart_flush_read error", __func__
);
612 dbg("%s - uart_flush_read OK!", __func__
);
613 iuu_led(port
, 0, 0xF000, 0, 0xFF);
617 static void read_buf_callback(struct urb
*urb
)
619 struct usb_serial_port
*port
= urb
->context
;
620 unsigned char *data
= urb
->transfer_buffer
;
621 struct tty_struct
*tty
;
622 dbg("%s - urb->status = %d", __func__
, urb
->status
);
625 dbg("%s - urb->status = %d", __func__
, urb
->status
);
626 if (urb
->status
== -EPROTO
) {
627 /* reschedule needed */
632 dbg("%s - %i chars to write", __func__
, urb
->actual_length
);
635 dbg("%s - data is NULL !!!", __func__
);
636 if (tty
&& urb
->actual_length
&& data
) {
637 tty_insert_flip_string(tty
, data
, urb
->actual_length
);
638 tty_flip_buffer_push(tty
);
640 iuu_led_activity_on(urb
);
643 static int iuu_bulk_write(struct usb_serial_port
*port
)
645 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
649 char *buf_ptr
= port
->write_urb
->transfer_buffer
;
650 dbg("%s - enter", __func__
);
652 *buf_ptr
++ = IUU_UART_ESC
;
653 *buf_ptr
++ = IUU_UART_TX
;
654 *buf_ptr
++ = priv
->writelen
;
656 memcpy(buf_ptr
, priv
->writebuf
,
659 for (i
= 0; i
< priv
->writelen
; i
++)
660 sprintf(priv
->dbgbuf
+ i
*2 ,
661 "%02X", priv
->writebuf
[i
]);
662 priv
->dbgbuf
[priv
->writelen
+i
*2] = 0;
663 dbg("%s - writing %i chars : %s", __func__
,
664 priv
->writelen
, priv
->dbgbuf
);
666 usb_fill_bulk_urb(port
->write_urb
, port
->serial
->dev
,
667 usb_sndbulkpipe(port
->serial
->dev
,
668 port
->bulk_out_endpointAddress
),
669 port
->write_urb
->transfer_buffer
, priv
->writelen
+ 3,
671 result
= usb_submit_urb(port
->write_urb
, GFP_ATOMIC
);
672 spin_lock_irqsave(&priv
->lock
, flags
);
674 spin_unlock_irqrestore(&priv
->lock
, flags
);
675 usb_serial_port_softint(port
);
679 static int iuu_read_buf(struct usb_serial_port
*port
, int len
)
682 dbg("%s - enter", __func__
);
684 usb_fill_bulk_urb(port
->read_urb
, port
->serial
->dev
,
685 usb_rcvbulkpipe(port
->serial
->dev
,
686 port
->bulk_in_endpointAddress
),
687 port
->read_urb
->transfer_buffer
, len
,
688 read_buf_callback
, port
);
689 result
= usb_submit_urb(port
->read_urb
, GFP_ATOMIC
);
693 static void iuu_uart_read_callback(struct urb
*urb
)
695 struct usb_serial_port
*port
= urb
->context
;
696 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
701 unsigned char *data
= urb
->transfer_buffer
;
704 dbg("%s - enter", __func__
);
707 dbg("%s - urb->status = %d", __func__
, urb
->status
);
712 dbg("%s - data is NULL !!!", __func__
);
714 if (urb
->actual_length
== 1 && data
!= NULL
)
717 if (urb
->actual_length
> 1) {
718 dbg("%s - urb->actual_length = %i", __func__
,
723 /* if len > 0 call readbuf */
725 if (len
> 0 && error
== 0) {
726 dbg("%s - call read buf - len to read is %i ",
728 status
= iuu_read_buf(port
, len
);
731 /* need to update status ? */
732 if (priv
->poll
> 99) {
733 status
= iuu_status(port
);
738 /* reset waiting ? */
740 if (priv
->reset
== 1) {
741 status
= iuu_reset(port
, 0xC);
744 /* Writebuf is waiting */
745 spin_lock_irqsave(&priv
->lock
, flags
);
746 if (priv
->writelen
> 0) {
747 spin_unlock_irqrestore(&priv
->lock
, flags
);
748 status
= iuu_bulk_write(port
);
751 spin_unlock_irqrestore(&priv
->lock
, flags
);
752 /* if nothing to write call again rxcmd */
753 dbg("%s - rxcmd recall", __func__
);
754 iuu_led_activity_off(urb
);
758 static int iuu_uart_write(struct usb_serial_port
*port
, const u8
*buf
,
761 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
763 dbg("%s - enter", __func__
);
768 spin_lock_irqsave(&priv
->lock
, flags
);
769 if (priv
->writelen
> 0) {
770 /* buffer already filled but not commited */
771 spin_unlock_irqrestore(&priv
->lock
, flags
);
774 /* fill the buffer */
775 memcpy(priv
->writebuf
, buf
, count
);
776 priv
->writelen
= count
;
777 spin_unlock_irqrestore(&priv
->lock
, flags
);
782 static void read_rxcmd_callback(struct urb
*urb
)
784 struct usb_serial_port
*port
= urb
->context
;
786 dbg("%s - enter", __func__
);
788 dbg("%s - urb->status = %d", __func__
, urb
->status
);
791 dbg("%s - urb->status = %d", __func__
, urb
->status
);
796 usb_fill_bulk_urb(port
->read_urb
, port
->serial
->dev
,
797 usb_rcvbulkpipe(port
->serial
->dev
,
798 port
->bulk_in_endpointAddress
),
799 port
->read_urb
->transfer_buffer
, 256,
800 iuu_uart_read_callback
, port
);
801 result
= usb_submit_urb(port
->read_urb
, GFP_ATOMIC
);
802 dbg("%s - submit result = %d", __func__
, result
);
806 static int iuu_uart_on(struct usb_serial_port
*port
)
811 buf
= kmalloc(sizeof(u8
) * 4, GFP_KERNEL
);
816 buf
[0] = IUU_UART_ENABLE
;
817 buf
[1] = (u8
) ((IUU_BAUD_9600
>> 8) & 0x00FF);
818 buf
[2] = (u8
) (0x00FF & IUU_BAUD_9600
);
819 buf
[3] = (u8
) (0x0F0 & IUU_TWO_STOP_BITS
) | (0x07 & IUU_PARITY_EVEN
);
821 status
= bulk_immediate(port
, buf
, 4);
822 if (status
!= IUU_OPERATION_OK
) {
823 dbg("%s - uart_on error", __func__
);
824 goto uart_enable_failed
;
826 /* iuu_reset() the card after iuu_uart_on() */
827 status
= iuu_uart_flush(port
);
828 if (status
!= IUU_OPERATION_OK
)
829 dbg("%s - uart_flush error", __func__
);
835 /* Diables the IUU UART (a.k.a. the Phoenix voiderface) */
836 static int iuu_uart_off(struct usb_serial_port
*port
)
840 buf
= kmalloc(1, GFP_KERNEL
);
843 buf
[0] = IUU_UART_DISABLE
;
845 status
= bulk_immediate(port
, buf
, 1);
846 if (status
!= IUU_OPERATION_OK
)
847 dbg("%s - uart_off error", __func__
);
853 static int iuu_uart_baud(struct usb_serial_port
*port
, u32 baud
,
854 u32
*actual
, u8 parity
)
861 unsigned int T1FrekvensHZ
= 0;
863 dataout
= kmalloc(sizeof(u8
) * 5, GFP_KERNEL
);
868 if (baud
< 1200 || baud
> 230400) {
870 return IUU_INVALID_PARAMETER
;
874 T1FrekvensHZ
= 500000;
879 T1FrekvensHZ
= 2000000;
884 T1FrekvensHZ
= 6000000;
889 T1FrekvensHZ
= 24000000;
892 T1reload
= 256 - (u8
) (T1FrekvensHZ
/ (baud
* 2));
894 /* magic number here: ENTER_FIRMWARE_UPDATE; */
895 dataout
[DataCount
++] = IUU_UART_ESC
;
896 /* magic number here: CHANGE_BAUD; */
897 dataout
[DataCount
++] = IUU_UART_CHANGE
;
898 dataout
[DataCount
++] = T1Frekvens
;
899 dataout
[DataCount
++] = T1reload
;
901 *actual
= (T1FrekvensHZ
/ (256 - T1reload
)) / 2;
903 switch (parity
& 0x0F) {
904 case IUU_PARITY_NONE
:
905 dataout
[DataCount
++] = 0x00;
907 case IUU_PARITY_EVEN
:
908 dataout
[DataCount
++] = 0x01;
911 dataout
[DataCount
++] = 0x02;
913 case IUU_PARITY_MARK
:
914 dataout
[DataCount
++] = 0x03;
916 case IUU_PARITY_SPACE
:
917 dataout
[DataCount
++] = 0x04;
921 return IUU_INVALID_PARAMETER
;
925 switch (parity
& 0xF0) {
926 case IUU_ONE_STOP_BIT
:
927 dataout
[DataCount
- 1] |= IUU_ONE_STOP_BIT
;
930 case IUU_TWO_STOP_BITS
:
931 dataout
[DataCount
- 1] |= IUU_TWO_STOP_BITS
;
935 return IUU_INVALID_PARAMETER
;
939 status
= bulk_immediate(port
, dataout
, DataCount
);
940 if (status
!= IUU_OPERATION_OK
)
941 dbg("%s - uart_off error", __func__
);
946 static int set_control_lines(struct usb_device
*dev
, u8 value
)
951 static void iuu_close(struct usb_serial_port
*port
, struct file
*filp
)
953 /* iuu_led (port,255,0,0,0); */
954 struct usb_serial
*serial
;
955 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
957 unsigned int c_cflag
;
959 serial
= port
->serial
;
963 dbg("%s - port %d", __func__
, port
->number
);
968 c_cflag
= port
->tty
->termios
->c_cflag
;
969 if (c_cflag
& HUPCL
) {
970 /* drop DTR and RTS */
971 priv
= usb_get_serial_port_data(port
);
972 spin_lock_irqsave(&priv
->lock
, flags
);
973 priv
->line_control
= 0;
974 spin_unlock_irqrestore(&priv
->lock
, flags
);
975 set_control_lines(port
->serial
->dev
, 0);
979 /* shutdown our urbs */
980 dbg("%s - shutting down urbs", __func__
);
981 usb_kill_urb(port
->write_urb
);
982 usb_kill_urb(port
->read_urb
);
983 usb_kill_urb(port
->interrupt_in_urb
);
985 /* wait one second to free all buffers */
986 iuu_led(port
, 0, 0, 0xF000, 0xFF);
988 usb_reset_device(port
->serial
->dev
);
992 static int iuu_open(struct usb_serial_port
*port
, struct file
*filp
)
994 struct usb_serial
*serial
= port
->serial
;
999 struct iuu_private
*priv
= usb_get_serial_port_data(port
);
1001 dbg("%s - port %d", __func__
, port
->number
);
1002 usb_clear_halt(serial
->dev
, port
->write_urb
->pipe
);
1003 usb_clear_halt(serial
->dev
, port
->read_urb
->pipe
);
1005 buf
= kmalloc(10, GFP_KERNEL
);
1009 /* fixup the endpoint buffer size */
1010 kfree(port
->bulk_out_buffer
);
1011 port
->bulk_out_buffer
= kmalloc(512, GFP_KERNEL
);
1012 port
->bulk_out_size
= 512;
1013 kfree(port
->bulk_in_buffer
);
1014 port
->bulk_in_buffer
= kmalloc(512, GFP_KERNEL
);
1015 port
->bulk_in_size
= 512;
1017 if (!port
->bulk_out_buffer
|| !port
->bulk_in_buffer
) {
1018 kfree(port
->bulk_out_buffer
);
1019 kfree(port
->bulk_in_buffer
);
1024 usb_fill_bulk_urb(port
->write_urb
, port
->serial
->dev
,
1025 usb_sndbulkpipe(port
->serial
->dev
,
1026 port
->bulk_out_endpointAddress
),
1027 port
->bulk_out_buffer
, 512,
1031 usb_fill_bulk_urb(port
->read_urb
, port
->serial
->dev
,
1032 usb_rcvbulkpipe(port
->serial
->dev
,
1033 port
->bulk_in_endpointAddress
),
1034 port
->bulk_in_buffer
, 512,
1037 /* set the termios structure */
1038 spin_lock_irqsave(&priv
->lock
, flags
);
1039 if (!priv
->termios_initialized
) {
1040 *(port
->tty
->termios
) = tty_std_termios
;
1041 port
->tty
->termios
->c_cflag
= CLOCAL
| CREAD
| CS8
| B9600
1042 | TIOCM_CTS
| CSTOPB
| PARENB
;
1043 port
->tty
->termios
->c_lflag
= 0;
1044 port
->tty
->termios
->c_oflag
= 0;
1045 port
->tty
->termios
->c_iflag
= 0;
1046 priv
->termios_initialized
= 1;
1047 port
->tty
->low_latency
= 1;
1050 spin_unlock_irqrestore(&priv
->lock
, flags
);
1052 /* initialize writebuf */
1053 #define FISH(a, b, c, d) do { \
1054 result = usb_control_msg(port->serial->dev, \
1055 usb_rcvctrlpipe(port->serial->dev, 0), \
1056 b, a, c, d, buf, 1, 1000); \
1057 dbg("0x%x:0x%x:0x%x:0x%x %d - %x", a, b, c, d, result, \
1058 buf[0]); } while (0);
1060 #define SOUP(a, b, c, d) do { \
1061 result = usb_control_msg(port->serial->dev, \
1062 usb_sndctrlpipe(port->serial->dev, 0), \
1063 b, a, c, d, NULL, 0, 1000); \
1064 dbg("0x%x:0x%x:0x%x:0x%x %d", a, b, c, d, result); } while (0)
1066 /* This is not UART related but IUU USB driver related or something */
1067 /* like that. Basically no IUU will accept any commands from the USB */
1068 /* host unless it has received the following message */
1069 /* sprintf(buf ,"%c%c%c%c",0x03,0x02,0x02,0x0); */
1071 SOUP(0x03, 0x02, 0x02, 0x0);
1073 iuu_led(port
, 0xF000, 0xF000, 0, 0xFF);
1077 switch (clockmode
) {
1078 case 2: /* 3.680 Mhz */
1079 iuu_clk(port
, IUU_CLK_3680000
* boost
/ 100);
1081 iuu_uart_baud(port
, 9600 * boost
/ 100, &actual
,
1084 case 3: /* 6.00 Mhz */
1085 iuu_clk(port
, IUU_CLK_6000000
* boost
/ 100);
1087 iuu_uart_baud(port
, 16457 * boost
/ 100, &actual
,
1090 default: /* 3.579 Mhz */
1091 iuu_clk(port
, IUU_CLK_3579000
* boost
/ 100);
1093 iuu_uart_baud(port
, 9600 * boost
/ 100, &actual
,
1097 /* set the cardin cardout signals */
1104 iuu_cardin
= TIOCM_CD
;
1109 iuu_cardout
= TIOCM_CD
;
1112 iuu_cardin
= TIOCM_DSR
;
1117 iuu_cardout
= TIOCM_DSR
;
1120 iuu_cardin
= TIOCM_CTS
;
1125 iuu_cardout
= TIOCM_CTS
;
1128 iuu_cardin
= TIOCM_RNG
;
1133 iuu_cardout
= TIOCM_RNG
;
1136 iuu_uart_flush(port
);
1138 dbg("%s - initialization done", __func__
);
1140 memset(port
->write_urb
->transfer_buffer
, IUU_UART_RX
, 1);
1141 usb_fill_bulk_urb(port
->write_urb
, port
->serial
->dev
,
1142 usb_sndbulkpipe(port
->serial
->dev
,
1143 port
->bulk_out_endpointAddress
),
1144 port
->write_urb
->transfer_buffer
, 1,
1145 read_rxcmd_callback
, port
);
1146 result
= usb_submit_urb(port
->write_urb
, GFP_KERNEL
);
1149 dev_err(&port
->dev
, "%s - failed submitting read urb,"
1150 " error %d\n", __func__
, result
);
1151 iuu_close(port
, NULL
);
1154 dbg("%s - rxcmd OK", __func__
);
1159 static struct usb_serial_driver iuu_device
= {
1161 .owner
= THIS_MODULE
,
1162 .name
= "iuu_phoenix",
1164 .id_table
= id_table
,
1168 .write
= iuu_uart_write
,
1169 .read_bulk_callback
= iuu_uart_read_callback
,
1170 .tiocmget
= iuu_tiocmget
,
1171 .tiocmset
= iuu_tiocmset
,
1172 .attach
= iuu_startup
,
1173 .shutdown
= iuu_shutdown
,
1176 static int __init
iuu_init(void)
1179 retval
= usb_serial_register(&iuu_device
);
1181 goto failed_usb_serial_register
;
1182 retval
= usb_register(&iuu_driver
);
1184 goto failed_usb_register
;
1185 info(DRIVER_DESC
" " DRIVER_VERSION
);
1187 failed_usb_register
:
1188 usb_serial_deregister(&iuu_device
);
1189 failed_usb_serial_register
:
1193 static void __exit
iuu_exit(void)
1195 usb_deregister(&iuu_driver
);
1196 usb_serial_deregister(&iuu_device
);
1199 module_init(iuu_init
);
1200 module_exit(iuu_exit
);
1202 MODULE_AUTHOR("Alain Degreffe eczema@ecze.com");
1204 MODULE_DESCRIPTION(DRIVER_DESC
);
1205 MODULE_LICENSE("GPL");
1207 MODULE_VERSION(DRIVER_VERSION
);
1208 module_param(debug
, bool, S_IRUGO
| S_IWUSR
);
1209 MODULE_PARM_DESC(debug
, "Debug enabled or not");
1211 module_param(xmas
, bool, S_IRUGO
| S_IWUSR
);
1212 MODULE_PARM_DESC(xmas
, "xmas color enabled or not");
1214 module_param(boost
, int, S_IRUGO
| S_IWUSR
);
1215 MODULE_PARM_DESC(boost
, "overclock boost percent 100 to 500");
1217 module_param(clockmode
, int, S_IRUGO
| S_IWUSR
);
1218 MODULE_PARM_DESC(clockmode
, "1=3Mhz579,2=3Mhz680,3=6Mhz");
1220 module_param(cdmode
, int, S_IRUGO
| S_IWUSR
);
1221 MODULE_PARM_DESC(cdmode
, "Card detect mode 0=none, 1=CD, 2=!CD, 3=DSR, "
1222 "4=!DSR, 5=CTS, 6=!CTS, 7=RING, 8=!RING");