diff options
author | Alan Cox <alan@redhat.com> | 2008-07-22 06:16:12 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@linux-foundation.org> | 2008-07-22 16:03:26 -0400 |
commit | 880af9db2c35c5fedaef0de89473f202329934db (patch) | |
tree | a2cf814a6f8d916d90c13ac89997d388b008aa43 | |
parent | 4944d40054d73b2f8d7d546f55c206eb3baf2710 (diff) |
mos7840: remove loads of bogus assignments to status
Signed-off-by: Alan Cox <alan@redhat.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
-rw-r--r-- | drivers/usb/serial/mos7840.c | 400 |
1 files changed, 164 insertions, 236 deletions
diff --git a/drivers/usb/serial/mos7840.c b/drivers/usb/serial/mos7840.c index 2b1fded6619d..09d82062b973 100644 --- a/drivers/usb/serial/mos7840.c +++ b/drivers/usb/serial/mos7840.c | |||
@@ -33,7 +33,7 @@ | |||
33 | #include <linux/serial.h> | 33 | #include <linux/serial.h> |
34 | #include <linux/usb.h> | 34 | #include <linux/usb.h> |
35 | #include <linux/usb/serial.h> | 35 | #include <linux/usb/serial.h> |
36 | #include <asm/uaccess.h> | 36 | #include <linux/uaccess.h> |
37 | 37 | ||
38 | /* | 38 | /* |
39 | * Version Information | 39 | * Version Information |
@@ -82,8 +82,8 @@ | |||
82 | * Defines used for sending commands to port | 82 | * Defines used for sending commands to port |
83 | */ | 83 | */ |
84 | 84 | ||
85 | #define WAIT_FOR_EVER (HZ * 0 ) /* timeout urb is wait for ever */ | 85 | #define WAIT_FOR_EVER (HZ * 0) /* timeout urb is wait for ever */ |
86 | #define MOS_WDR_TIMEOUT (HZ * 5 ) /* default urb timeout */ | 86 | #define MOS_WDR_TIMEOUT (HZ * 5) /* default urb timeout */ |
87 | 87 | ||
88 | #define MOS_PORT1 0x0200 | 88 | #define MOS_PORT1 0x0200 |
89 | #define MOS_PORT2 0x0300 | 89 | #define MOS_PORT2 0x0300 |
@@ -102,8 +102,8 @@ | |||
102 | 102 | ||
103 | #define MAX_NAME_LEN 64 | 103 | #define MAX_NAME_LEN 64 |
104 | 104 | ||
105 | #define ZLP_REG1 0x3A //Zero_Flag_Reg1 58 | 105 | #define ZLP_REG1 0x3A /* Zero_Flag_Reg1 58 */ |
106 | #define ZLP_REG5 0x3E //Zero_Flag_Reg5 62 | 106 | #define ZLP_REG5 0x3E /* Zero_Flag_Reg5 62 */ |
107 | 107 | ||
108 | /* For higher baud Rates use TIOCEXBAUD */ | 108 | /* For higher baud Rates use TIOCEXBAUD */ |
109 | #define TIOCEXBAUD 0x5462 | 109 | #define TIOCEXBAUD 0x5462 |
@@ -142,7 +142,7 @@ | |||
142 | #define MOS_MSR_DELTA_RI 0x40 | 142 | #define MOS_MSR_DELTA_RI 0x40 |
143 | #define MOS_MSR_DELTA_CD 0x80 | 143 | #define MOS_MSR_DELTA_CD 0x80 |
144 | 144 | ||
145 | // Serial Port register Address | 145 | /* Serial Port register Address */ |
146 | #define INTERRUPT_ENABLE_REGISTER ((__u16)(0x01)) | 146 | #define INTERRUPT_ENABLE_REGISTER ((__u16)(0x01)) |
147 | #define FIFO_CONTROL_REGISTER ((__u16)(0x02)) | 147 | #define FIFO_CONTROL_REGISTER ((__u16)(0x02)) |
148 | #define LINE_CONTROL_REGISTER ((__u16)(0x03)) | 148 | #define LINE_CONTROL_REGISTER ((__u16)(0x03)) |
@@ -201,11 +201,11 @@ struct moschip_port { | |||
201 | struct async_icount icount; | 201 | struct async_icount icount; |
202 | struct usb_serial_port *port; /* loop back to the owner of this object */ | 202 | struct usb_serial_port *port; /* loop back to the owner of this object */ |
203 | 203 | ||
204 | /*Offsets */ | 204 | /* Offsets */ |
205 | __u8 SpRegOffset; | 205 | __u8 SpRegOffset; |
206 | __u8 ControlRegOffset; | 206 | __u8 ControlRegOffset; |
207 | __u8 DcrRegOffset; | 207 | __u8 DcrRegOffset; |
208 | //for processing control URBS in interrupt context | 208 | /* for processing control URBS in interrupt context */ |
209 | struct urb *control_urb; | 209 | struct urb *control_urb; |
210 | struct usb_ctrlrequest *dr; | 210 | struct usb_ctrlrequest *dr; |
211 | char *ctrl_buf; | 211 | char *ctrl_buf; |
@@ -244,7 +244,7 @@ static int mos7840_set_reg_sync(struct usb_serial_port *port, __u16 reg, | |||
244 | */ | 244 | */ |
245 | 245 | ||
246 | static int mos7840_get_reg_sync(struct usb_serial_port *port, __u16 reg, | 246 | static int mos7840_get_reg_sync(struct usb_serial_port *port, __u16 reg, |
247 | __u16 * val) | 247 | __u16 *val) |
248 | { | 248 | { |
249 | struct usb_device *dev = port->serial->dev; | 249 | struct usb_device *dev = port->serial->dev; |
250 | int ret = 0; | 250 | int ret = 0; |
@@ -269,16 +269,15 @@ static int mos7840_set_uart_reg(struct usb_serial_port *port, __u16 reg, | |||
269 | 269 | ||
270 | struct usb_device *dev = port->serial->dev; | 270 | struct usb_device *dev = port->serial->dev; |
271 | val = val & 0x00ff; | 271 | val = val & 0x00ff; |
272 | // For the UART control registers, the application number need to be Or'ed | 272 | /* For the UART control registers, the application number need |
273 | to be Or'ed */ | ||
273 | if (port->serial->num_ports == 4) { | 274 | if (port->serial->num_ports == 4) { |
274 | val |= | 275 | val |= (((__u16) port->number - |
275 | (((__u16) port->number - (__u16) (port->serial->minor)) + | 276 | (__u16) (port->serial->minor)) + 1) << 8; |
276 | 1) << 8; | ||
277 | dbg("mos7840_set_uart_reg application number is %x\n", val); | 277 | dbg("mos7840_set_uart_reg application number is %x\n", val); |
278 | } else { | 278 | } else { |
279 | if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) { | 279 | if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) { |
280 | val |= | 280 | val |= (((__u16) port->number - |
281 | (((__u16) port->number - | ||
282 | (__u16) (port->serial->minor)) + 1) << 8; | 281 | (__u16) (port->serial->minor)) + 1) << 8; |
283 | dbg("mos7840_set_uart_reg application number is %x\n", | 282 | dbg("mos7840_set_uart_reg application number is %x\n", |
284 | val); | 283 | val); |
@@ -302,14 +301,15 @@ static int mos7840_set_uart_reg(struct usb_serial_port *port, __u16 reg, | |||
302 | * by passing usb_rcvctrlpipe function as parameter. | 301 | * by passing usb_rcvctrlpipe function as parameter. |
303 | */ | 302 | */ |
304 | static int mos7840_get_uart_reg(struct usb_serial_port *port, __u16 reg, | 303 | static int mos7840_get_uart_reg(struct usb_serial_port *port, __u16 reg, |
305 | __u16 * val) | 304 | __u16 *val) |
306 | { | 305 | { |
307 | struct usb_device *dev = port->serial->dev; | 306 | struct usb_device *dev = port->serial->dev; |
308 | int ret = 0; | 307 | int ret = 0; |
309 | __u16 Wval; | 308 | __u16 Wval; |
310 | 309 | ||
311 | //dbg("application number is %4x \n",(((__u16)port->number - (__u16)(port->serial->minor))+1)<<8); | 310 | /* dbg("application number is %4x \n", |
312 | /*Wval is same as application number */ | 311 | (((__u16)port->number - (__u16)(port->serial->minor))+1)<<8); */ |
312 | /* Wval is same as application number */ | ||
313 | if (port->serial->num_ports == 4) { | 313 | if (port->serial->num_ports == 4) { |
314 | Wval = | 314 | Wval = |
315 | (((__u16) port->number - (__u16) (port->serial->minor)) + | 315 | (((__u16) port->number - (__u16) (port->serial->minor)) + |
@@ -317,14 +317,12 @@ static int mos7840_get_uart_reg(struct usb_serial_port *port, __u16 reg, | |||
317 | dbg("mos7840_get_uart_reg application number is %x\n", Wval); | 317 | dbg("mos7840_get_uart_reg application number is %x\n", Wval); |
318 | } else { | 318 | } else { |
319 | if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) { | 319 | if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) { |
320 | Wval = | 320 | Wval = (((__u16) port->number - |
321 | (((__u16) port->number - | ||
322 | (__u16) (port->serial->minor)) + 1) << 8; | 321 | (__u16) (port->serial->minor)) + 1) << 8; |
323 | dbg("mos7840_get_uart_reg application number is %x\n", | 322 | dbg("mos7840_get_uart_reg application number is %x\n", |
324 | Wval); | 323 | Wval); |
325 | } else { | 324 | } else { |
326 | Wval = | 325 | Wval = (((__u16) port->number - |
327 | (((__u16) port->number - | ||
328 | (__u16) (port->serial->minor)) + 2) << 8; | 326 | (__u16) (port->serial->minor)) + 2) << 8; |
329 | dbg("mos7840_get_uart_reg application number is %x\n", | 327 | dbg("mos7840_get_uart_reg application number is %x\n", |
330 | Wval); | 328 | Wval); |
@@ -406,11 +404,11 @@ static void mos7840_handle_new_lsr(struct moschip_port *port, __u8 new_lsr) | |||
406 | dbg("%s - %02x", __func__, new_lsr); | 404 | dbg("%s - %02x", __func__, new_lsr); |
407 | 405 | ||
408 | if (new_lsr & SERIAL_LSR_BI) { | 406 | if (new_lsr & SERIAL_LSR_BI) { |
409 | // | 407 | /* |
410 | // Parity and Framing errors only count if they | 408 | * Parity and Framing errors only count if they |
411 | // occur exclusive of a break being | 409 | * occur exclusive of a break being |
412 | // received. | 410 | * received. |
413 | // | 411 | */ |
414 | new_lsr &= (__u8) (SERIAL_LSR_OE | SERIAL_LSR_BI); | 412 | new_lsr &= (__u8) (SERIAL_LSR_OE | SERIAL_LSR_BI); |
415 | } | 413 | } |
416 | 414 | ||
@@ -492,7 +490,7 @@ exit: | |||
492 | } | 490 | } |
493 | 491 | ||
494 | static int mos7840_get_reg(struct moschip_port *mcs, __u16 Wval, __u16 reg, | 492 | static int mos7840_get_reg(struct moschip_port *mcs, __u16 Wval, __u16 reg, |
495 | __u16 * val) | 493 | __u16 *val) |
496 | { | 494 | { |
497 | struct usb_device *dev = mcs->port->serial->dev; | 495 | struct usb_device *dev = mcs->port->serial->dev; |
498 | struct usb_ctrlrequest *dr = mcs->dr; | 496 | struct usb_ctrlrequest *dr = mcs->dr; |
@@ -501,7 +499,7 @@ static int mos7840_get_reg(struct moschip_port *mcs, __u16 Wval, __u16 reg, | |||
501 | 499 | ||
502 | dr->bRequestType = MCS_RD_RTYPE; | 500 | dr->bRequestType = MCS_RD_RTYPE; |
503 | dr->bRequest = MCS_RDREQ; | 501 | dr->bRequest = MCS_RDREQ; |
504 | dr->wValue = cpu_to_le16(Wval); //0; | 502 | dr->wValue = cpu_to_le16(Wval); /* 0 */ |
505 | dr->wIndex = cpu_to_le16(reg); | 503 | dr->wIndex = cpu_to_le16(reg); |
506 | dr->wLength = cpu_to_le16(2); | 504 | dr->wLength = cpu_to_le16(2); |
507 | 505 | ||
@@ -607,7 +605,8 @@ static void mos7840_interrupt_callback(struct urb *urb) | |||
607 | } | 605 | } |
608 | } | 606 | } |
609 | } | 607 | } |
610 | if (!(rv < 0)) /* the completion handler for the control urb will resubmit */ | 608 | if (!(rv < 0)) |
609 | /* the completion handler for the control urb will resubmit */ | ||
611 | return; | 610 | return; |
612 | exit: | 611 | exit: |
613 | result = usb_submit_urb(urb, GFP_ATOMIC); | 612 | result = usb_submit_urb(urb, GFP_ATOMIC); |
@@ -656,8 +655,8 @@ static struct usb_serial *mos7840_get_usb_serial(struct usb_serial_port *port, | |||
656 | if (!port || | 655 | if (!port || |
657 | mos7840_port_paranoia_check(port, function) || | 656 | mos7840_port_paranoia_check(port, function) || |
658 | mos7840_serial_paranoia_check(port->serial, function)) { | 657 | mos7840_serial_paranoia_check(port->serial, function)) { |
659 | /* then say that we don't have a valid usb_serial thing, which will | 658 | /* then say that we don't have a valid usb_serial thing, |
660 | * end up genrating -ENODEV return values */ | 659 | * which will end up genrating -ENODEV return values */ |
661 | return NULL; | 660 | return NULL; |
662 | } | 661 | } |
663 | 662 | ||
@@ -741,8 +740,8 @@ static void mos7840_bulk_in_callback(struct urb *urb) | |||
741 | 740 | ||
742 | /***************************************************************************** | 741 | /***************************************************************************** |
743 | * mos7840_bulk_out_data_callback | 742 | * mos7840_bulk_out_data_callback |
744 | * this is the callback function for when we have finished sending serial data | 743 | * this is the callback function for when we have finished sending |
745 | * on the bulk out endpoint. | 744 | * serial data on the bulk out endpoint. |
746 | *****************************************************************************/ | 745 | *****************************************************************************/ |
747 | 746 | ||
748 | static void mos7840_bulk_out_data_callback(struct urb *urb) | 747 | static void mos7840_bulk_out_data_callback(struct urb *urb) |
@@ -848,7 +847,8 @@ static int mos7840_open(struct tty_struct *tty, | |||
848 | continue; | 847 | continue; |
849 | } | 848 | } |
850 | 849 | ||
851 | urb->transfer_buffer = kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL); | 850 | urb->transfer_buffer = kmalloc(URB_TRANSFER_BUFFER_SIZE, |
851 | GFP_KERNEL); | ||
852 | if (!urb->transfer_buffer) { | 852 | if (!urb->transfer_buffer) { |
853 | usb_free_urb(urb); | 853 | usb_free_urb(urb); |
854 | mos7840_port->write_urb_pool[j] = NULL; | 854 | mos7840_port->write_urb_pool[j] = NULL; |
@@ -869,9 +869,8 @@ static int mos7840_open(struct tty_struct *tty, | |||
869 | * 0x08 : SP1/2 Control Reg | 869 | * 0x08 : SP1/2 Control Reg |
870 | *****************************************************************************/ | 870 | *****************************************************************************/ |
871 | 871 | ||
872 | //NEED to check the following Block | 872 | /* NEED to check the following Block */ |
873 | 873 | ||
874 | status = 0; | ||
875 | Data = 0x0; | 874 | Data = 0x0; |
876 | status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data); | 875 | status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data); |
877 | if (status < 0) { | 876 | if (status < 0) { |
@@ -891,36 +890,35 @@ static int mos7840_open(struct tty_struct *tty, | |||
891 | dbg("writing Spreg failed\n"); | 890 | dbg("writing Spreg failed\n"); |
892 | return -1; | 891 | return -1; |
893 | } | 892 | } |
894 | //End of block to be checked | 893 | /* End of block to be checked */ |
895 | 894 | ||
896 | status = 0; | ||
897 | Data = 0x0; | 895 | Data = 0x0; |
898 | status = | 896 | status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, |
899 | mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, &Data); | 897 | &Data); |
900 | if (status < 0) { | 898 | if (status < 0) { |
901 | dbg("Reading Controlreg failed\n"); | 899 | dbg("Reading Controlreg failed\n"); |
902 | return -1; | 900 | return -1; |
903 | } | 901 | } |
904 | Data |= 0x08; //Driver done bit | 902 | Data |= 0x08; /* Driver done bit */ |
905 | Data |= 0x20; //rx_disable | 903 | Data |= 0x20; /* rx_disable */ |
906 | status = mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, Data); | 904 | status = mos7840_set_reg_sync(port, |
905 | mos7840_port->ControlRegOffset, Data); | ||
907 | if (status < 0) { | 906 | if (status < 0) { |
908 | dbg("writing Controlreg failed\n"); | 907 | dbg("writing Controlreg failed\n"); |
909 | return -1; | 908 | return -1; |
910 | } | 909 | } |
911 | //do register settings here | 910 | /* do register settings here */ |
912 | // Set all regs to the device default values. | 911 | /* Set all regs to the device default values. */ |
913 | //////////////////////////////////// | 912 | /*********************************** |
914 | // First Disable all interrupts. | 913 | * First Disable all interrupts. |
915 | //////////////////////////////////// | 914 | ***********************************/ |
916 | |||
917 | Data = 0x00; | 915 | Data = 0x00; |
918 | status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); | 916 | status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); |
919 | if (status < 0) { | 917 | if (status < 0) { |
920 | dbg("disableing interrupts failed\n"); | 918 | dbg("disableing interrupts failed\n"); |
921 | return -1; | 919 | return -1; |
922 | } | 920 | } |
923 | // Set FIFO_CONTROL_REGISTER to the default value | 921 | /* Set FIFO_CONTROL_REGISTER to the default value */ |
924 | Data = 0x00; | 922 | Data = 0x00; |
925 | status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); | 923 | status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); |
926 | if (status < 0) { | 924 | if (status < 0) { |
@@ -947,90 +945,73 @@ static int mos7840_open(struct tty_struct *tty, | |||
947 | status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); | 945 | status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); |
948 | mos7840_port->shadowLCR = Data; | 946 | mos7840_port->shadowLCR = Data; |
949 | 947 | ||
950 | Data |= SERIAL_LCR_DLAB; //data latch enable in LCR 0x80 | 948 | Data |= SERIAL_LCR_DLAB; /* data latch enable in LCR 0x80 */ |
951 | status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); | 949 | status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); |
952 | 950 | ||
953 | Data = 0x0c; | 951 | Data = 0x0c; |
954 | status = 0; | ||
955 | status = mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data); | 952 | status = mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data); |
956 | 953 | ||
957 | Data = 0x0; | 954 | Data = 0x0; |
958 | status = 0; | ||
959 | status = mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data); | 955 | status = mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data); |
960 | 956 | ||
961 | Data = 0x00; | 957 | Data = 0x00; |
962 | status = 0; | ||
963 | status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); | 958 | status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); |
964 | 959 | ||
965 | Data = Data & ~SERIAL_LCR_DLAB; | 960 | Data = Data & ~SERIAL_LCR_DLAB; |
966 | status = 0; | ||
967 | status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); | 961 | status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); |
968 | mos7840_port->shadowLCR = Data; | 962 | mos7840_port->shadowLCR = Data; |
969 | 963 | ||
970 | //clearing Bulkin and Bulkout Fifo | 964 | /* clearing Bulkin and Bulkout Fifo */ |
971 | Data = 0x0; | 965 | Data = 0x0; |
972 | status = 0; | ||
973 | status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data); | 966 | status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data); |
974 | 967 | ||
975 | Data = Data | 0x0c; | 968 | Data = Data | 0x0c; |
976 | status = 0; | ||
977 | status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); | 969 | status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); |
978 | 970 | ||
979 | Data = Data & ~0x0c; | 971 | Data = Data & ~0x0c; |
980 | status = 0; | ||
981 | status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); | 972 | status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); |
982 | //Finally enable all interrupts | 973 | /* Finally enable all interrupts */ |
983 | Data = 0x0; | ||
984 | Data = 0x0c; | 974 | Data = 0x0c; |
985 | status = 0; | ||
986 | status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); | 975 | status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); |
987 | 976 | ||
988 | //clearing rx_disable | 977 | /* clearing rx_disable */ |
989 | Data = 0x0; | 978 | Data = 0x0; |
990 | status = 0; | 979 | status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, |
991 | status = | 980 | &Data); |
992 | mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, &Data); | ||
993 | Data = Data & ~0x20; | 981 | Data = Data & ~0x20; |
994 | status = 0; | 982 | status = mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, |
995 | status = | 983 | Data); |
996 | mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, Data); | ||
997 | 984 | ||
998 | // rx_negate | 985 | /* rx_negate */ |
999 | Data = 0x0; | 986 | Data = 0x0; |
1000 | status = 0; | 987 | status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, |
1001 | status = | 988 | &Data); |
1002 | mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, &Data); | ||
1003 | Data = Data | 0x10; | 989 | Data = Data | 0x10; |
1004 | status = 0; | 990 | status = mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, |
1005 | status = | 991 | Data); |
1006 | mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, Data); | ||
1007 | 992 | ||
1008 | /* force low_latency on so that our tty_push actually forces * | 993 | /* force low_latency on so that our tty_push actually forces * |
1009 | * the data through,otherwise it is scheduled, and with * | 994 | * the data through,otherwise it is scheduled, and with * |
1010 | * high data rates (like with OHCI) data can get lost. */ | 995 | * high data rates (like with OHCI) data can get lost. */ |
1011 | |||
1012 | if (tty) | 996 | if (tty) |
1013 | tty->low_latency = 1; | 997 | tty->low_latency = 1; |
1014 | /* Check to see if we've set up our endpoint info yet * | 998 | |
1015 | * (can't set it up in mos7840_startup as the structures * | 999 | /* Check to see if we've set up our endpoint info yet * |
1016 | * were not set up at that time.) */ | 1000 | * (can't set it up in mos7840_startup as the structures * |
1001 | * were not set up at that time.) */ | ||
1017 | if (port0->open_ports == 1) { | 1002 | if (port0->open_ports == 1) { |
1018 | if (serial->port[0]->interrupt_in_buffer == NULL) { | 1003 | if (serial->port[0]->interrupt_in_buffer == NULL) { |
1019 | |||
1020 | /* set up interrupt urb */ | 1004 | /* set up interrupt urb */ |
1021 | |||
1022 | usb_fill_int_urb(serial->port[0]->interrupt_in_urb, | 1005 | usb_fill_int_urb(serial->port[0]->interrupt_in_urb, |
1023 | serial->dev, | 1006 | serial->dev, |
1024 | usb_rcvintpipe(serial->dev, | 1007 | usb_rcvintpipe(serial->dev, |
1025 | serial->port[0]-> | 1008 | serial->port[0]->interrupt_in_endpointAddress), |
1026 | interrupt_in_endpointAddress), | 1009 | serial->port[0]->interrupt_in_buffer, |
1027 | serial->port[0]->interrupt_in_buffer, | 1010 | serial->port[0]->interrupt_in_urb-> |
1028 | serial->port[0]->interrupt_in_urb-> | 1011 | transfer_buffer_length, |
1029 | transfer_buffer_length, | 1012 | mos7840_interrupt_callback, |
1030 | mos7840_interrupt_callback, | 1013 | serial, |
1031 | serial, | 1014 | serial->port[0]->interrupt_in_urb->interval); |
1032 | serial->port[0]->interrupt_in_urb-> | ||
1033 | interval); | ||
1034 | 1015 | ||
1035 | /* start interrupt read for mos7840 * | 1016 | /* start interrupt read for mos7840 * |
1036 | * will continue as long as mos7840 is connected */ | 1017 | * will continue as long as mos7840 is connected */ |
@@ -1085,14 +1066,16 @@ static int mos7840_open(struct tty_struct *tty, | |||
1085 | memset(&(mos7840_port->icount), 0x00, sizeof(mos7840_port->icount)); | 1066 | memset(&(mos7840_port->icount), 0x00, sizeof(mos7840_port->icount)); |
1086 | 1067 | ||
1087 | /* initialize our port settings */ | 1068 | /* initialize our port settings */ |
1088 | mos7840_port->shadowMCR = MCR_MASTER_IE; /* Must set to enable ints! */ | 1069 | /* Must set to enable ints! */ |
1070 | mos7840_port->shadowMCR = MCR_MASTER_IE; | ||
1089 | /* send a open port command */ | 1071 | /* send a open port command */ |
1090 | mos7840_port->open = 1; | 1072 | mos7840_port->open = 1; |
1091 | //mos7840_change_port_settings(mos7840_port,old_termios); | 1073 | /* mos7840_change_port_settings(mos7840_port,old_termios); */ |
1092 | mos7840_port->icount.tx = 0; | 1074 | mos7840_port->icount.tx = 0; |
1093 | mos7840_port->icount.rx = 0; | 1075 | mos7840_port->icount.rx = 0; |
1094 | 1076 | ||
1095 | dbg("\n\nusb_serial serial:%p mos7840_port:%p\n usb_serial_port port:%p\n\n", serial, mos7840_port, port); | 1077 | dbg("\n\nusb_serial serial:%p mos7840_port:%p\n usb_serial_port port:%p\n\n", |
1078 | serial, mos7840_port, port); | ||
1096 | 1079 | ||
1097 | return 0; | 1080 | return 0; |
1098 | 1081 | ||
@@ -1129,11 +1112,11 @@ static int mos7840_chars_in_buffer(struct tty_struct *tty) | |||
1129 | return 0; | 1112 | return 0; |
1130 | } | 1113 | } |
1131 | 1114 | ||
1132 | spin_lock_irqsave(&mos7840_port->pool_lock,flags); | 1115 | spin_lock_irqsave(&mos7840_port->pool_lock, flags); |
1133 | for (i = 0; i < NUM_URBS; ++i) | 1116 | for (i = 0; i < NUM_URBS; ++i) |
1134 | if (mos7840_port->busy[i]) | 1117 | if (mos7840_port->busy[i]) |
1135 | chars += URB_TRANSFER_BUFFER_SIZE; | 1118 | chars += URB_TRANSFER_BUFFER_SIZE; |
1136 | spin_unlock_irqrestore(&mos7840_port->pool_lock,flags); | 1119 | spin_unlock_irqrestore(&mos7840_port->pool_lock, flags); |
1137 | dbg("%s - returns %d", __func__, chars); | 1120 | dbg("%s - returns %d", __func__, chars); |
1138 | return chars; | 1121 | return chars; |
1139 | 1122 | ||
@@ -1161,9 +1144,8 @@ static void mos7840_block_until_tx_empty(struct tty_struct *tty, | |||
1161 | count = mos7840_chars_in_buffer(tty); | 1144 | count = mos7840_chars_in_buffer(tty); |
1162 | 1145 | ||
1163 | /* Check for Buffer status */ | 1146 | /* Check for Buffer status */ |
1164 | if (count <= 0) { | 1147 | if (count <= 0) |
1165 | return; | 1148 | return; |
1166 | } | ||
1167 | 1149 | ||
1168 | /* Block the thread for a while */ | 1150 | /* Block the thread for a while */ |
1169 | interruptible_sleep_on_timeout(&mos7840_port->wait_chase, | 1151 | interruptible_sleep_on_timeout(&mos7840_port->wait_chase, |
@@ -1245,11 +1227,11 @@ static void mos7840_close(struct tty_struct *tty, | |||
1245 | } | 1227 | } |
1246 | if ((&mos7840_port->control_urb)) { | 1228 | if ((&mos7840_port->control_urb)) { |
1247 | dbg("%s", "Shutdown control read\n"); | 1229 | dbg("%s", "Shutdown control read\n"); |
1248 | // usb_kill_urb (mos7840_port->control_urb); | 1230 | /*/ usb_kill_urb (mos7840_port->control_urb); */ |
1249 | } | 1231 | } |
1250 | } | 1232 | } |
1251 | // if(mos7840_port->ctrl_buf != NULL) | 1233 | /* if(mos7840_port->ctrl_buf != NULL) */ |
1252 | // kfree(mos7840_port->ctrl_buf); | 1234 | /* kfree(mos7840_port->ctrl_buf); */ |
1253 | port0->open_ports--; | 1235 | port0->open_ports--; |
1254 | dbg("mos7840_num_open_ports in close%d:in port%d\n", | 1236 | dbg("mos7840_num_open_ports in close%d:in port%d\n", |
1255 | port0->open_ports, port->number); | 1237 | port0->open_ports, port->number); |
@@ -1262,10 +1244,8 @@ static void mos7840_close(struct tty_struct *tty, | |||
1262 | 1244 | ||
1263 | if (mos7840_port->write_urb) { | 1245 | if (mos7840_port->write_urb) { |
1264 | /* if this urb had a transfer buffer already (old tx) free it */ | 1246 | /* if this urb had a transfer buffer already (old tx) free it */ |
1265 | 1247 | if (mos7840_port->write_urb->transfer_buffer != NULL) | |
1266 | if (mos7840_port->write_urb->transfer_buffer != NULL) { | ||
1267 | kfree(mos7840_port->write_urb->transfer_buffer); | 1248 | kfree(mos7840_port->write_urb->transfer_buffer); |
1268 | } | ||
1269 | usb_free_urb(mos7840_port->write_urb); | 1249 | usb_free_urb(mos7840_port->write_urb); |
1270 | } | 1250 | } |
1271 | 1251 | ||
@@ -1302,9 +1282,8 @@ static void mos7840_block_until_chase_response(struct tty_struct *tty, | |||
1302 | count = mos7840_chars_in_buffer(tty); | 1282 | count = mos7840_chars_in_buffer(tty); |
1303 | 1283 | ||
1304 | /* Check for Buffer status */ | 1284 | /* Check for Buffer status */ |
1305 | if (count <= 0) { | 1285 | if (count <= 0) |
1306 | return; | 1286 | return; |
1307 | } | ||
1308 | 1287 | ||
1309 | /* Block the thread for a while */ | 1288 | /* Block the thread for a while */ |
1310 | interruptible_sleep_on_timeout(&mos7840_port->wait_chase, | 1289 | interruptible_sleep_on_timeout(&mos7840_port->wait_chase, |
@@ -1349,9 +1328,8 @@ static void mos7840_break(struct tty_struct *tty, int break_state) | |||
1349 | 1328 | ||
1350 | mos7840_port = mos7840_get_port_private(port); | 1329 | mos7840_port = mos7840_get_port_private(port); |
1351 | 1330 | ||
1352 | if (mos7840_port == NULL) { | 1331 | if (mos7840_port == NULL) |
1353 | return; | 1332 | return; |
1354 | } | ||
1355 | 1333 | ||
1356 | if (serial->dev) | 1334 | if (serial->dev) |
1357 | /* flush and block until tx is empty */ | 1335 | /* flush and block until tx is empty */ |
@@ -1403,9 +1381,8 @@ static int mos7840_write_room(struct tty_struct *tty) | |||
1403 | 1381 | ||
1404 | spin_lock_irqsave(&mos7840_port->pool_lock, flags); | 1382 | spin_lock_irqsave(&mos7840_port->pool_lock, flags); |
1405 | for (i = 0; i < NUM_URBS; ++i) { | 1383 | for (i = 0; i < NUM_URBS; ++i) { |
1406 | if (!mos7840_port->busy[i]) { | 1384 | if (!mos7840_port->busy[i]) |
1407 | room += URB_TRANSFER_BUFFER_SIZE; | 1385 | room += URB_TRANSFER_BUFFER_SIZE; |
1408 | } | ||
1409 | } | 1386 | } |
1410 | spin_unlock_irqrestore(&mos7840_port->pool_lock, flags); | 1387 | spin_unlock_irqrestore(&mos7840_port->pool_lock, flags); |
1411 | 1388 | ||
@@ -1435,45 +1412,41 @@ static int mos7840_write(struct tty_struct *tty, struct usb_serial_port *port, | |||
1435 | struct moschip_port *mos7840_port; | 1412 | struct moschip_port *mos7840_port; |
1436 | struct usb_serial *serial; | 1413 | struct usb_serial *serial; |
1437 | struct urb *urb; | 1414 | struct urb *urb; |
1438 | //__u16 Data; | 1415 | /* __u16 Data; */ |
1439 | const unsigned char *current_position = data; | 1416 | const unsigned char *current_position = data; |
1440 | unsigned char *data1; | 1417 | unsigned char *data1; |
1441 | dbg("%s \n", "entering ..........."); | 1418 | dbg("%s \n", "entering ..........."); |
1442 | //dbg("mos7840_write: mos7840_port->shadowLCR is %x\n",mos7840_port->shadowLCR); | 1419 | /* dbg("mos7840_write: mos7840_port->shadowLCR is %x\n", |
1420 | mos7840_port->shadowLCR); */ | ||
1443 | 1421 | ||
1444 | #ifdef NOTMOS7840 | 1422 | #ifdef NOTMOS7840 |
1445 | Data = 0x00; | 1423 | Data = 0x00; |
1446 | status = 0; | ||
1447 | status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); | 1424 | status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); |
1448 | mos7840_port->shadowLCR = Data; | 1425 | mos7840_port->shadowLCR = Data; |
1449 | dbg("mos7840_write: LINE_CONTROL_REGISTER is %x\n", Data); | 1426 | dbg("mos7840_write: LINE_CONTROL_REGISTER is %x\n", Data); |
1450 | dbg("mos7840_write: mos7840_port->shadowLCR is %x\n", | 1427 | dbg("mos7840_write: mos7840_port->shadowLCR is %x\n", |
1451 | mos7840_port->shadowLCR); | 1428 | mos7840_port->shadowLCR); |
1452 | 1429 | ||
1453 | //Data = 0x03; | 1430 | /* Data = 0x03; */ |
1454 | //status = mos7840_set_uart_reg(port,LINE_CONTROL_REGISTER,Data); | 1431 | /* status = mos7840_set_uart_reg(port,LINE_CONTROL_REGISTER,Data); */ |
1455 | //mos7840_port->shadowLCR=Data;//Need to add later | 1432 | /* mos7840_port->shadowLCR=Data;//Need to add later */ |
1456 | 1433 | ||
1457 | Data |= SERIAL_LCR_DLAB; //data latch enable in LCR 0x80 | 1434 | Data |= SERIAL_LCR_DLAB; /* data latch enable in LCR 0x80 */ |
1458 | status = 0; | ||
1459 | status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); | 1435 | status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); |
1460 | 1436 | ||
1461 | //Data = 0x0c; | 1437 | /* Data = 0x0c; */ |
1462 | //status = mos7840_set_uart_reg(port,DIVISOR_LATCH_LSB,Data); | 1438 | /* status = mos7840_set_uart_reg(port,DIVISOR_LATCH_LSB,Data); */ |
1463 | Data = 0x00; | 1439 | Data = 0x00; |
1464 | status = 0; | ||
1465 | status = mos7840_get_uart_reg(port, DIVISOR_LATCH_LSB, &Data); | 1440 | status = mos7840_get_uart_reg(port, DIVISOR_LATCH_LSB, &Data); |
1466 | dbg("mos7840_write:DLL value is %x\n", Data); | 1441 | dbg("mos7840_write:DLL value is %x\n", Data); |
1467 | 1442 | ||
1468 | Data = 0x0; | 1443 | Data = 0x0; |
1469 | status = 0; | ||
1470 | status = mos7840_get_uart_reg(port, DIVISOR_LATCH_MSB, &Data); | 1444 | status = mos7840_get_uart_reg(port, DIVISOR_LATCH_MSB, &Data); |
1471 | dbg("mos7840_write:DLM value is %x\n", Data); | 1445 | dbg("mos7840_write:DLM value is %x\n", Data); |
1472 | 1446 | ||
1473 | Data = Data & ~SERIAL_LCR_DLAB; | 1447 | Data = Data & ~SERIAL_LCR_DLAB; |
1474 | dbg("mos7840_write: mos7840_port->shadowLCR is %x\n", | 1448 | dbg("mos7840_write: mos7840_port->shadowLCR is %x\n", |
1475 | mos7840_port->shadowLCR); | 1449 | mos7840_port->shadowLCR); |
1476 | status = 0; | ||
1477 | status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); | 1450 | status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); |
1478 | #endif | 1451 | #endif |
1479 | 1452 | ||
@@ -1598,7 +1571,6 @@ static void mos7840_throttle(struct tty_struct *tty) | |||
1598 | /* if we are implementing RTS/CTS, toggle that line */ | 1571 | /* if we are implementing RTS/CTS, toggle that line */ |
1599 | if (tty->termios->c_cflag & CRTSCTS) { | 1572 | if (tty->termios->c_cflag & CRTSCTS) { |
1600 | mos7840_port->shadowMCR &= ~MCR_RTS; | 1573 | mos7840_port->shadowMCR &= ~MCR_RTS; |
1601 | status = 0; | ||
1602 | status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, | 1574 | status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, |
1603 | mos7840_port->shadowMCR); | 1575 | mos7840_port->shadowMCR); |
1604 | if (status < 0) | 1576 | if (status < 0) |
@@ -1610,8 +1582,9 @@ static void mos7840_throttle(struct tty_struct *tty) | |||
1610 | 1582 | ||
1611 | /***************************************************************************** | 1583 | /***************************************************************************** |
1612 | * mos7840_unthrottle | 1584 | * mos7840_unthrottle |
1613 | * this function is called by the tty driver when it wants to resume the data | 1585 | * this function is called by the tty driver when it wants to resume |
1614 | * being read from the port (called after SerialThrottle is called) | 1586 | * the data being read from the port (called after mos7840_throttle is |
1587 | * called) | ||
1615 | *****************************************************************************/ | 1588 | *****************************************************************************/ |
1616 | static void mos7840_unthrottle(struct tty_struct *tty) | 1589 | static void mos7840_unthrottle(struct tty_struct *tty) |
1617 | { | 1590 | { |
@@ -1645,7 +1618,6 @@ static void mos7840_unthrottle(struct tty_struct *tty) | |||
1645 | /* if we are implementing RTS/CTS, toggle that line */ | 1618 | /* if we are implementing RTS/CTS, toggle that line */ |
1646 | if (tty->termios->c_cflag & CRTSCTS) { | 1619 | if (tty->termios->c_cflag & CRTSCTS) { |
1647 | mos7840_port->shadowMCR |= MCR_RTS; | 1620 | mos7840_port->shadowMCR |= MCR_RTS; |
1648 | status = 0; | ||
1649 | status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, | 1621 | status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, |
1650 | mos7840_port->shadowMCR); | 1622 | mos7840_port->shadowMCR); |
1651 | if (status < 0) | 1623 | if (status < 0) |
@@ -1660,7 +1632,7 @@ static int mos7840_tiocmget(struct tty_struct *tty, struct file *file) | |||
1660 | unsigned int result; | 1632 | unsigned int result; |
1661 | __u16 msr; | 1633 | __u16 msr; |
1662 | __u16 mcr; | 1634 | __u16 mcr; |
1663 | int status = 0; | 1635 | int status; |
1664 | mos7840_port = mos7840_get_port_private(port); | 1636 | mos7840_port = mos7840_get_port_private(port); |
1665 | 1637 | ||
1666 | dbg("%s - port %d", __func__, port->number); | 1638 | dbg("%s - port %d", __func__, port->number); |
@@ -1731,7 +1703,7 @@ static int mos7840_tiocmset(struct tty_struct *tty, struct file *file, | |||
1731 | * baud rate. | 1703 | * baud rate. |
1732 | *****************************************************************************/ | 1704 | *****************************************************************************/ |
1733 | static int mos7840_calc_baud_rate_divisor(int baudRate, int *divisor, | 1705 | static int mos7840_calc_baud_rate_divisor(int baudRate, int *divisor, |
1734 | __u16 * clk_sel_val) | 1706 | __u16 *clk_sel_val) |
1735 | { | 1707 | { |
1736 | 1708 | ||
1737 | dbg("%s - %d", __func__, baudRate); | 1709 | dbg("%s - %d", __func__, baudRate); |
@@ -1783,9 +1755,8 @@ static int mos7840_calc_baud_rate_divisor(int baudRate, int *divisor, | |||
1783 | /* Check for round off */ | 1755 | /* Check for round off */ |
1784 | round1 = (__u16) (2304000L / baudrate); | 1756 | round1 = (__u16) (2304000L / baudrate); |
1785 | round = (__u16) (round1 - (custom * 10)); | 1757 | round = (__u16) (round1 - (custom * 10)); |
1786 | if (round > 4) { | 1758 | if (round > 4) |
1787 | custom++; | 1759 | custom++; |
1788 | } | ||
1789 | *divisor = custom; | 1760 | *divisor = custom; |
1790 | 1761 | ||
1791 | dbg(" Baud %d = %d\n", baudrate, custom); | 1762 | dbg(" Baud %d = %d\n", baudrate, custom); |
@@ -1833,16 +1804,15 @@ static int mos7840_send_cmd_write_baud_rate(struct moschip_port *mos7840_port, | |||
1833 | 1804 | ||
1834 | dbg("%s - port = %d, baud = %d", __func__, | 1805 | dbg("%s - port = %d, baud = %d", __func__, |
1835 | mos7840_port->port->number, baudRate); | 1806 | mos7840_port->port->number, baudRate); |
1836 | //reset clk_uart_sel in spregOffset | 1807 | /* reset clk_uart_sel in spregOffset */ |
1837 | if (baudRate > 115200) { | 1808 | if (baudRate > 115200) { |
1838 | #ifdef HW_flow_control | 1809 | #ifdef HW_flow_control |
1839 | //NOTE: need to see the pther register to modify | 1810 | /* NOTE: need to see the pther register to modify */ |
1840 | //setting h/w flow control bit to 1; | 1811 | /* setting h/w flow control bit to 1 */ |
1841 | status = 0; | ||
1842 | Data = 0x2b; | 1812 | Data = 0x2b; |
1843 | mos7840_port->shadowMCR = Data; | 1813 | mos7840_port->shadowMCR = Data; |
1844 | status = | 1814 | status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, |
1845 | mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); | 1815 | Data); |
1846 | if (status < 0) { | 1816 | if (status < 0) { |
1847 | dbg("Writing spreg failed in set_serial_baud\n"); | 1817 | dbg("Writing spreg failed in set_serial_baud\n"); |
1848 | return -1; | 1818 | return -1; |
@@ -1851,12 +1821,11 @@ static int mos7840_send_cmd_write_baud_rate(struct moschip_port *mos7840_port, | |||
1851 | 1821 | ||
1852 | } else { | 1822 | } else { |
1853 | #ifdef HW_flow_control | 1823 | #ifdef HW_flow_control |
1854 | //setting h/w flow control bit to 0; | 1824 | / *setting h/w flow control bit to 0 */ |
1855 | status = 0; | ||
1856 | Data = 0xb; | 1825 | Data = 0xb; |
1857 | mos7840_port->shadowMCR = Data; | 1826 | mos7840_port->shadowMCR = Data; |
1858 | status = | 1827 | status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, |
1859 | mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); | 1828 | Data); |
1860 | if (status < 0) { | 1829 | if (status < 0) { |
1861 | dbg("Writing spreg failed in set_serial_baud\n"); | 1830 | dbg("Writing spreg failed in set_serial_baud\n"); |
1862 | return -1; | 1831 | return -1; |
@@ -1865,25 +1834,20 @@ static int mos7840_send_cmd_write_baud_rate(struct moschip_port *mos7840_port, | |||
1865 | 1834 | ||
1866 | } | 1835 | } |
1867 | 1836 | ||
1868 | if (1) //baudRate <= 115200) | 1837 | if (1) { /* baudRate <= 115200) */ |
1869 | { | ||
1870 | clk_sel_val = 0x0; | 1838 | clk_sel_val = 0x0; |
1871 | Data = 0x0; | 1839 | Data = 0x0; |
1872 | status = 0; | 1840 | status = mos7840_calc_baud_rate_divisor(baudRate, &divisor, |
1873 | status = | ||
1874 | mos7840_calc_baud_rate_divisor(baudRate, &divisor, | ||
1875 | &clk_sel_val); | 1841 | &clk_sel_val); |
1876 | status = | 1842 | status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, |
1877 | mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, | 1843 | &Data); |
1878 | &Data); | ||
1879 | if (status < 0) { | 1844 | if (status < 0) { |
1880 | dbg("reading spreg failed in set_serial_baud\n"); | 1845 | dbg("reading spreg failed in set_serial_baud\n"); |
1881 | return -1; | 1846 | return -1; |
1882 | } | 1847 | } |
1883 | Data = (Data & 0x8f) | clk_sel_val; | 1848 | Data = (Data & 0x8f) | clk_sel_val; |
1884 | status = 0; | 1849 | status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, |
1885 | status = | 1850 | Data); |
1886 | mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); | ||
1887 | if (status < 0) { | 1851 | if (status < 0) { |
1888 | dbg("Writing spreg failed in set_serial_baud\n"); | 1852 | dbg("Writing spreg failed in set_serial_baud\n"); |
1889 | return -1; | 1853 | return -1; |
@@ -1915,7 +1879,6 @@ static int mos7840_send_cmd_write_baud_rate(struct moschip_port *mos7840_port, | |||
1915 | mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); | 1879 | mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); |
1916 | 1880 | ||
1917 | } | 1881 | } |
1918 | |||
1919 | return status; | 1882 | return status; |
1920 | } | 1883 | } |
1921 | 1884 | ||
@@ -2006,9 +1969,8 @@ static void mos7840_change_port_settings(struct tty_struct *tty, | |||
2006 | dbg("%s - parity = none", __func__); | 1969 | dbg("%s - parity = none", __func__); |
2007 | } | 1970 | } |
2008 | 1971 | ||
2009 | if (cflag & CMSPAR) { | 1972 | if (cflag & CMSPAR) |
2010 | lParity = lParity | 0x20; | 1973 | lParity = lParity | 0x20; |
2011 | } | ||
2012 | 1974 | ||
2013 | /* Change the Stop bit */ | 1975 | /* Change the Stop bit */ |
2014 | if (cflag & CSTOPB) { | 1976 | if (cflag & CSTOPB) { |
@@ -2050,16 +2012,13 @@ static void mos7840_change_port_settings(struct tty_struct *tty, | |||
2050 | /* set up the MCR register and send it to the mos7840 */ | 2012 | /* set up the MCR register and send it to the mos7840 */ |
2051 | 2013 | ||
2052 | mos7840_port->shadowMCR = MCR_MASTER_IE; | 2014 | mos7840_port->shadowMCR = MCR_MASTER_IE; |
2053 | if (cflag & CBAUD) { | 2015 | if (cflag & CBAUD) |
2054 | mos7840_port->shadowMCR |= (MCR_DTR | MCR_RTS); | 2016 | mos7840_port->shadowMCR |= (MCR_DTR | MCR_RTS); |
2055 | } | ||
2056 | 2017 | ||
2057 | if (cflag & CRTSCTS) { | 2018 | if (cflag & CRTSCTS) |
2058 | mos7840_port->shadowMCR |= (MCR_XON_ANY); | 2019 | mos7840_port->shadowMCR |= (MCR_XON_ANY); |
2059 | 2020 | else | |
2060 | } else { | ||
2061 | mos7840_port->shadowMCR &= ~(MCR_XON_ANY); | 2021 | mos7840_port->shadowMCR &= ~(MCR_XON_ANY); |
2062 | } | ||
2063 | 2022 | ||
2064 | Data = mos7840_port->shadowMCR; | 2023 | Data = mos7840_port->shadowMCR; |
2065 | mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); | 2024 | mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); |
@@ -2255,7 +2214,6 @@ static int mos7840_set_modem_info(struct moschip_port *mos7840_port, | |||
2255 | mos7840_port->shadowMCR = mcr; | 2214 | mos7840_port->shadowMCR = mcr; |
2256 | 2215 | ||
2257 | Data = mos7840_port->shadowMCR; | 2216 | Data = mos7840_port->shadowMCR; |
2258 | status = 0; | ||
2259 | status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); | 2217 | status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); |
2260 | if (status < 0) { | 2218 | if (status < 0) { |
2261 | dbg("setting MODEM_CONTROL_REGISTER Failed\n"); | 2219 | dbg("setting MODEM_CONTROL_REGISTER Failed\n"); |
@@ -2276,8 +2234,7 @@ static int mos7840_get_modem_info(struct moschip_port *mos7840_port, | |||
2276 | unsigned int result = 0; | 2234 | unsigned int result = 0; |
2277 | __u16 msr; | 2235 | __u16 msr; |
2278 | unsigned int mcr = mos7840_port->shadowMCR; | 2236 | unsigned int mcr = mos7840_port->shadowMCR; |
2279 | int status = 0; | 2237 | mos7840_get_uart_reg(mos7840_port->port, |
2280 | status = mos7840_get_uart_reg(mos7840_port->port, | ||
2281 | MODEM_STATUS_REGISTER, &msr); | 2238 | MODEM_STATUS_REGISTER, &msr); |
2282 | result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0) /* 0x002 */ | 2239 | result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0) /* 0x002 */ |
2283 | |((mcr & MCR_RTS) ? TIOCM_RTS : 0) /* 0x004 */ | 2240 | |((mcr & MCR_RTS) ? TIOCM_RTS : 0) /* 0x004 */ |
@@ -2389,7 +2346,7 @@ static int mos7840_ioctl(struct tty_struct *tty, struct file *file, | |||
2389 | dbg("%s (%d) TIOCMIWAIT", __func__, port->number); | 2346 | dbg("%s (%d) TIOCMIWAIT", __func__, port->number); |
2390 | cprev = mos7840_port->icount; | 2347 | cprev = mos7840_port->icount; |
2391 | while (1) { | 2348 | while (1) { |
2392 | //interruptible_sleep_on(&mos7840_port->delta_msr_wait); | 2349 | /* interruptible_sleep_on(&mos7840_port->delta_msr_wait); */ |
2393 | mos7840_port->delta_msr_cond = 0; | 2350 | mos7840_port->delta_msr_cond = 0; |
2394 | wait_event_interruptible(mos7840_port->delta_msr_wait, | 2351 | wait_event_interruptible(mos7840_port->delta_msr_wait, |
2395 | (mos7840_port-> | 2352 | (mos7840_port-> |
@@ -2494,8 +2451,9 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2494 | goto error; | 2451 | goto error; |
2495 | } | 2452 | } |
2496 | 2453 | ||
2497 | /* Initialize all port interrupt end point to port 0 int endpoint * | 2454 | /* Initialize all port interrupt end point to port 0 int |
2498 | * Our device has only one interrupt end point comman to all port */ | 2455 | * endpoint. Our device has only one interrupt end point |
2456 | * common to all port */ | ||
2499 | 2457 | ||
2500 | mos7840_port->port = serial->port[i]; | 2458 | mos7840_port->port = serial->port[i]; |
2501 | mos7840_set_port_private(serial->port[i], mos7840_port); | 2459 | mos7840_set_port_private(serial->port[i], mos7840_port); |
@@ -2531,27 +2489,23 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2531 | mos7840_port->DcrRegOffset = 0x1c; | 2489 | mos7840_port->DcrRegOffset = 0x1c; |
2532 | } | 2490 | } |
2533 | mos7840_dump_serial_port(mos7840_port); | 2491 | mos7840_dump_serial_port(mos7840_port); |
2534 | |||
2535 | mos7840_set_port_private(serial->port[i], mos7840_port); | 2492 | mos7840_set_port_private(serial->port[i], mos7840_port); |
2536 | 2493 | ||
2537 | //enable rx_disable bit in control register | 2494 | /* enable rx_disable bit in control register */ |
2538 | 2495 | status = mos7840_get_reg_sync(serial->port[i], | |
2539 | status = | 2496 | mos7840_port->ControlRegOffset, &Data); |
2540 | mos7840_get_reg_sync(serial->port[i], | ||
2541 | mos7840_port->ControlRegOffset, &Data); | ||
2542 | if (status < 0) { | 2497 | if (status < 0) { |
2543 | dbg("Reading ControlReg failed status-0x%x\n", status); | 2498 | dbg("Reading ControlReg failed status-0x%x\n", status); |
2544 | break; | 2499 | break; |
2545 | } else | 2500 | } else |
2546 | dbg("ControlReg Reading success val is %x, status%d\n", | 2501 | dbg("ControlReg Reading success val is %x, status%d\n", |
2547 | Data, status); | 2502 | Data, status); |
2548 | Data |= 0x08; //setting driver done bit | 2503 | Data |= 0x08; /* setting driver done bit */ |
2549 | Data |= 0x04; //sp1_bit to have cts change reflect in modem status reg | 2504 | Data |= 0x04; /* sp1_bit to have cts change reflect in |
2505 | modem status reg */ | ||
2550 | 2506 | ||
2551 | //Data |= 0x20; //rx_disable bit | 2507 | /* Data |= 0x20; //rx_disable bit */ |
2552 | status = 0; | 2508 | status = mos7840_set_reg_sync(serial->port[i], |
2553 | status = | ||
2554 | mos7840_set_reg_sync(serial->port[i], | ||
2555 | mos7840_port->ControlRegOffset, Data); | 2509 | mos7840_port->ControlRegOffset, Data); |
2556 | if (status < 0) { | 2510 | if (status < 0) { |
2557 | dbg("Writing ControlReg failed(rx_disable) status-0x%x\n", status); | 2511 | dbg("Writing ControlReg failed(rx_disable) status-0x%x\n", status); |
@@ -2560,13 +2514,11 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2560 | dbg("ControlReg Writing success(rx_disable) status%d\n", | 2514 | dbg("ControlReg Writing success(rx_disable) status%d\n", |
2561 | status); | 2515 | status); |
2562 | 2516 | ||
2563 | //Write default values in DCR (i.e 0x01 in DCR0, 0x05 in DCR2 and 0x24 in DCR3 | 2517 | /* Write default values in DCR (i.e 0x01 in DCR0, 0x05 in DCR2 |
2518 | and 0x24 in DCR3 */ | ||
2564 | Data = 0x01; | 2519 | Data = 0x01; |
2565 | status = 0; | 2520 | status = mos7840_set_reg_sync(serial->port[i], |
2566 | status = | 2521 | (__u16) (mos7840_port->DcrRegOffset + 0), Data); |
2567 | mos7840_set_reg_sync(serial->port[i], | ||
2568 | (__u16) (mos7840_port->DcrRegOffset + | ||
2569 | 0), Data); | ||
2570 | if (status < 0) { | 2522 | if (status < 0) { |
2571 | dbg("Writing DCR0 failed status-0x%x\n", status); | 2523 | dbg("Writing DCR0 failed status-0x%x\n", status); |
2572 | break; | 2524 | break; |
@@ -2574,11 +2526,8 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2574 | dbg("DCR0 Writing success status%d\n", status); | 2526 | dbg("DCR0 Writing success status%d\n", status); |
2575 | 2527 | ||
2576 | Data = 0x05; | 2528 | Data = 0x05; |
2577 | status = 0; | 2529 | status = mos7840_set_reg_sync(serial->port[i], |
2578 | status = | 2530 | (__u16) (mos7840_port->DcrRegOffset + 1), Data); |
2579 | mos7840_set_reg_sync(serial->port[i], | ||
2580 | (__u16) (mos7840_port->DcrRegOffset + | ||
2581 | 1), Data); | ||
2582 | if (status < 0) { | 2531 | if (status < 0) { |
2583 | dbg("Writing DCR1 failed status-0x%x\n", status); | 2532 | dbg("Writing DCR1 failed status-0x%x\n", status); |
2584 | break; | 2533 | break; |
@@ -2586,22 +2535,17 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2586 | dbg("DCR1 Writing success status%d\n", status); | 2535 | dbg("DCR1 Writing success status%d\n", status); |
2587 | 2536 | ||
2588 | Data = 0x24; | 2537 | Data = 0x24; |
2589 | status = 0; | 2538 | status = mos7840_set_reg_sync(serial->port[i], |
2590 | status = | 2539 | (__u16) (mos7840_port->DcrRegOffset + 2), Data); |
2591 | mos7840_set_reg_sync(serial->port[i], | ||
2592 | (__u16) (mos7840_port->DcrRegOffset + | ||
2593 | 2), Data); | ||
2594 | if (status < 0) { | 2540 | if (status < 0) { |
2595 | dbg("Writing DCR2 failed status-0x%x\n", status); | 2541 | dbg("Writing DCR2 failed status-0x%x\n", status); |
2596 | break; | 2542 | break; |
2597 | } else | 2543 | } else |
2598 | dbg("DCR2 Writing success status%d\n", status); | 2544 | dbg("DCR2 Writing success status%d\n", status); |
2599 | 2545 | ||
2600 | // write values in clkstart0x0 and clkmulti 0x20 | 2546 | /* write values in clkstart0x0 and clkmulti 0x20 */ |
2601 | Data = 0x0; | 2547 | Data = 0x0; |
2602 | status = 0; | 2548 | status = mos7840_set_reg_sync(serial->port[i], |
2603 | status = | ||
2604 | mos7840_set_reg_sync(serial->port[i], | ||
2605 | CLK_START_VALUE_REGISTER, Data); | 2549 | CLK_START_VALUE_REGISTER, Data); |
2606 | if (status < 0) { | 2550 | if (status < 0) { |
2607 | dbg("Writing CLK_START_VALUE_REGISTER failed status-0x%x\n", status); | 2551 | dbg("Writing CLK_START_VALUE_REGISTER failed status-0x%x\n", status); |
@@ -2610,9 +2554,8 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2610 | dbg("CLK_START_VALUE_REGISTER Writing success status%d\n", status); | 2554 | dbg("CLK_START_VALUE_REGISTER Writing success status%d\n", status); |
2611 | 2555 | ||
2612 | Data = 0x20; | 2556 | Data = 0x20; |
2613 | status = | 2557 | status = mos7840_set_reg_sync(serial->port[i], |
2614 | mos7840_set_reg_sync(serial->port[i], CLK_MULTI_REGISTER, | 2558 | CLK_MULTI_REGISTER, Data); |
2615 | Data); | ||
2616 | if (status < 0) { | 2559 | if (status < 0) { |
2617 | dbg("Writing CLK_MULTI_REGISTER failed status-0x%x\n", | 2560 | dbg("Writing CLK_MULTI_REGISTER failed status-0x%x\n", |
2618 | status); | 2561 | status); |
@@ -2621,11 +2564,10 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2621 | dbg("CLK_MULTI_REGISTER Writing success status%d\n", | 2564 | dbg("CLK_MULTI_REGISTER Writing success status%d\n", |
2622 | status); | 2565 | status); |
2623 | 2566 | ||
2624 | //write value 0x0 to scratchpad register | 2567 | /* write value 0x0 to scratchpad register */ |
2625 | Data = 0x00; | 2568 | Data = 0x00; |
2626 | status = | 2569 | status = mos7840_set_uart_reg(serial->port[i], |
2627 | mos7840_set_uart_reg(serial->port[i], SCRATCH_PAD_REGISTER, | 2570 | SCRATCH_PAD_REGISTER, Data); |
2628 | Data); | ||
2629 | if (status < 0) { | 2571 | if (status < 0) { |
2630 | dbg("Writing SCRATCH_PAD_REGISTER failed status-0x%x\n", | 2572 | dbg("Writing SCRATCH_PAD_REGISTER failed status-0x%x\n", |
2631 | status); | 2573 | status); |
@@ -2634,21 +2576,17 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2634 | dbg("SCRATCH_PAD_REGISTER Writing success status%d\n", | 2576 | dbg("SCRATCH_PAD_REGISTER Writing success status%d\n", |
2635 | status); | 2577 | status); |
2636 | 2578 | ||
2637 | //Zero Length flag register | 2579 | /* Zero Length flag register */ |
2638 | if ((mos7840_port->port_num != 1) | 2580 | if ((mos7840_port->port_num != 1) |
2639 | && (serial->num_ports == 2)) { | 2581 | && (serial->num_ports == 2)) { |
2640 | 2582 | ||
2641 | Data = 0xff; | 2583 | Data = 0xff; |
2642 | status = 0; | ||
2643 | status = mos7840_set_reg_sync(serial->port[i], | 2584 | status = mos7840_set_reg_sync(serial->port[i], |
2644 | (__u16) (ZLP_REG1 + | 2585 | (__u16) (ZLP_REG1 + |
2645 | ((__u16) | 2586 | ((__u16)mos7840_port->port_num)), Data); |
2646 | mos7840_port-> | ||
2647 | port_num)), | ||
2648 | Data); | ||
2649 | dbg("ZLIP offset%x\n", | 2587 | dbg("ZLIP offset%x\n", |
2650 | (__u16) (ZLP_REG1 + | 2588 | (__u16) (ZLP_REG1 + |
2651 | ((__u16) mos7840_port->port_num))); | 2589 | ((__u16) mos7840_port->port_num))); |
2652 | if (status < 0) { | 2590 | if (status < 0) { |
2653 | dbg("Writing ZLP_REG%d failed status-0x%x\n", | 2591 | dbg("Writing ZLP_REG%d failed status-0x%x\n", |
2654 | i + 2, status); | 2592 | i + 2, status); |
@@ -2658,13 +2596,9 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2658 | i + 2, status); | 2596 | i + 2, status); |
2659 | } else { | 2597 | } else { |
2660 | Data = 0xff; | 2598 | Data = 0xff; |
2661 | status = 0; | ||
2662 | status = mos7840_set_reg_sync(serial->port[i], | 2599 | status = mos7840_set_reg_sync(serial->port[i], |
2663 | (__u16) (ZLP_REG1 + | 2600 | (__u16) (ZLP_REG1 + |
2664 | ((__u16) | 2601 | ((__u16)mos7840_port->port_num) - 0x1), Data); |
2665 | mos7840_port-> | ||
2666 | port_num) - | ||
2667 | 0x1), Data); | ||
2668 | dbg("ZLIP offset%x\n", | 2602 | dbg("ZLIP offset%x\n", |
2669 | (__u16) (ZLP_REG1 + | 2603 | (__u16) (ZLP_REG1 + |
2670 | ((__u16) mos7840_port->port_num) - 0x1)); | 2604 | ((__u16) mos7840_port->port_num) - 0x1)); |
@@ -2679,14 +2613,16 @@ static int mos7840_startup(struct usb_serial *serial) | |||
2679 | } | 2613 | } |
2680 | mos7840_port->control_urb = usb_alloc_urb(0, GFP_KERNEL); | 2614 | mos7840_port->control_urb = usb_alloc_urb(0, GFP_KERNEL); |
2681 | mos7840_port->ctrl_buf = kmalloc(16, GFP_KERNEL); | 2615 | mos7840_port->ctrl_buf = kmalloc(16, GFP_KERNEL); |
2682 | mos7840_port->dr = kmalloc(sizeof(struct usb_ctrlrequest), GFP_KERNEL); | 2616 | mos7840_port->dr = kmalloc(sizeof(struct usb_ctrlrequest), |
2683 | if (!mos7840_port->control_urb || !mos7840_port->ctrl_buf || !mos7840_port->dr) { | 2617 | GFP_KERNEL); |
2618 | if (!mos7840_port->control_urb || !mos7840_port->ctrl_buf || | ||
2619 | !mos7840_port->dr) { | ||
2684 | status = -ENOMEM; | 2620 | status = -ENOMEM; |
2685 | goto error; | 2621 | goto error; |
2686 | } | 2622 | } |
2687 | } | 2623 | } |
2688 | 2624 | ||
2689 | //Zero Length flag enable | 2625 | /* Zero Length flag enable */ |
2690 | Data = 0x0f; | 2626 | Data = 0x0f; |
2691 | status = mos7840_set_reg_sync(serial->port[0], ZLP_REG5, Data); | 2627 | status = mos7840_set_reg_sync(serial->port[0], ZLP_REG5, Data); |
2692 | if (status < 0) { | 2628 | if (status < 0) { |
@@ -2729,7 +2665,7 @@ static void mos7840_shutdown(struct usb_serial *serial) | |||
2729 | return; | 2665 | return; |
2730 | } | 2666 | } |
2731 | 2667 | ||
2732 | /* check for the ports to be closed,close the ports and disconnect */ | 2668 | /* check for the ports to be closed,close the ports and disconnect */ |
2733 | 2669 | ||
2734 | /* free private structure allocated for serial port * | 2670 | /* free private structure allocated for serial port * |
2735 | * stop reads and writes on all ports */ | 2671 | * stop reads and writes on all ports */ |
@@ -2810,20 +2746,12 @@ static int __init moschip7840_init(void) | |||
2810 | 2746 | ||
2811 | /* Register with the usb */ | 2747 | /* Register with the usb */ |
2812 | retval = usb_register(&io_driver); | 2748 | retval = usb_register(&io_driver); |
2813 | |||
2814 | if (retval) | ||
2815 | goto failed_usb_register; | ||
2816 | |||
2817 | if (retval == 0) { | 2749 | if (retval == 0) { |
2818 | dbg("%s\n", "Leaving..."); | 2750 | dbg("%s\n", "Leaving..."); |
2819 | return 0; | 2751 | return 0; |
2820 | } | 2752 | } |
2821 | |||
2822 | failed_usb_register: | ||
2823 | usb_serial_deregister(&moschip7840_4port_device); | 2753 | usb_serial_deregister(&moschip7840_4port_device); |
2824 | 2754 | failed_port_device_register: | |
2825 | failed_port_device_register: | ||
2826 | |||
2827 | return retval; | 2755 | return retval; |
2828 | } | 2756 | } |
2829 | 2757 | ||