13f542974SPaul B Schroeder /* 23f542974SPaul B Schroeder * This program is free software; you can redistribute it and/or modify 33f542974SPaul B Schroeder * it under the terms of the GNU General Public License as published by 43f542974SPaul B Schroeder * the Free Software Foundation; either version 2 of the License, or 53f542974SPaul B Schroeder * (at your option) any later version. 63f542974SPaul B Schroeder * 73f542974SPaul B Schroeder * This program is distributed in the hope that it will be useful, 83f542974SPaul B Schroeder * but WITHOUT ANY WARRANTY; without even the implied warranty of 93f542974SPaul B Schroeder * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 103f542974SPaul B Schroeder * GNU General Public License for more details. 113f542974SPaul B Schroeder * 123f542974SPaul B Schroeder * You should have received a copy of the GNU General Public License 133f542974SPaul B Schroeder * along with this program; if not, write to the Free Software 143f542974SPaul B Schroeder * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 153f542974SPaul B Schroeder * 163f542974SPaul B Schroeder * Clean ups from Moschip version and a few ioctl implementations by: 173f542974SPaul B Schroeder * Paul B Schroeder <pschroeder "at" uplogix "dot" com> 183f542974SPaul B Schroeder * 193f542974SPaul B Schroeder * Originally based on drivers/usb/serial/io_edgeport.c which is: 203f542974SPaul B Schroeder * Copyright (C) 2000 Inside Out Networks, All rights reserved. 213f542974SPaul B Schroeder * Copyright (C) 2001-2002 Greg Kroah-Hartman <greg@kroah.com> 223f542974SPaul B Schroeder * 233f542974SPaul B Schroeder */ 243f542974SPaul B Schroeder 253f542974SPaul B Schroeder #include <linux/kernel.h> 263f542974SPaul B Schroeder #include <linux/errno.h> 273f542974SPaul B Schroeder #include <linux/init.h> 283f542974SPaul B Schroeder #include <linux/slab.h> 29405f5571SAlexey Dobriyan #include <linux/smp_lock.h> 303f542974SPaul B Schroeder #include <linux/tty.h> 313f542974SPaul B Schroeder #include <linux/tty_driver.h> 323f542974SPaul B Schroeder #include <linux/tty_flip.h> 333f542974SPaul B Schroeder #include <linux/module.h> 343f542974SPaul B Schroeder #include <linux/serial.h> 353f542974SPaul B Schroeder #include <linux/usb.h> 363f542974SPaul B Schroeder #include <linux/usb/serial.h> 37880af9dbSAlan Cox #include <linux/uaccess.h> 383f542974SPaul B Schroeder 393f542974SPaul B Schroeder /* 403f542974SPaul B Schroeder * Version Information 413f542974SPaul B Schroeder */ 4237768adfSTony Cook #define DRIVER_VERSION "1.3.2" 433f542974SPaul B Schroeder #define DRIVER_DESC "Moschip 7840/7820 USB Serial Driver" 443f542974SPaul B Schroeder 453f542974SPaul B Schroeder /* 463f542974SPaul B Schroeder * 16C50 UART register defines 473f542974SPaul B Schroeder */ 483f542974SPaul B Schroeder 493f542974SPaul B Schroeder #define LCR_BITS_5 0x00 /* 5 bits/char */ 503f542974SPaul B Schroeder #define LCR_BITS_6 0x01 /* 6 bits/char */ 513f542974SPaul B Schroeder #define LCR_BITS_7 0x02 /* 7 bits/char */ 523f542974SPaul B Schroeder #define LCR_BITS_8 0x03 /* 8 bits/char */ 533f542974SPaul B Schroeder #define LCR_BITS_MASK 0x03 /* Mask for bits/char field */ 543f542974SPaul B Schroeder 553f542974SPaul B Schroeder #define LCR_STOP_1 0x00 /* 1 stop bit */ 563f542974SPaul B Schroeder #define LCR_STOP_1_5 0x04 /* 1.5 stop bits (if 5 bits/char) */ 573f542974SPaul B Schroeder #define LCR_STOP_2 0x04 /* 2 stop bits (if 6-8 bits/char) */ 583f542974SPaul B Schroeder #define LCR_STOP_MASK 0x04 /* Mask for stop bits field */ 593f542974SPaul B Schroeder 603f542974SPaul B Schroeder #define LCR_PAR_NONE 0x00 /* No parity */ 613f542974SPaul B Schroeder #define LCR_PAR_ODD 0x08 /* Odd parity */ 623f542974SPaul B Schroeder #define LCR_PAR_EVEN 0x18 /* Even parity */ 633f542974SPaul B Schroeder #define LCR_PAR_MARK 0x28 /* Force parity bit to 1 */ 643f542974SPaul B Schroeder #define LCR_PAR_SPACE 0x38 /* Force parity bit to 0 */ 653f542974SPaul B Schroeder #define LCR_PAR_MASK 0x38 /* Mask for parity field */ 663f542974SPaul B Schroeder 673f542974SPaul B Schroeder #define LCR_SET_BREAK 0x40 /* Set Break condition */ 683f542974SPaul B Schroeder #define LCR_DL_ENABLE 0x80 /* Enable access to divisor latch */ 693f542974SPaul B Schroeder 703f542974SPaul B Schroeder #define MCR_DTR 0x01 /* Assert DTR */ 713f542974SPaul B Schroeder #define MCR_RTS 0x02 /* Assert RTS */ 723f542974SPaul B Schroeder #define MCR_OUT1 0x04 /* Loopback only: Sets state of RI */ 733f542974SPaul B Schroeder #define MCR_MASTER_IE 0x08 /* Enable interrupt outputs */ 743f542974SPaul B Schroeder #define MCR_LOOPBACK 0x10 /* Set internal (digital) loopback mode */ 753f542974SPaul B Schroeder #define MCR_XON_ANY 0x20 /* Enable any char to exit XOFF mode */ 763f542974SPaul B Schroeder 773f542974SPaul B Schroeder #define MOS7840_MSR_CTS 0x10 /* Current state of CTS */ 783f542974SPaul B Schroeder #define MOS7840_MSR_DSR 0x20 /* Current state of DSR */ 793f542974SPaul B Schroeder #define MOS7840_MSR_RI 0x40 /* Current state of RI */ 803f542974SPaul B Schroeder #define MOS7840_MSR_CD 0x80 /* Current state of CD */ 813f542974SPaul B Schroeder 823f542974SPaul B Schroeder /* 833f542974SPaul B Schroeder * Defines used for sending commands to port 843f542974SPaul B Schroeder */ 853f542974SPaul B Schroeder 863f542974SPaul B Schroeder #define WAIT_FOR_EVER (HZ * 0) /* timeout urb is wait for ever */ 873f542974SPaul B Schroeder #define MOS_WDR_TIMEOUT (HZ * 5) /* default urb timeout */ 883f542974SPaul B Schroeder 893f542974SPaul B Schroeder #define MOS_PORT1 0x0200 903f542974SPaul B Schroeder #define MOS_PORT2 0x0300 913f542974SPaul B Schroeder #define MOS_VENREG 0x0000 923f542974SPaul B Schroeder #define MOS_MAX_PORT 0x02 933f542974SPaul B Schroeder #define MOS_WRITE 0x0E 943f542974SPaul B Schroeder #define MOS_READ 0x0D 953f542974SPaul B Schroeder 963f542974SPaul B Schroeder /* Requests */ 973f542974SPaul B Schroeder #define MCS_RD_RTYPE 0xC0 983f542974SPaul B Schroeder #define MCS_WR_RTYPE 0x40 993f542974SPaul B Schroeder #define MCS_RDREQ 0x0D 1003f542974SPaul B Schroeder #define MCS_WRREQ 0x0E 1013f542974SPaul B Schroeder #define MCS_CTRL_TIMEOUT 500 1023f542974SPaul B Schroeder #define VENDOR_READ_LENGTH (0x01) 1033f542974SPaul B Schroeder 1043f542974SPaul B Schroeder #define MAX_NAME_LEN 64 1053f542974SPaul B Schroeder 106880af9dbSAlan Cox #define ZLP_REG1 0x3A /* Zero_Flag_Reg1 58 */ 107880af9dbSAlan Cox #define ZLP_REG5 0x3E /* Zero_Flag_Reg5 62 */ 1083f542974SPaul B Schroeder 1093f542974SPaul B Schroeder /* For higher baud Rates use TIOCEXBAUD */ 1103f542974SPaul B Schroeder #define TIOCEXBAUD 0x5462 1113f542974SPaul B Schroeder 1123f542974SPaul B Schroeder /* vendor id and device id defines */ 1133f542974SPaul B Schroeder 11411e1abb4SDavid Ludlow /* The native mos7840/7820 component */ 1153f542974SPaul B Schroeder #define USB_VENDOR_ID_MOSCHIP 0x9710 1163f542974SPaul B Schroeder #define MOSCHIP_DEVICE_ID_7840 0x7840 1173f542974SPaul B Schroeder #define MOSCHIP_DEVICE_ID_7820 0x7820 11811e1abb4SDavid Ludlow /* The native component can have its vendor/device id's overridden 11911e1abb4SDavid Ludlow * in vendor-specific implementations. Such devices can be handled 12011e1abb4SDavid Ludlow * by making a change here, in moschip_port_id_table, and in 12111e1abb4SDavid Ludlow * moschip_id_table_combined 12211e1abb4SDavid Ludlow */ 12311e1abb4SDavid Ludlow #define USB_VENDOR_ID_BANDB 0x0856 12411e1abb4SDavid Ludlow #define BANDB_DEVICE_ID_USOPTL4_4 0xAC44 12511e1abb4SDavid Ludlow #define BANDB_DEVICE_ID_USOPTL4_2 0xAC42 1263f542974SPaul B Schroeder 127*9d498beaSRussell Lang /* This driver also supports 128*9d498beaSRussell Lang * ATEN UC2324 device using Moschip MCS7840 129*9d498beaSRussell Lang * ATEN UC2322 device using Moschip MCS7820 130*9d498beaSRussell Lang */ 131e9b8cffaSTony Cook #define USB_VENDOR_ID_ATENINTL 0x0557 132e9b8cffaSTony Cook #define ATENINTL_DEVICE_ID_UC2324 0x2011 133*9d498beaSRussell Lang #define ATENINTL_DEVICE_ID_UC2322 0x7820 134e9b8cffaSTony Cook 13511e1abb4SDavid Ludlow /* Interrupt Routine Defines */ 1363f542974SPaul B Schroeder 1373f542974SPaul B Schroeder #define SERIAL_IIR_RLS 0x06 1383f542974SPaul B Schroeder #define SERIAL_IIR_MS 0x00 1393f542974SPaul B Schroeder 1403f542974SPaul B Schroeder /* 1413f542974SPaul B Schroeder * Emulation of the bit mask on the LINE STATUS REGISTER. 1423f542974SPaul B Schroeder */ 1433f542974SPaul B Schroeder #define SERIAL_LSR_DR 0x0001 1443f542974SPaul B Schroeder #define SERIAL_LSR_OE 0x0002 1453f542974SPaul B Schroeder #define SERIAL_LSR_PE 0x0004 1463f542974SPaul B Schroeder #define SERIAL_LSR_FE 0x0008 1473f542974SPaul B Schroeder #define SERIAL_LSR_BI 0x0010 1483f542974SPaul B Schroeder 1493f542974SPaul B Schroeder #define MOS_MSR_DELTA_CTS 0x10 1503f542974SPaul B Schroeder #define MOS_MSR_DELTA_DSR 0x20 1513f542974SPaul B Schroeder #define MOS_MSR_DELTA_RI 0x40 1523f542974SPaul B Schroeder #define MOS_MSR_DELTA_CD 0x80 1533f542974SPaul B Schroeder 154880af9dbSAlan Cox /* Serial Port register Address */ 1553f542974SPaul B Schroeder #define INTERRUPT_ENABLE_REGISTER ((__u16)(0x01)) 1563f542974SPaul B Schroeder #define FIFO_CONTROL_REGISTER ((__u16)(0x02)) 1573f542974SPaul B Schroeder #define LINE_CONTROL_REGISTER ((__u16)(0x03)) 1583f542974SPaul B Schroeder #define MODEM_CONTROL_REGISTER ((__u16)(0x04)) 1593f542974SPaul B Schroeder #define LINE_STATUS_REGISTER ((__u16)(0x05)) 1603f542974SPaul B Schroeder #define MODEM_STATUS_REGISTER ((__u16)(0x06)) 1613f542974SPaul B Schroeder #define SCRATCH_PAD_REGISTER ((__u16)(0x07)) 1623f542974SPaul B Schroeder #define DIVISOR_LATCH_LSB ((__u16)(0x00)) 1633f542974SPaul B Schroeder #define DIVISOR_LATCH_MSB ((__u16)(0x01)) 1643f542974SPaul B Schroeder 1653f542974SPaul B Schroeder #define CLK_MULTI_REGISTER ((__u16)(0x02)) 1663f542974SPaul B Schroeder #define CLK_START_VALUE_REGISTER ((__u16)(0x03)) 1673f542974SPaul B Schroeder 1683f542974SPaul B Schroeder #define SERIAL_LCR_DLAB ((__u16)(0x0080)) 1693f542974SPaul B Schroeder 1703f542974SPaul B Schroeder /* 1713f542974SPaul B Schroeder * URB POOL related defines 1723f542974SPaul B Schroeder */ 1733f542974SPaul B Schroeder #define NUM_URBS 16 /* URB Count */ 1743f542974SPaul B Schroeder #define URB_TRANSFER_BUFFER_SIZE 32 /* URB Size */ 1753f542974SPaul B Schroeder 1763f542974SPaul B Schroeder 1773f542974SPaul B Schroeder static struct usb_device_id moschip_port_id_table[] = { 1783f542974SPaul B Schroeder {USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)}, 1793f542974SPaul B Schroeder {USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)}, 18011e1abb4SDavid Ludlow {USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4)}, 18111e1abb4SDavid Ludlow {USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2)}, 182e9b8cffaSTony Cook {USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2324)}, 183*9d498beaSRussell Lang {USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2322)}, 1843f542974SPaul B Schroeder {} /* terminating entry */ 1853f542974SPaul B Schroeder }; 1863f542974SPaul B Schroeder 1873f542974SPaul B Schroeder static __devinitdata struct usb_device_id moschip_id_table_combined[] = { 1883f542974SPaul B Schroeder {USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)}, 1893f542974SPaul B Schroeder {USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)}, 19011e1abb4SDavid Ludlow {USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4)}, 19111e1abb4SDavid Ludlow {USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2)}, 192e9b8cffaSTony Cook {USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2324)}, 193*9d498beaSRussell Lang {USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2322)}, 1943f542974SPaul B Schroeder {} /* terminating entry */ 1953f542974SPaul B Schroeder }; 1963f542974SPaul B Schroeder 1973f542974SPaul B Schroeder MODULE_DEVICE_TABLE(usb, moschip_id_table_combined); 1983f542974SPaul B Schroeder 1993f542974SPaul B Schroeder /* This structure holds all of the local port information */ 2003f542974SPaul B Schroeder 2013f542974SPaul B Schroeder struct moschip_port { 2023f542974SPaul B Schroeder int port_num; /*Actual port number in the device(1,2,etc) */ 2033f542974SPaul B Schroeder struct urb *write_urb; /* write URB for this port */ 2043f542974SPaul B Schroeder struct urb *read_urb; /* read URB for this port */ 2050de9a702SOliver Neukum struct urb *int_urb; 2063f542974SPaul B Schroeder __u8 shadowLCR; /* last LCR value received */ 2073f542974SPaul B Schroeder __u8 shadowMCR; /* last MCR value received */ 2083f542974SPaul B Schroeder char open; 2090de9a702SOliver Neukum char open_ports; 2100de9a702SOliver Neukum char zombie; 2113f542974SPaul B Schroeder wait_queue_head_t wait_chase; /* for handling sleeping while waiting for chase to finish */ 2123f542974SPaul B Schroeder wait_queue_head_t delta_msr_wait; /* for handling sleeping while waiting for msr change to happen */ 2133f542974SPaul B Schroeder int delta_msr_cond; 2143f542974SPaul B Schroeder struct async_icount icount; 2153f542974SPaul B Schroeder struct usb_serial_port *port; /* loop back to the owner of this object */ 2163f542974SPaul B Schroeder 2173f542974SPaul B Schroeder /* Offsets */ 2183f542974SPaul B Schroeder __u8 SpRegOffset; 2193f542974SPaul B Schroeder __u8 ControlRegOffset; 2203f542974SPaul B Schroeder __u8 DcrRegOffset; 221880af9dbSAlan Cox /* for processing control URBS in interrupt context */ 2223f542974SPaul B Schroeder struct urb *control_urb; 2230de9a702SOliver Neukum struct usb_ctrlrequest *dr; 2243f542974SPaul B Schroeder char *ctrl_buf; 2253f542974SPaul B Schroeder int MsrLsr; 2263f542974SPaul B Schroeder 2270de9a702SOliver Neukum spinlock_t pool_lock; 2283f542974SPaul B Schroeder struct urb *write_urb_pool[NUM_URBS]; 2290de9a702SOliver Neukum char busy[NUM_URBS]; 23050de36f7SGreg Kroah-Hartman bool read_urb_busy; 2313f542974SPaul B Schroeder }; 2323f542974SPaul B Schroeder 2333f542974SPaul B Schroeder 2343f542974SPaul B Schroeder static int debug; 2353f542974SPaul B Schroeder 2363f542974SPaul B Schroeder /* 2373f542974SPaul B Schroeder * mos7840_set_reg_sync 2383f542974SPaul B Schroeder * To set the Control register by calling usb_fill_control_urb function 2393f542974SPaul B Schroeder * by passing usb_sndctrlpipe function as parameter. 2403f542974SPaul B Schroeder */ 2413f542974SPaul B Schroeder 2423f542974SPaul B Schroeder static int mos7840_set_reg_sync(struct usb_serial_port *port, __u16 reg, 2433f542974SPaul B Schroeder __u16 val) 2443f542974SPaul B Schroeder { 2453f542974SPaul B Schroeder struct usb_device *dev = port->serial->dev; 2463f542974SPaul B Schroeder val = val & 0x00ff; 24784fe6e79STony Cook dbg("mos7840_set_reg_sync offset is %x, value %x", reg, val); 2483f542974SPaul B Schroeder 2493f542974SPaul B Schroeder return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ, 2503f542974SPaul B Schroeder MCS_WR_RTYPE, val, reg, NULL, 0, 2513f542974SPaul B Schroeder MOS_WDR_TIMEOUT); 2523f542974SPaul B Schroeder } 2533f542974SPaul B Schroeder 2543f542974SPaul B Schroeder /* 2553f542974SPaul B Schroeder * mos7840_get_reg_sync 2563f542974SPaul B Schroeder * To set the Uart register by calling usb_fill_control_urb function by 2573f542974SPaul B Schroeder * passing usb_rcvctrlpipe function as parameter. 2583f542974SPaul B Schroeder */ 2593f542974SPaul B Schroeder 2603f542974SPaul B Schroeder static int mos7840_get_reg_sync(struct usb_serial_port *port, __u16 reg, 2613f542974SPaul B Schroeder __u16 *val) 2623f542974SPaul B Schroeder { 2633f542974SPaul B Schroeder struct usb_device *dev = port->serial->dev; 2643f542974SPaul B Schroeder int ret = 0; 2653f542974SPaul B Schroeder 2663f542974SPaul B Schroeder ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ, 2673f542974SPaul B Schroeder MCS_RD_RTYPE, 0, reg, val, VENDOR_READ_LENGTH, 2683f542974SPaul B Schroeder MOS_WDR_TIMEOUT); 26984fe6e79STony Cook dbg("mos7840_get_reg_sync offset is %x, return val %x", reg, *val); 2703f542974SPaul B Schroeder *val = (*val) & 0x00ff; 2713f542974SPaul B Schroeder return ret; 2723f542974SPaul B Schroeder } 2733f542974SPaul B Schroeder 2743f542974SPaul B Schroeder /* 2753f542974SPaul B Schroeder * mos7840_set_uart_reg 2763f542974SPaul B Schroeder * To set the Uart register by calling usb_fill_control_urb function by 2773f542974SPaul B Schroeder * passing usb_sndctrlpipe function as parameter. 2783f542974SPaul B Schroeder */ 2793f542974SPaul B Schroeder 2803f542974SPaul B Schroeder static int mos7840_set_uart_reg(struct usb_serial_port *port, __u16 reg, 2813f542974SPaul B Schroeder __u16 val) 2823f542974SPaul B Schroeder { 2833f542974SPaul B Schroeder 2843f542974SPaul B Schroeder struct usb_device *dev = port->serial->dev; 2853f542974SPaul B Schroeder val = val & 0x00ff; 286880af9dbSAlan Cox /* For the UART control registers, the application number need 287880af9dbSAlan Cox to be Or'ed */ 2880de9a702SOliver Neukum if (port->serial->num_ports == 4) { 289880af9dbSAlan Cox val |= (((__u16) port->number - 290880af9dbSAlan Cox (__u16) (port->serial->minor)) + 1) << 8; 29184fe6e79STony Cook dbg("mos7840_set_uart_reg application number is %x", val); 2923f542974SPaul B Schroeder } else { 2933f542974SPaul B Schroeder if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) { 294880af9dbSAlan Cox val |= (((__u16) port->number - 2953f542974SPaul B Schroeder (__u16) (port->serial->minor)) + 1) << 8; 29684fe6e79STony Cook dbg("mos7840_set_uart_reg application number is %x", 2973f542974SPaul B Schroeder val); 2983f542974SPaul B Schroeder } else { 2993f542974SPaul B Schroeder val |= 3003f542974SPaul B Schroeder (((__u16) port->number - 3013f542974SPaul B Schroeder (__u16) (port->serial->minor)) + 2) << 8; 30284fe6e79STony Cook dbg("mos7840_set_uart_reg application number is %x", 3033f542974SPaul B Schroeder val); 3043f542974SPaul B Schroeder } 3053f542974SPaul B Schroeder } 3063f542974SPaul B Schroeder return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ, 3073f542974SPaul B Schroeder MCS_WR_RTYPE, val, reg, NULL, 0, 3083f542974SPaul B Schroeder MOS_WDR_TIMEOUT); 3093f542974SPaul B Schroeder 3103f542974SPaul B Schroeder } 3113f542974SPaul B Schroeder 3123f542974SPaul B Schroeder /* 3133f542974SPaul B Schroeder * mos7840_get_uart_reg 3143f542974SPaul B Schroeder * To set the Control register by calling usb_fill_control_urb function 3153f542974SPaul B Schroeder * by passing usb_rcvctrlpipe function as parameter. 3163f542974SPaul B Schroeder */ 3173f542974SPaul B Schroeder static int mos7840_get_uart_reg(struct usb_serial_port *port, __u16 reg, 3183f542974SPaul B Schroeder __u16 *val) 3193f542974SPaul B Schroeder { 3203f542974SPaul B Schroeder struct usb_device *dev = port->serial->dev; 3213f542974SPaul B Schroeder int ret = 0; 3223f542974SPaul B Schroeder __u16 Wval; 3233f542974SPaul B Schroeder 32484fe6e79STony Cook /* dbg("application number is %4x", 325880af9dbSAlan Cox (((__u16)port->number - (__u16)(port->serial->minor))+1)<<8); */ 3263f542974SPaul B Schroeder /* Wval is same as application number */ 3270de9a702SOliver Neukum if (port->serial->num_ports == 4) { 3283f542974SPaul B Schroeder Wval = 3293f542974SPaul B Schroeder (((__u16) port->number - (__u16) (port->serial->minor)) + 3303f542974SPaul B Schroeder 1) << 8; 33184fe6e79STony Cook dbg("mos7840_get_uart_reg application number is %x", Wval); 3323f542974SPaul B Schroeder } else { 3333f542974SPaul B Schroeder if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) { 334880af9dbSAlan Cox Wval = (((__u16) port->number - 3353f542974SPaul B Schroeder (__u16) (port->serial->minor)) + 1) << 8; 33684fe6e79STony Cook dbg("mos7840_get_uart_reg application number is %x", 3373f542974SPaul B Schroeder Wval); 3383f542974SPaul B Schroeder } else { 339880af9dbSAlan Cox Wval = (((__u16) port->number - 3403f542974SPaul B Schroeder (__u16) (port->serial->minor)) + 2) << 8; 34184fe6e79STony Cook dbg("mos7840_get_uart_reg application number is %x", 3423f542974SPaul B Schroeder Wval); 3433f542974SPaul B Schroeder } 3443f542974SPaul B Schroeder } 3453f542974SPaul B Schroeder ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ, 3463f542974SPaul B Schroeder MCS_RD_RTYPE, Wval, reg, val, VENDOR_READ_LENGTH, 3473f542974SPaul B Schroeder MOS_WDR_TIMEOUT); 3483f542974SPaul B Schroeder *val = (*val) & 0x00ff; 3493f542974SPaul B Schroeder return ret; 3503f542974SPaul B Schroeder } 3513f542974SPaul B Schroeder 3523f542974SPaul B Schroeder static void mos7840_dump_serial_port(struct moschip_port *mos7840_port) 3533f542974SPaul B Schroeder { 3543f542974SPaul B Schroeder 35584fe6e79STony Cook dbg("***************************************"); 35684fe6e79STony Cook dbg("SpRegOffset is %2x", mos7840_port->SpRegOffset); 35784fe6e79STony Cook dbg("ControlRegOffset is %2x", mos7840_port->ControlRegOffset); 35884fe6e79STony Cook dbg("DCRRegOffset is %2x", mos7840_port->DcrRegOffset); 35984fe6e79STony Cook dbg("***************************************"); 3603f542974SPaul B Schroeder 3613f542974SPaul B Schroeder } 3623f542974SPaul B Schroeder 3633f542974SPaul B Schroeder /************************************************************************/ 3643f542974SPaul B Schroeder /************************************************************************/ 3653f542974SPaul B Schroeder /* I N T E R F A C E F U N C T I O N S */ 3663f542974SPaul B Schroeder /* I N T E R F A C E F U N C T I O N S */ 3673f542974SPaul B Schroeder /************************************************************************/ 3683f542974SPaul B Schroeder /************************************************************************/ 3693f542974SPaul B Schroeder 3703f542974SPaul B Schroeder static inline void mos7840_set_port_private(struct usb_serial_port *port, 3713f542974SPaul B Schroeder struct moschip_port *data) 3723f542974SPaul B Schroeder { 3733f542974SPaul B Schroeder usb_set_serial_port_data(port, (void *)data); 3743f542974SPaul B Schroeder } 3753f542974SPaul B Schroeder 3763f542974SPaul B Schroeder static inline struct moschip_port *mos7840_get_port_private(struct 3773f542974SPaul B Schroeder usb_serial_port 3783f542974SPaul B Schroeder *port) 3793f542974SPaul B Schroeder { 3803f542974SPaul B Schroeder return (struct moschip_port *)usb_get_serial_port_data(port); 3813f542974SPaul B Schroeder } 3823f542974SPaul B Schroeder 3830de9a702SOliver Neukum static void mos7840_handle_new_msr(struct moschip_port *port, __u8 new_msr) 3843f542974SPaul B Schroeder { 3853f542974SPaul B Schroeder struct moschip_port *mos7840_port; 3863f542974SPaul B Schroeder struct async_icount *icount; 3873f542974SPaul B Schroeder mos7840_port = port; 3883f542974SPaul B Schroeder icount = &mos7840_port->icount; 3893f542974SPaul B Schroeder if (new_msr & 3903f542974SPaul B Schroeder (MOS_MSR_DELTA_CTS | MOS_MSR_DELTA_DSR | MOS_MSR_DELTA_RI | 3913f542974SPaul B Schroeder MOS_MSR_DELTA_CD)) { 3923f542974SPaul B Schroeder icount = &mos7840_port->icount; 3933f542974SPaul B Schroeder 3943f542974SPaul B Schroeder /* update input line counters */ 3953f542974SPaul B Schroeder if (new_msr & MOS_MSR_DELTA_CTS) { 3963f542974SPaul B Schroeder icount->cts++; 3970de9a702SOliver Neukum smp_wmb(); 3983f542974SPaul B Schroeder } 3993f542974SPaul B Schroeder if (new_msr & MOS_MSR_DELTA_DSR) { 4003f542974SPaul B Schroeder icount->dsr++; 4010de9a702SOliver Neukum smp_wmb(); 4023f542974SPaul B Schroeder } 4033f542974SPaul B Schroeder if (new_msr & MOS_MSR_DELTA_CD) { 4043f542974SPaul B Schroeder icount->dcd++; 4050de9a702SOliver Neukum smp_wmb(); 4063f542974SPaul B Schroeder } 4073f542974SPaul B Schroeder if (new_msr & MOS_MSR_DELTA_RI) { 4083f542974SPaul B Schroeder icount->rng++; 4090de9a702SOliver Neukum smp_wmb(); 4100de9a702SOliver Neukum } 4113f542974SPaul B Schroeder } 4123f542974SPaul B Schroeder } 4133f542974SPaul B Schroeder 4140de9a702SOliver Neukum static void mos7840_handle_new_lsr(struct moschip_port *port, __u8 new_lsr) 4153f542974SPaul B Schroeder { 4163f542974SPaul B Schroeder struct async_icount *icount; 4173f542974SPaul B Schroeder 418441b62c1SHarvey Harrison dbg("%s - %02x", __func__, new_lsr); 4193f542974SPaul B Schroeder 4203f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_BI) { 421880af9dbSAlan Cox /* 422880af9dbSAlan Cox * Parity and Framing errors only count if they 423880af9dbSAlan Cox * occur exclusive of a break being 424880af9dbSAlan Cox * received. 425880af9dbSAlan Cox */ 4263f542974SPaul B Schroeder new_lsr &= (__u8) (SERIAL_LSR_OE | SERIAL_LSR_BI); 4273f542974SPaul B Schroeder } 4283f542974SPaul B Schroeder 4293f542974SPaul B Schroeder /* update input line counters */ 4303f542974SPaul B Schroeder icount = &port->icount; 4313f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_BI) { 4323f542974SPaul B Schroeder icount->brk++; 4330de9a702SOliver Neukum smp_wmb(); 4343f542974SPaul B Schroeder } 4353f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_OE) { 4363f542974SPaul B Schroeder icount->overrun++; 4370de9a702SOliver Neukum smp_wmb(); 4383f542974SPaul B Schroeder } 4393f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_PE) { 4403f542974SPaul B Schroeder icount->parity++; 4410de9a702SOliver Neukum smp_wmb(); 4423f542974SPaul B Schroeder } 4433f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_FE) { 4443f542974SPaul B Schroeder icount->frame++; 4450de9a702SOliver Neukum smp_wmb(); 4463f542974SPaul B Schroeder } 4473f542974SPaul B Schroeder } 4483f542974SPaul B Schroeder 4493f542974SPaul B Schroeder /************************************************************************/ 4503f542974SPaul B Schroeder /************************************************************************/ 4513f542974SPaul B Schroeder /* U S B C A L L B A C K F U N C T I O N S */ 4523f542974SPaul B Schroeder /* U S B C A L L B A C K F U N C T I O N S */ 4533f542974SPaul B Schroeder /************************************************************************/ 4543f542974SPaul B Schroeder /************************************************************************/ 4553f542974SPaul B Schroeder 4567d12e780SDavid Howells static void mos7840_control_callback(struct urb *urb) 4573f542974SPaul B Schroeder { 4583f542974SPaul B Schroeder unsigned char *data; 4593f542974SPaul B Schroeder struct moschip_port *mos7840_port; 4603f542974SPaul B Schroeder __u8 regval = 0x0; 4610de9a702SOliver Neukum int result = 0; 4620643c724SGreg Kroah-Hartman int status = urb->status; 4633f542974SPaul B Schroeder 464cdc97792SMing Lei mos7840_port = urb->context; 4650de9a702SOliver Neukum 4660643c724SGreg Kroah-Hartman switch (status) { 4673f542974SPaul B Schroeder case 0: 4683f542974SPaul B Schroeder /* success */ 4693f542974SPaul B Schroeder break; 4703f542974SPaul B Schroeder case -ECONNRESET: 4713f542974SPaul B Schroeder case -ENOENT: 4723f542974SPaul B Schroeder case -ESHUTDOWN: 4733f542974SPaul B Schroeder /* this urb is terminated, clean up */ 474441b62c1SHarvey Harrison dbg("%s - urb shutting down with status: %d", __func__, 4750643c724SGreg Kroah-Hartman status); 4763f542974SPaul B Schroeder return; 4773f542974SPaul B Schroeder default: 478441b62c1SHarvey Harrison dbg("%s - nonzero urb status received: %d", __func__, 4790643c724SGreg Kroah-Hartman status); 4803f542974SPaul B Schroeder goto exit; 4813f542974SPaul B Schroeder } 4823f542974SPaul B Schroeder 48384fe6e79STony Cook dbg("%s urb buffer size is %d", __func__, urb->actual_length); 48484fe6e79STony Cook dbg("%s mos7840_port->MsrLsr is %d port %d", __func__, 4853f542974SPaul B Schroeder mos7840_port->MsrLsr, mos7840_port->port_num); 4863f542974SPaul B Schroeder data = urb->transfer_buffer; 4873f542974SPaul B Schroeder regval = (__u8) data[0]; 48884fe6e79STony Cook dbg("%s data is %x", __func__, regval); 4893f542974SPaul B Schroeder if (mos7840_port->MsrLsr == 0) 4903f542974SPaul B Schroeder mos7840_handle_new_msr(mos7840_port, regval); 4913f542974SPaul B Schroeder else if (mos7840_port->MsrLsr == 1) 4923f542974SPaul B Schroeder mos7840_handle_new_lsr(mos7840_port, regval); 4933f542974SPaul B Schroeder 4943f542974SPaul B Schroeder exit: 4950de9a702SOliver Neukum spin_lock(&mos7840_port->pool_lock); 4960de9a702SOliver Neukum if (!mos7840_port->zombie) 4970de9a702SOliver Neukum result = usb_submit_urb(mos7840_port->int_urb, GFP_ATOMIC); 4980de9a702SOliver Neukum spin_unlock(&mos7840_port->pool_lock); 4990de9a702SOliver Neukum if (result) { 5000de9a702SOliver Neukum dev_err(&urb->dev->dev, 5010de9a702SOliver Neukum "%s - Error %d submitting interrupt urb\n", 502441b62c1SHarvey Harrison __func__, result); 5030de9a702SOliver Neukum } 5043f542974SPaul B Schroeder } 5053f542974SPaul B Schroeder 5063f542974SPaul B Schroeder static int mos7840_get_reg(struct moschip_port *mcs, __u16 Wval, __u16 reg, 5073f542974SPaul B Schroeder __u16 *val) 5083f542974SPaul B Schroeder { 5093f542974SPaul B Schroeder struct usb_device *dev = mcs->port->serial->dev; 5100de9a702SOliver Neukum struct usb_ctrlrequest *dr = mcs->dr; 5110de9a702SOliver Neukum unsigned char *buffer = mcs->ctrl_buf; 5120de9a702SOliver Neukum int ret; 5133f542974SPaul B Schroeder 5143f542974SPaul B Schroeder dr->bRequestType = MCS_RD_RTYPE; 5153f542974SPaul B Schroeder dr->bRequest = MCS_RDREQ; 516880af9dbSAlan Cox dr->wValue = cpu_to_le16(Wval); /* 0 */ 5173f542974SPaul B Schroeder dr->wIndex = cpu_to_le16(reg); 5183f542974SPaul B Schroeder dr->wLength = cpu_to_le16(2); 5193f542974SPaul B Schroeder 5203f542974SPaul B Schroeder usb_fill_control_urb(mcs->control_urb, dev, usb_rcvctrlpipe(dev, 0), 5213f542974SPaul B Schroeder (unsigned char *)dr, buffer, 2, 5223f542974SPaul B Schroeder mos7840_control_callback, mcs); 5233f542974SPaul B Schroeder mcs->control_urb->transfer_buffer_length = 2; 5243f542974SPaul B Schroeder ret = usb_submit_urb(mcs->control_urb, GFP_ATOMIC); 5253f542974SPaul B Schroeder return ret; 5263f542974SPaul B Schroeder } 5273f542974SPaul B Schroeder 5283f542974SPaul B Schroeder /***************************************************************************** 5293f542974SPaul B Schroeder * mos7840_interrupt_callback 5303f542974SPaul B Schroeder * this is the callback function for when we have received data on the 5313f542974SPaul B Schroeder * interrupt endpoint. 5323f542974SPaul B Schroeder *****************************************************************************/ 5333f542974SPaul B Schroeder 5347d12e780SDavid Howells static void mos7840_interrupt_callback(struct urb *urb) 5353f542974SPaul B Schroeder { 5363f542974SPaul B Schroeder int result; 5373f542974SPaul B Schroeder int length; 5383f542974SPaul B Schroeder struct moschip_port *mos7840_port; 5393f542974SPaul B Schroeder struct usb_serial *serial; 5403f542974SPaul B Schroeder __u16 Data; 5413f542974SPaul B Schroeder unsigned char *data; 5423f542974SPaul B Schroeder __u8 sp[5], st; 5430de9a702SOliver Neukum int i, rv = 0; 5440de9a702SOliver Neukum __u16 wval, wreg = 0; 5450643c724SGreg Kroah-Hartman int status = urb->status; 5463f542974SPaul B Schroeder 54784fe6e79STony Cook dbg("%s", " : Entering"); 5483f542974SPaul B Schroeder 5490643c724SGreg Kroah-Hartman switch (status) { 5503f542974SPaul B Schroeder case 0: 5513f542974SPaul B Schroeder /* success */ 5523f542974SPaul B Schroeder break; 5533f542974SPaul B Schroeder case -ECONNRESET: 5543f542974SPaul B Schroeder case -ENOENT: 5553f542974SPaul B Schroeder case -ESHUTDOWN: 5563f542974SPaul B Schroeder /* this urb is terminated, clean up */ 557441b62c1SHarvey Harrison dbg("%s - urb shutting down with status: %d", __func__, 5580643c724SGreg Kroah-Hartman status); 5593f542974SPaul B Schroeder return; 5603f542974SPaul B Schroeder default: 561441b62c1SHarvey Harrison dbg("%s - nonzero urb status received: %d", __func__, 5620643c724SGreg Kroah-Hartman status); 5633f542974SPaul B Schroeder goto exit; 5643f542974SPaul B Schroeder } 5653f542974SPaul B Schroeder 5663f542974SPaul B Schroeder length = urb->actual_length; 5673f542974SPaul B Schroeder data = urb->transfer_buffer; 5683f542974SPaul B Schroeder 569cdc97792SMing Lei serial = urb->context; 5703f542974SPaul B Schroeder 5713f542974SPaul B Schroeder /* Moschip get 5 bytes 5723f542974SPaul B Schroeder * Byte 1 IIR Port 1 (port.number is 0) 5733f542974SPaul B Schroeder * Byte 2 IIR Port 2 (port.number is 1) 5743f542974SPaul B Schroeder * Byte 3 IIR Port 3 (port.number is 2) 5753f542974SPaul B Schroeder * Byte 4 IIR Port 4 (port.number is 3) 5763f542974SPaul B Schroeder * Byte 5 FIFO status for both */ 5773f542974SPaul B Schroeder 5783f542974SPaul B Schroeder if (length && length > 5) { 57984fe6e79STony Cook dbg("%s", "Wrong data !!!"); 5803f542974SPaul B Schroeder return; 5813f542974SPaul B Schroeder } 5823f542974SPaul B Schroeder 5833f542974SPaul B Schroeder sp[0] = (__u8) data[0]; 5843f542974SPaul B Schroeder sp[1] = (__u8) data[1]; 5853f542974SPaul B Schroeder sp[2] = (__u8) data[2]; 5863f542974SPaul B Schroeder sp[3] = (__u8) data[3]; 5873f542974SPaul B Schroeder st = (__u8) data[4]; 5883f542974SPaul B Schroeder 5893f542974SPaul B Schroeder for (i = 0; i < serial->num_ports; i++) { 5903f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(serial->port[i]); 5913f542974SPaul B Schroeder wval = 5923f542974SPaul B Schroeder (((__u16) serial->port[i]->number - 5933f542974SPaul B Schroeder (__u16) (serial->minor)) + 1) << 8; 5943f542974SPaul B Schroeder if (mos7840_port->open) { 5953f542974SPaul B Schroeder if (sp[i] & 0x01) { 59684fe6e79STony Cook dbg("SP%d No Interrupt !!!", i); 5973f542974SPaul B Schroeder } else { 5983f542974SPaul B Schroeder switch (sp[i] & 0x0f) { 5993f542974SPaul B Schroeder case SERIAL_IIR_RLS: 6003f542974SPaul B Schroeder dbg("Serial Port %d: Receiver status error or ", i); 60184fe6e79STony Cook dbg("address bit detected in 9-bit mode"); 6023f542974SPaul B Schroeder mos7840_port->MsrLsr = 1; 6030de9a702SOliver Neukum wreg = LINE_STATUS_REGISTER; 6043f542974SPaul B Schroeder break; 6053f542974SPaul B Schroeder case SERIAL_IIR_MS: 60684fe6e79STony Cook dbg("Serial Port %d: Modem status change", i); 6073f542974SPaul B Schroeder mos7840_port->MsrLsr = 0; 6080de9a702SOliver Neukum wreg = MODEM_STATUS_REGISTER; 6093f542974SPaul B Schroeder break; 6103f542974SPaul B Schroeder } 6110de9a702SOliver Neukum spin_lock(&mos7840_port->pool_lock); 6120de9a702SOliver Neukum if (!mos7840_port->zombie) { 6130de9a702SOliver Neukum rv = mos7840_get_reg(mos7840_port, wval, wreg, &Data); 6140de9a702SOliver Neukum } else { 6150de9a702SOliver Neukum spin_unlock(&mos7840_port->pool_lock); 6160de9a702SOliver Neukum return; 6170de9a702SOliver Neukum } 6180de9a702SOliver Neukum spin_unlock(&mos7840_port->pool_lock); 6193f542974SPaul B Schroeder } 6203f542974SPaul B Schroeder } 6213f542974SPaul B Schroeder } 622880af9dbSAlan Cox if (!(rv < 0)) 623880af9dbSAlan Cox /* the completion handler for the control urb will resubmit */ 6240de9a702SOliver Neukum return; 6253f542974SPaul B Schroeder exit: 6263f542974SPaul B Schroeder result = usb_submit_urb(urb, GFP_ATOMIC); 6273f542974SPaul B Schroeder if (result) { 6283f542974SPaul B Schroeder dev_err(&urb->dev->dev, 6293f542974SPaul B Schroeder "%s - Error %d submitting interrupt urb\n", 630441b62c1SHarvey Harrison __func__, result); 6313f542974SPaul B Schroeder } 6323f542974SPaul B Schroeder } 6333f542974SPaul B Schroeder 6343f542974SPaul B Schroeder static int mos7840_port_paranoia_check(struct usb_serial_port *port, 6353f542974SPaul B Schroeder const char *function) 6363f542974SPaul B Schroeder { 6373f542974SPaul B Schroeder if (!port) { 6383f542974SPaul B Schroeder dbg("%s - port == NULL", function); 6393f542974SPaul B Schroeder return -1; 6403f542974SPaul B Schroeder } 6413f542974SPaul B Schroeder if (!port->serial) { 6423f542974SPaul B Schroeder dbg("%s - port->serial == NULL", function); 6433f542974SPaul B Schroeder return -1; 6443f542974SPaul B Schroeder } 6453f542974SPaul B Schroeder 6463f542974SPaul B Schroeder return 0; 6473f542974SPaul B Schroeder } 6483f542974SPaul B Schroeder 6493f542974SPaul B Schroeder /* Inline functions to check the sanity of a pointer that is passed to us */ 6503f542974SPaul B Schroeder static int mos7840_serial_paranoia_check(struct usb_serial *serial, 6513f542974SPaul B Schroeder const char *function) 6523f542974SPaul B Schroeder { 6533f542974SPaul B Schroeder if (!serial) { 6543f542974SPaul B Schroeder dbg("%s - serial == NULL", function); 6553f542974SPaul B Schroeder return -1; 6563f542974SPaul B Schroeder } 6573f542974SPaul B Schroeder if (!serial->type) { 6583f542974SPaul B Schroeder dbg("%s - serial->type == NULL!", function); 6593f542974SPaul B Schroeder return -1; 6603f542974SPaul B Schroeder } 6613f542974SPaul B Schroeder 6623f542974SPaul B Schroeder return 0; 6633f542974SPaul B Schroeder } 6643f542974SPaul B Schroeder 6653f542974SPaul B Schroeder static struct usb_serial *mos7840_get_usb_serial(struct usb_serial_port *port, 6663f542974SPaul B Schroeder const char *function) 6673f542974SPaul B Schroeder { 6683f542974SPaul B Schroeder /* if no port was specified, or it fails a paranoia check */ 6693f542974SPaul B Schroeder if (!port || 6703f542974SPaul B Schroeder mos7840_port_paranoia_check(port, function) || 6713f542974SPaul B Schroeder mos7840_serial_paranoia_check(port->serial, function)) { 672880af9dbSAlan Cox /* then say that we don't have a valid usb_serial thing, 673880af9dbSAlan Cox * which will end up genrating -ENODEV return values */ 6743f542974SPaul B Schroeder return NULL; 6753f542974SPaul B Schroeder } 6763f542974SPaul B Schroeder 6773f542974SPaul B Schroeder return port->serial; 6783f542974SPaul B Schroeder } 6793f542974SPaul B Schroeder 6803f542974SPaul B Schroeder /***************************************************************************** 6813f542974SPaul B Schroeder * mos7840_bulk_in_callback 6823f542974SPaul B Schroeder * this is the callback function for when we have received data on the 6833f542974SPaul B Schroeder * bulk in endpoint. 6843f542974SPaul B Schroeder *****************************************************************************/ 6853f542974SPaul B Schroeder 6867d12e780SDavid Howells static void mos7840_bulk_in_callback(struct urb *urb) 6873f542974SPaul B Schroeder { 6880643c724SGreg Kroah-Hartman int retval; 6893f542974SPaul B Schroeder unsigned char *data; 6903f542974SPaul B Schroeder struct usb_serial *serial; 6913f542974SPaul B Schroeder struct usb_serial_port *port; 6923f542974SPaul B Schroeder struct moschip_port *mos7840_port; 6933f542974SPaul B Schroeder struct tty_struct *tty; 6940643c724SGreg Kroah-Hartman int status = urb->status; 6953f542974SPaul B Schroeder 696cdc97792SMing Lei mos7840_port = urb->context; 6973f542974SPaul B Schroeder if (!mos7840_port) { 69884fe6e79STony Cook dbg("%s", "NULL mos7840_port pointer"); 69950de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 70050de36f7SGreg Kroah-Hartman return; 70150de36f7SGreg Kroah-Hartman } 70250de36f7SGreg Kroah-Hartman 70350de36f7SGreg Kroah-Hartman if (status) { 70450de36f7SGreg Kroah-Hartman dbg("nonzero read bulk status received: %d", status); 70550de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 7063f542974SPaul B Schroeder return; 7073f542974SPaul B Schroeder } 7083f542974SPaul B Schroeder 7093f542974SPaul B Schroeder port = (struct usb_serial_port *)mos7840_port->port; 710441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 71184fe6e79STony Cook dbg("%s", "Port Paranoia failed"); 71250de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 7133f542974SPaul B Schroeder return; 7143f542974SPaul B Schroeder } 7153f542974SPaul B Schroeder 716441b62c1SHarvey Harrison serial = mos7840_get_usb_serial(port, __func__); 7173f542974SPaul B Schroeder if (!serial) { 71884fe6e79STony Cook dbg("%s", "Bad serial pointer"); 71950de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 7203f542974SPaul B Schroeder return; 7213f542974SPaul B Schroeder } 7223f542974SPaul B Schroeder 72384fe6e79STony Cook dbg("%s", "Entering... "); 7243f542974SPaul B Schroeder 7253f542974SPaul B Schroeder data = urb->transfer_buffer; 7263f542974SPaul B Schroeder 72784fe6e79STony Cook dbg("%s", "Entering ..........."); 7283f542974SPaul B Schroeder 7293f542974SPaul B Schroeder if (urb->actual_length) { 7304a90f09bSAlan Cox tty = tty_port_tty_get(&mos7840_port->port->port); 7313f542974SPaul B Schroeder if (tty) { 7323f542974SPaul B Schroeder tty_buffer_request_room(tty, urb->actual_length); 7333f542974SPaul B Schroeder tty_insert_flip_string(tty, data, urb->actual_length); 73484fe6e79STony Cook dbg(" %s ", data); 7353f542974SPaul B Schroeder tty_flip_buffer_push(tty); 7364a90f09bSAlan Cox tty_kref_put(tty); 7373f542974SPaul B Schroeder } 7383f542974SPaul B Schroeder mos7840_port->icount.rx += urb->actual_length; 7390de9a702SOliver Neukum smp_wmb(); 74084fe6e79STony Cook dbg("mos7840_port->icount.rx is %d:", 7413f542974SPaul B Schroeder mos7840_port->icount.rx); 7423f542974SPaul B Schroeder } 7433f542974SPaul B Schroeder 7443f542974SPaul B Schroeder if (!mos7840_port->read_urb) { 74584fe6e79STony Cook dbg("%s", "URB KILLED !!!"); 74650de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 7473f542974SPaul B Schroeder return; 7483f542974SPaul B Schroeder } 7493f542974SPaul B Schroeder 7500de9a702SOliver Neukum 7513f542974SPaul B Schroeder mos7840_port->read_urb->dev = serial->dev; 7523f542974SPaul B Schroeder 75350de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = true; 7540643c724SGreg Kroah-Hartman retval = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC); 7553f542974SPaul B Schroeder 7560643c724SGreg Kroah-Hartman if (retval) { 75750de36f7SGreg Kroah-Hartman dbg("usb_submit_urb(read bulk) failed, retval = %d", retval); 75850de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 7593f542974SPaul B Schroeder } 7603f542974SPaul B Schroeder } 7613f542974SPaul B Schroeder 7623f542974SPaul B Schroeder /***************************************************************************** 7633f542974SPaul B Schroeder * mos7840_bulk_out_data_callback 764880af9dbSAlan Cox * this is the callback function for when we have finished sending 765880af9dbSAlan Cox * serial data on the bulk out endpoint. 7663f542974SPaul B Schroeder *****************************************************************************/ 7673f542974SPaul B Schroeder 7687d12e780SDavid Howells static void mos7840_bulk_out_data_callback(struct urb *urb) 7693f542974SPaul B Schroeder { 7703f542974SPaul B Schroeder struct moschip_port *mos7840_port; 7713f542974SPaul B Schroeder struct tty_struct *tty; 7720643c724SGreg Kroah-Hartman int status = urb->status; 7730de9a702SOliver Neukum int i; 7740de9a702SOliver Neukum 775cdc97792SMing Lei mos7840_port = urb->context; 7760de9a702SOliver Neukum spin_lock(&mos7840_port->pool_lock); 7770de9a702SOliver Neukum for (i = 0; i < NUM_URBS; i++) { 7780de9a702SOliver Neukum if (urb == mos7840_port->write_urb_pool[i]) { 7790de9a702SOliver Neukum mos7840_port->busy[i] = 0; 7800de9a702SOliver Neukum break; 7810de9a702SOliver Neukum } 7820de9a702SOliver Neukum } 7830de9a702SOliver Neukum spin_unlock(&mos7840_port->pool_lock); 7840de9a702SOliver Neukum 7850643c724SGreg Kroah-Hartman if (status) { 78684fe6e79STony Cook dbg("nonzero write bulk status received:%d", status); 7873f542974SPaul B Schroeder return; 7883f542974SPaul B Schroeder } 7893f542974SPaul B Schroeder 790441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(mos7840_port->port, __func__)) { 79184fe6e79STony Cook dbg("%s", "Port Paranoia failed"); 7923f542974SPaul B Schroeder return; 7933f542974SPaul B Schroeder } 7943f542974SPaul B Schroeder 79584fe6e79STony Cook dbg("%s", "Entering ........."); 7963f542974SPaul B Schroeder 7974a90f09bSAlan Cox tty = tty_port_tty_get(&mos7840_port->port->port); 798b963a844SJiri Slaby if (tty && mos7840_port->open) 799b963a844SJiri Slaby tty_wakeup(tty); 8004a90f09bSAlan Cox tty_kref_put(tty); 8013f542974SPaul B Schroeder 8023f542974SPaul B Schroeder } 8033f542974SPaul B Schroeder 8043f542974SPaul B Schroeder /************************************************************************/ 8053f542974SPaul B Schroeder /* D R I V E R T T Y I N T E R F A C E F U N C T I O N S */ 8063f542974SPaul B Schroeder /************************************************************************/ 8073f542974SPaul B Schroeder #ifdef MCSSerialProbe 8083f542974SPaul B Schroeder static int mos7840_serial_probe(struct usb_serial *serial, 8093f542974SPaul B Schroeder const struct usb_device_id *id) 8103f542974SPaul B Schroeder { 8113f542974SPaul B Schroeder 8123f542974SPaul B Schroeder /*need to implement the mode_reg reading and updating\ 8133f542974SPaul B Schroeder structures usb_serial_ device_type\ 8143f542974SPaul B Schroeder (i.e num_ports, num_bulkin,bulkout etc) */ 8153f542974SPaul B Schroeder /* Also we can update the changes attach */ 8163f542974SPaul B Schroeder return 1; 8173f542974SPaul B Schroeder } 8183f542974SPaul B Schroeder #endif 8193f542974SPaul B Schroeder 8203f542974SPaul B Schroeder /***************************************************************************** 8213f542974SPaul B Schroeder * mos7840_open 8223f542974SPaul B Schroeder * this function is called by the tty driver when a port is opened 8233f542974SPaul B Schroeder * If successful, we return 0 8243f542974SPaul B Schroeder * Otherwise we return a negative error number. 8253f542974SPaul B Schroeder *****************************************************************************/ 8263f542974SPaul B Schroeder 82795da310eSAlan Cox static int mos7840_open(struct tty_struct *tty, 82895da310eSAlan Cox struct usb_serial_port *port, struct file *filp) 8293f542974SPaul B Schroeder { 8303f542974SPaul B Schroeder int response; 8313f542974SPaul B Schroeder int j; 8323f542974SPaul B Schroeder struct usb_serial *serial; 8333f542974SPaul B Schroeder struct urb *urb; 8343f542974SPaul B Schroeder __u16 Data; 8353f542974SPaul B Schroeder int status; 8363f542974SPaul B Schroeder struct moschip_port *mos7840_port; 8370de9a702SOliver Neukum struct moschip_port *port0; 8383f542974SPaul B Schroeder 83984fe6e79STony Cook dbg ("%s enter", __func__); 84084fe6e79STony Cook 841441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 84284fe6e79STony Cook dbg("%s", "Port Paranoia failed"); 8433f542974SPaul B Schroeder return -ENODEV; 8443f542974SPaul B Schroeder } 8453f542974SPaul B Schroeder 8463f542974SPaul B Schroeder serial = port->serial; 8473f542974SPaul B Schroeder 848441b62c1SHarvey Harrison if (mos7840_serial_paranoia_check(serial, __func__)) { 84984fe6e79STony Cook dbg("%s", "Serial Paranoia failed"); 8503f542974SPaul B Schroeder return -ENODEV; 8513f542974SPaul B Schroeder } 8523f542974SPaul B Schroeder 8533f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 8540de9a702SOliver Neukum port0 = mos7840_get_port_private(serial->port[0]); 8553f542974SPaul B Schroeder 8560de9a702SOliver Neukum if (mos7840_port == NULL || port0 == NULL) 8573f542974SPaul B Schroeder return -ENODEV; 8583f542974SPaul B Schroeder 8593f542974SPaul B Schroeder usb_clear_halt(serial->dev, port->write_urb->pipe); 8603f542974SPaul B Schroeder usb_clear_halt(serial->dev, port->read_urb->pipe); 8610de9a702SOliver Neukum port0->open_ports++; 8623f542974SPaul B Schroeder 8633f542974SPaul B Schroeder /* Initialising the write urb pool */ 8643f542974SPaul B Schroeder for (j = 0; j < NUM_URBS; ++j) { 8650de9a702SOliver Neukum urb = usb_alloc_urb(0, GFP_KERNEL); 8663f542974SPaul B Schroeder mos7840_port->write_urb_pool[j] = urb; 8673f542974SPaul B Schroeder 8683f542974SPaul B Schroeder if (urb == NULL) { 869194343d9SGreg Kroah-Hartman dev_err(&port->dev, "No more urbs???\n"); 8703f542974SPaul B Schroeder continue; 8713f542974SPaul B Schroeder } 8723f542974SPaul B Schroeder 873880af9dbSAlan Cox urb->transfer_buffer = kmalloc(URB_TRANSFER_BUFFER_SIZE, 874880af9dbSAlan Cox GFP_KERNEL); 8753f542974SPaul B Schroeder if (!urb->transfer_buffer) { 8760de9a702SOliver Neukum usb_free_urb(urb); 8770de9a702SOliver Neukum mos7840_port->write_urb_pool[j] = NULL; 878194343d9SGreg Kroah-Hartman dev_err(&port->dev, 879194343d9SGreg Kroah-Hartman "%s-out of memory for urb buffers.\n", 880194343d9SGreg Kroah-Hartman __func__); 8813f542974SPaul B Schroeder continue; 8823f542974SPaul B Schroeder } 8833f542974SPaul B Schroeder } 8843f542974SPaul B Schroeder 8853f542974SPaul B Schroeder /***************************************************************************** 8863f542974SPaul B Schroeder * Initialize MCS7840 -- Write Init values to corresponding Registers 8873f542974SPaul B Schroeder * 8883f542974SPaul B Schroeder * Register Index 8893f542974SPaul B Schroeder * 1 : IER 8903f542974SPaul B Schroeder * 2 : FCR 8913f542974SPaul B Schroeder * 3 : LCR 8923f542974SPaul B Schroeder * 4 : MCR 8933f542974SPaul B Schroeder * 8943f542974SPaul B Schroeder * 0x08 : SP1/2 Control Reg 8953f542974SPaul B Schroeder *****************************************************************************/ 8963f542974SPaul B Schroeder 897880af9dbSAlan Cox /* NEED to check the following Block */ 8983f542974SPaul B Schroeder 8993f542974SPaul B Schroeder Data = 0x0; 9003f542974SPaul B Schroeder status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data); 9013f542974SPaul B Schroeder if (status < 0) { 90284fe6e79STony Cook dbg("Reading Spreg failed"); 9033f542974SPaul B Schroeder return -1; 9043f542974SPaul B Schroeder } 9053f542974SPaul B Schroeder Data |= 0x80; 9063f542974SPaul B Schroeder status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); 9073f542974SPaul B Schroeder if (status < 0) { 90884fe6e79STony Cook dbg("writing Spreg failed"); 9093f542974SPaul B Schroeder return -1; 9103f542974SPaul B Schroeder } 9113f542974SPaul B Schroeder 9123f542974SPaul B Schroeder Data &= ~0x80; 9133f542974SPaul B Schroeder status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); 9143f542974SPaul B Schroeder if (status < 0) { 91584fe6e79STony Cook dbg("writing Spreg failed"); 9163f542974SPaul B Schroeder return -1; 9173f542974SPaul B Schroeder } 918880af9dbSAlan Cox /* End of block to be checked */ 9193f542974SPaul B Schroeder 9203f542974SPaul B Schroeder Data = 0x0; 921880af9dbSAlan Cox status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, 922880af9dbSAlan Cox &Data); 9233f542974SPaul B Schroeder if (status < 0) { 92484fe6e79STony Cook dbg("Reading Controlreg failed"); 9253f542974SPaul B Schroeder return -1; 9263f542974SPaul B Schroeder } 927880af9dbSAlan Cox Data |= 0x08; /* Driver done bit */ 928880af9dbSAlan Cox Data |= 0x20; /* rx_disable */ 929880af9dbSAlan Cox status = mos7840_set_reg_sync(port, 930880af9dbSAlan Cox mos7840_port->ControlRegOffset, Data); 9313f542974SPaul B Schroeder if (status < 0) { 93284fe6e79STony Cook dbg("writing Controlreg failed"); 9333f542974SPaul B Schroeder return -1; 9343f542974SPaul B Schroeder } 935880af9dbSAlan Cox /* do register settings here */ 936880af9dbSAlan Cox /* Set all regs to the device default values. */ 937880af9dbSAlan Cox /*********************************** 938880af9dbSAlan Cox * First Disable all interrupts. 939880af9dbSAlan Cox ***********************************/ 9403f542974SPaul B Schroeder Data = 0x00; 9413f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 9423f542974SPaul B Schroeder if (status < 0) { 94384fe6e79STony Cook dbg("disabling interrupts failed"); 9443f542974SPaul B Schroeder return -1; 9453f542974SPaul B Schroeder } 946880af9dbSAlan Cox /* Set FIFO_CONTROL_REGISTER to the default value */ 9473f542974SPaul B Schroeder Data = 0x00; 9483f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); 9493f542974SPaul B Schroeder if (status < 0) { 95084fe6e79STony Cook dbg("Writing FIFO_CONTROL_REGISTER failed"); 9513f542974SPaul B Schroeder return -1; 9523f542974SPaul B Schroeder } 9533f542974SPaul B Schroeder 9543f542974SPaul B Schroeder Data = 0xcf; 9553f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); 9563f542974SPaul B Schroeder if (status < 0) { 95784fe6e79STony Cook dbg("Writing FIFO_CONTROL_REGISTER failed"); 9583f542974SPaul B Schroeder return -1; 9593f542974SPaul B Schroeder } 9603f542974SPaul B Schroeder 9613f542974SPaul B Schroeder Data = 0x03; 9623f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 9633f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 9643f542974SPaul B Schroeder 9653f542974SPaul B Schroeder Data = 0x0b; 9663f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 9673f542974SPaul B Schroeder mos7840_port->shadowMCR = Data; 9683f542974SPaul B Schroeder 9693f542974SPaul B Schroeder Data = 0x00; 9703f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); 9713f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 9723f542974SPaul B Schroeder 973880af9dbSAlan Cox Data |= SERIAL_LCR_DLAB; /* data latch enable in LCR 0x80 */ 9743f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 9753f542974SPaul B Schroeder 9763f542974SPaul B Schroeder Data = 0x0c; 9773f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data); 9783f542974SPaul B Schroeder 9793f542974SPaul B Schroeder Data = 0x0; 9803f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data); 9813f542974SPaul B Schroeder 9823f542974SPaul B Schroeder Data = 0x00; 9833f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); 9843f542974SPaul B Schroeder 9853f542974SPaul B Schroeder Data = Data & ~SERIAL_LCR_DLAB; 9863f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 9873f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 9883f542974SPaul B Schroeder 989880af9dbSAlan Cox /* clearing Bulkin and Bulkout Fifo */ 9903f542974SPaul B Schroeder Data = 0x0; 9913f542974SPaul B Schroeder status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data); 9923f542974SPaul B Schroeder 9933f542974SPaul B Schroeder Data = Data | 0x0c; 9943f542974SPaul B Schroeder status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); 9953f542974SPaul B Schroeder 9963f542974SPaul B Schroeder Data = Data & ~0x0c; 9973f542974SPaul B Schroeder status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); 998880af9dbSAlan Cox /* Finally enable all interrupts */ 9993f542974SPaul B Schroeder Data = 0x0c; 10003f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 10013f542974SPaul B Schroeder 1002880af9dbSAlan Cox /* clearing rx_disable */ 10033f542974SPaul B Schroeder Data = 0x0; 1004880af9dbSAlan Cox status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, 1005880af9dbSAlan Cox &Data); 10063f542974SPaul B Schroeder Data = Data & ~0x20; 1007880af9dbSAlan Cox status = mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, 1008880af9dbSAlan Cox Data); 10093f542974SPaul B Schroeder 1010880af9dbSAlan Cox /* rx_negate */ 10113f542974SPaul B Schroeder Data = 0x0; 1012880af9dbSAlan Cox status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, 1013880af9dbSAlan Cox &Data); 10143f542974SPaul B Schroeder Data = Data | 0x10; 1015880af9dbSAlan Cox status = mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, 1016880af9dbSAlan Cox Data); 10173f542974SPaul B Schroeder 10183f542974SPaul B Schroeder /* Check to see if we've set up our endpoint info yet * 10193f542974SPaul B Schroeder * (can't set it up in mos7840_startup as the structures * 10203f542974SPaul B Schroeder * were not set up at that time.) */ 10210de9a702SOliver Neukum if (port0->open_ports == 1) { 10223f542974SPaul B Schroeder if (serial->port[0]->interrupt_in_buffer == NULL) { 10233f542974SPaul B Schroeder /* set up interrupt urb */ 10243f542974SPaul B Schroeder usb_fill_int_urb(serial->port[0]->interrupt_in_urb, 10253f542974SPaul B Schroeder serial->dev, 10263f542974SPaul B Schroeder usb_rcvintpipe(serial->dev, 1027880af9dbSAlan Cox serial->port[0]->interrupt_in_endpointAddress), 10283f542974SPaul B Schroeder serial->port[0]->interrupt_in_buffer, 10293f542974SPaul B Schroeder serial->port[0]->interrupt_in_urb-> 10303f542974SPaul B Schroeder transfer_buffer_length, 10313f542974SPaul B Schroeder mos7840_interrupt_callback, 10323f542974SPaul B Schroeder serial, 1033880af9dbSAlan Cox serial->port[0]->interrupt_in_urb->interval); 10343f542974SPaul B Schroeder 10353f542974SPaul B Schroeder /* start interrupt read for mos7840 * 10363f542974SPaul B Schroeder * will continue as long as mos7840 is connected */ 10373f542974SPaul B Schroeder 10383f542974SPaul B Schroeder response = 10393f542974SPaul B Schroeder usb_submit_urb(serial->port[0]->interrupt_in_urb, 10403f542974SPaul B Schroeder GFP_KERNEL); 10413f542974SPaul B Schroeder if (response) { 1042194343d9SGreg Kroah-Hartman dev_err(&port->dev, "%s - Error %d submitting " 1043194343d9SGreg Kroah-Hartman "interrupt urb\n", __func__, response); 10443f542974SPaul B Schroeder } 10453f542974SPaul B Schroeder 10463f542974SPaul B Schroeder } 10473f542974SPaul B Schroeder 10483f542974SPaul B Schroeder } 10493f542974SPaul B Schroeder 10503f542974SPaul B Schroeder /* see if we've set up our endpoint info yet * 10513f542974SPaul B Schroeder * (can't set it up in mos7840_startup as the * 10523f542974SPaul B Schroeder * structures were not set up at that time.) */ 10533f542974SPaul B Schroeder 105484fe6e79STony Cook dbg("port number is %d", port->number); 105584fe6e79STony Cook dbg("serial number is %d", port->serial->minor); 105684fe6e79STony Cook dbg("Bulkin endpoint is %d", port->bulk_in_endpointAddress); 105784fe6e79STony Cook dbg("BulkOut endpoint is %d", port->bulk_out_endpointAddress); 105884fe6e79STony Cook dbg("Interrupt endpoint is %d", port->interrupt_in_endpointAddress); 105984fe6e79STony Cook dbg("port's number in the device is %d", mos7840_port->port_num); 10603f542974SPaul B Schroeder mos7840_port->read_urb = port->read_urb; 10613f542974SPaul B Schroeder 10623f542974SPaul B Schroeder /* set up our bulk in urb */ 10633f542974SPaul B Schroeder 10643f542974SPaul B Schroeder usb_fill_bulk_urb(mos7840_port->read_urb, 10653f542974SPaul B Schroeder serial->dev, 10663f542974SPaul B Schroeder usb_rcvbulkpipe(serial->dev, 10673f542974SPaul B Schroeder port->bulk_in_endpointAddress), 10683f542974SPaul B Schroeder port->bulk_in_buffer, 10693f542974SPaul B Schroeder mos7840_port->read_urb->transfer_buffer_length, 10703f542974SPaul B Schroeder mos7840_bulk_in_callback, mos7840_port); 10713f542974SPaul B Schroeder 107284fe6e79STony Cook dbg("mos7840_open: bulkin endpoint is %d", 10733f542974SPaul B Schroeder port->bulk_in_endpointAddress); 107450de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = true; 10753f542974SPaul B Schroeder response = usb_submit_urb(mos7840_port->read_urb, GFP_KERNEL); 10763f542974SPaul B Schroeder if (response) { 1077194343d9SGreg Kroah-Hartman dev_err(&port->dev, "%s - Error %d submitting control urb\n", 1078194343d9SGreg Kroah-Hartman __func__, response); 107950de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 10803f542974SPaul B Schroeder } 10813f542974SPaul B Schroeder 10823f542974SPaul B Schroeder /* initialize our wait queues */ 10833f542974SPaul B Schroeder init_waitqueue_head(&mos7840_port->wait_chase); 10843f542974SPaul B Schroeder init_waitqueue_head(&mos7840_port->delta_msr_wait); 10853f542974SPaul B Schroeder 10863f542974SPaul B Schroeder /* initialize our icount structure */ 10873f542974SPaul B Schroeder memset(&(mos7840_port->icount), 0x00, sizeof(mos7840_port->icount)); 10883f542974SPaul B Schroeder 10893f542974SPaul B Schroeder /* initialize our port settings */ 1090880af9dbSAlan Cox /* Must set to enable ints! */ 1091880af9dbSAlan Cox mos7840_port->shadowMCR = MCR_MASTER_IE; 10923f542974SPaul B Schroeder /* send a open port command */ 10933f542974SPaul B Schroeder mos7840_port->open = 1; 1094880af9dbSAlan Cox /* mos7840_change_port_settings(mos7840_port,old_termios); */ 10953f542974SPaul B Schroeder mos7840_port->icount.tx = 0; 10963f542974SPaul B Schroeder mos7840_port->icount.rx = 0; 10973f542974SPaul B Schroeder 109884fe6e79STony Cook dbg("usb_serial serial:%p mos7840_port:%p\n usb_serial_port port:%p", 1099880af9dbSAlan Cox serial, mos7840_port, port); 11003f542974SPaul B Schroeder 110184fe6e79STony Cook dbg ("%s leave", __func__); 110284fe6e79STony Cook 11033f542974SPaul B Schroeder return 0; 11043f542974SPaul B Schroeder 11053f542974SPaul B Schroeder } 11063f542974SPaul B Schroeder 11073f542974SPaul B Schroeder /***************************************************************************** 11083f542974SPaul B Schroeder * mos7840_chars_in_buffer 11093f542974SPaul B Schroeder * this function is called by the tty driver when it wants to know how many 11103f542974SPaul B Schroeder * bytes of data we currently have outstanding in the port (data that has 11113f542974SPaul B Schroeder * been written, but hasn't made it out the port yet) 11123f542974SPaul B Schroeder * If successful, we return the number of bytes left to be written in the 11133f542974SPaul B Schroeder * system, 111495da310eSAlan Cox * Otherwise we return zero. 11153f542974SPaul B Schroeder *****************************************************************************/ 11163f542974SPaul B Schroeder 111795da310eSAlan Cox static int mos7840_chars_in_buffer(struct tty_struct *tty) 11183f542974SPaul B Schroeder { 111995da310eSAlan Cox struct usb_serial_port *port = tty->driver_data; 11203f542974SPaul B Schroeder int i; 11213f542974SPaul B Schroeder int chars = 0; 11220de9a702SOliver Neukum unsigned long flags; 11233f542974SPaul B Schroeder struct moschip_port *mos7840_port; 11243f542974SPaul B Schroeder 112584fe6e79STony Cook dbg("%s", " mos7840_chars_in_buffer:entering ..........."); 11263f542974SPaul B Schroeder 1127441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 112884fe6e79STony Cook dbg("%s", "Invalid port"); 112995da310eSAlan Cox return 0; 11303f542974SPaul B Schroeder } 11313f542974SPaul B Schroeder 11323f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 11333f542974SPaul B Schroeder if (mos7840_port == NULL) { 113484fe6e79STony Cook dbg("%s", "mos7840_break:leaving ..........."); 113595da310eSAlan Cox return 0; 11363f542974SPaul B Schroeder } 11373f542974SPaul B Schroeder 11380de9a702SOliver Neukum spin_lock_irqsave(&mos7840_port->pool_lock, flags); 113995da310eSAlan Cox for (i = 0; i < NUM_URBS; ++i) 114095da310eSAlan Cox if (mos7840_port->busy[i]) 11413f542974SPaul B Schroeder chars += URB_TRANSFER_BUFFER_SIZE; 11420de9a702SOliver Neukum spin_unlock_irqrestore(&mos7840_port->pool_lock, flags); 1143441b62c1SHarvey Harrison dbg("%s - returns %d", __func__, chars); 11440de9a702SOliver Neukum return chars; 11453f542974SPaul B Schroeder 11463f542974SPaul B Schroeder } 11473f542974SPaul B Schroeder 11483f542974SPaul B Schroeder /***************************************************************************** 11493f542974SPaul B Schroeder * mos7840_close 11503f542974SPaul B Schroeder * this function is called by the tty driver when a port is closed 11513f542974SPaul B Schroeder *****************************************************************************/ 11523f542974SPaul B Schroeder 1153335f8514SAlan Cox static void mos7840_close(struct usb_serial_port *port) 11543f542974SPaul B Schroeder { 11553f542974SPaul B Schroeder struct usb_serial *serial; 11563f542974SPaul B Schroeder struct moschip_port *mos7840_port; 11570de9a702SOliver Neukum struct moschip_port *port0; 11583f542974SPaul B Schroeder int j; 11593f542974SPaul B Schroeder __u16 Data; 11603f542974SPaul B Schroeder 116184fe6e79STony Cook dbg("%s", "mos7840_close:entering..."); 11623f542974SPaul B Schroeder 1163441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 116484fe6e79STony Cook dbg("%s", "Port Paranoia failed"); 11653f542974SPaul B Schroeder return; 11663f542974SPaul B Schroeder } 11673f542974SPaul B Schroeder 1168441b62c1SHarvey Harrison serial = mos7840_get_usb_serial(port, __func__); 11693f542974SPaul B Schroeder if (!serial) { 117084fe6e79STony Cook dbg("%s", "Serial Paranoia failed"); 11713f542974SPaul B Schroeder return; 11723f542974SPaul B Schroeder } 11733f542974SPaul B Schroeder 11743f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 11750de9a702SOliver Neukum port0 = mos7840_get_port_private(serial->port[0]); 11763f542974SPaul B Schroeder 11770de9a702SOliver Neukum if (mos7840_port == NULL || port0 == NULL) 11783f542974SPaul B Schroeder return; 11793f542974SPaul B Schroeder 11803f542974SPaul B Schroeder for (j = 0; j < NUM_URBS; ++j) 11813f542974SPaul B Schroeder usb_kill_urb(mos7840_port->write_urb_pool[j]); 11823f542974SPaul B Schroeder 11833f542974SPaul B Schroeder /* Freeing Write URBs */ 11843f542974SPaul B Schroeder for (j = 0; j < NUM_URBS; ++j) { 11853f542974SPaul B Schroeder if (mos7840_port->write_urb_pool[j]) { 11863f542974SPaul B Schroeder if (mos7840_port->write_urb_pool[j]->transfer_buffer) 11873f542974SPaul B Schroeder kfree(mos7840_port->write_urb_pool[j]-> 11883f542974SPaul B Schroeder transfer_buffer); 11893f542974SPaul B Schroeder 11903f542974SPaul B Schroeder usb_free_urb(mos7840_port->write_urb_pool[j]); 11913f542974SPaul B Schroeder } 11923f542974SPaul B Schroeder } 11933f542974SPaul B Schroeder 11943f542974SPaul B Schroeder /* While closing port, shutdown all bulk read, write * 11953f542974SPaul B Schroeder * and interrupt read if they exists */ 11963f542974SPaul B Schroeder if (serial->dev) { 11973f542974SPaul B Schroeder if (mos7840_port->write_urb) { 119884fe6e79STony Cook dbg("%s", "Shutdown bulk write"); 11993f542974SPaul B Schroeder usb_kill_urb(mos7840_port->write_urb); 12003f542974SPaul B Schroeder } 12013f542974SPaul B Schroeder if (mos7840_port->read_urb) { 120284fe6e79STony Cook dbg("%s", "Shutdown bulk read"); 12033f542974SPaul B Schroeder usb_kill_urb(mos7840_port->read_urb); 120450de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 12053f542974SPaul B Schroeder } 12063f542974SPaul B Schroeder if ((&mos7840_port->control_urb)) { 120784fe6e79STony Cook dbg("%s", "Shutdown control read"); 1208880af9dbSAlan Cox /*/ usb_kill_urb (mos7840_port->control_urb); */ 12093f542974SPaul B Schroeder } 12103f542974SPaul B Schroeder } 1211880af9dbSAlan Cox /* if(mos7840_port->ctrl_buf != NULL) */ 1212880af9dbSAlan Cox /* kfree(mos7840_port->ctrl_buf); */ 12130de9a702SOliver Neukum port0->open_ports--; 121484fe6e79STony Cook dbg("mos7840_num_open_ports in close%d:in port%d", 12150de9a702SOliver Neukum port0->open_ports, port->number); 12160de9a702SOliver Neukum if (port0->open_ports == 0) { 12173f542974SPaul B Schroeder if (serial->port[0]->interrupt_in_urb) { 121884fe6e79STony Cook dbg("%s", "Shutdown interrupt_in_urb"); 12190de9a702SOliver Neukum usb_kill_urb(serial->port[0]->interrupt_in_urb); 12203f542974SPaul B Schroeder } 12213f542974SPaul B Schroeder } 12223f542974SPaul B Schroeder 12233f542974SPaul B Schroeder if (mos7840_port->write_urb) { 12243f542974SPaul B Schroeder /* if this urb had a transfer buffer already (old tx) free it */ 1225880af9dbSAlan Cox if (mos7840_port->write_urb->transfer_buffer != NULL) 12263f542974SPaul B Schroeder kfree(mos7840_port->write_urb->transfer_buffer); 12273f542974SPaul B Schroeder usb_free_urb(mos7840_port->write_urb); 12283f542974SPaul B Schroeder } 12293f542974SPaul B Schroeder 12303f542974SPaul B Schroeder Data = 0x0; 12313f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 12323f542974SPaul B Schroeder 12333f542974SPaul B Schroeder Data = 0x00; 12343f542974SPaul B Schroeder mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 12353f542974SPaul B Schroeder 12363f542974SPaul B Schroeder mos7840_port->open = 0; 12373f542974SPaul B Schroeder 123884fe6e79STony Cook dbg("%s", "Leaving ............"); 12393f542974SPaul B Schroeder } 12403f542974SPaul B Schroeder 12413f542974SPaul B Schroeder /************************************************************************ 12423f542974SPaul B Schroeder * 12433f542974SPaul B Schroeder * mos7840_block_until_chase_response 12443f542974SPaul B Schroeder * 12453f542974SPaul B Schroeder * This function will block the close until one of the following: 12463f542974SPaul B Schroeder * 1. Response to our Chase comes from mos7840 1247dc0d5c1eSJoe Perches * 2. A timeout of 10 seconds without activity has expired 12483f542974SPaul B Schroeder * (1K of mos7840 data @ 2400 baud ==> 4 sec to empty) 12493f542974SPaul B Schroeder * 12503f542974SPaul B Schroeder ************************************************************************/ 12513f542974SPaul B Schroeder 125295da310eSAlan Cox static void mos7840_block_until_chase_response(struct tty_struct *tty, 125395da310eSAlan Cox struct moschip_port *mos7840_port) 12543f542974SPaul B Schroeder { 12553f542974SPaul B Schroeder int timeout = 1 * HZ; 12563f542974SPaul B Schroeder int wait = 10; 12573f542974SPaul B Schroeder int count; 12583f542974SPaul B Schroeder 12593f542974SPaul B Schroeder while (1) { 126095da310eSAlan Cox count = mos7840_chars_in_buffer(tty); 12613f542974SPaul B Schroeder 12623f542974SPaul B Schroeder /* Check for Buffer status */ 1263880af9dbSAlan Cox if (count <= 0) 12643f542974SPaul B Schroeder return; 12653f542974SPaul B Schroeder 12663f542974SPaul B Schroeder /* Block the thread for a while */ 12673f542974SPaul B Schroeder interruptible_sleep_on_timeout(&mos7840_port->wait_chase, 12683f542974SPaul B Schroeder timeout); 12693f542974SPaul B Schroeder /* No activity.. count down section */ 12703f542974SPaul B Schroeder wait--; 12713f542974SPaul B Schroeder if (wait == 0) { 1272441b62c1SHarvey Harrison dbg("%s - TIMEOUT", __func__); 12733f542974SPaul B Schroeder return; 12743f542974SPaul B Schroeder } else { 1275dc0d5c1eSJoe Perches /* Reset timeout value back to seconds */ 12763f542974SPaul B Schroeder wait = 10; 12773f542974SPaul B Schroeder } 12783f542974SPaul B Schroeder } 12793f542974SPaul B Schroeder 12803f542974SPaul B Schroeder } 12813f542974SPaul B Schroeder 12823f542974SPaul B Schroeder /***************************************************************************** 12833f542974SPaul B Schroeder * mos7840_break 12843f542974SPaul B Schroeder * this function sends a break to the port 12853f542974SPaul B Schroeder *****************************************************************************/ 128695da310eSAlan Cox static void mos7840_break(struct tty_struct *tty, int break_state) 12873f542974SPaul B Schroeder { 128895da310eSAlan Cox struct usb_serial_port *port = tty->driver_data; 12893f542974SPaul B Schroeder unsigned char data; 12903f542974SPaul B Schroeder struct usb_serial *serial; 12913f542974SPaul B Schroeder struct moschip_port *mos7840_port; 12923f542974SPaul B Schroeder 129384fe6e79STony Cook dbg("%s", "Entering ..........."); 129484fe6e79STony Cook dbg("mos7840_break: Start"); 12953f542974SPaul B Schroeder 1296441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 129784fe6e79STony Cook dbg("%s", "Port Paranoia failed"); 12983f542974SPaul B Schroeder return; 12993f542974SPaul B Schroeder } 13003f542974SPaul B Schroeder 1301441b62c1SHarvey Harrison serial = mos7840_get_usb_serial(port, __func__); 13023f542974SPaul B Schroeder if (!serial) { 130384fe6e79STony Cook dbg("%s", "Serial Paranoia failed"); 13043f542974SPaul B Schroeder return; 13053f542974SPaul B Schroeder } 13063f542974SPaul B Schroeder 13073f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 13083f542974SPaul B Schroeder 1309880af9dbSAlan Cox if (mos7840_port == NULL) 13103f542974SPaul B Schroeder return; 13113f542974SPaul B Schroeder 131295da310eSAlan Cox if (serial->dev) 13133f542974SPaul B Schroeder /* flush and block until tx is empty */ 131495da310eSAlan Cox mos7840_block_until_chase_response(tty, mos7840_port); 13153f542974SPaul B Schroeder 131695da310eSAlan Cox if (break_state == -1) 13173f542974SPaul B Schroeder data = mos7840_port->shadowLCR | LCR_SET_BREAK; 131895da310eSAlan Cox else 13193f542974SPaul B Schroeder data = mos7840_port->shadowLCR & ~LCR_SET_BREAK; 13203f542974SPaul B Schroeder 13216b447f04SAlan Cox /* FIXME: no locking on shadowLCR anywhere in driver */ 13223f542974SPaul B Schroeder mos7840_port->shadowLCR = data; 132384fe6e79STony Cook dbg("mcs7840_break mos7840_port->shadowLCR is %x", 13243f542974SPaul B Schroeder mos7840_port->shadowLCR); 13253f542974SPaul B Schroeder mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, 13263f542974SPaul B Schroeder mos7840_port->shadowLCR); 13273f542974SPaul B Schroeder 13283f542974SPaul B Schroeder return; 13293f542974SPaul B Schroeder } 13303f542974SPaul B Schroeder 13313f542974SPaul B Schroeder /***************************************************************************** 13323f542974SPaul B Schroeder * mos7840_write_room 13333f542974SPaul B Schroeder * this function is called by the tty driver when it wants to know how many 13343f542974SPaul B Schroeder * bytes of data we can accept for a specific port. 13353f542974SPaul B Schroeder * If successful, we return the amount of room that we have for this port 13363f542974SPaul B Schroeder * Otherwise we return a negative error number. 13373f542974SPaul B Schroeder *****************************************************************************/ 13383f542974SPaul B Schroeder 133995da310eSAlan Cox static int mos7840_write_room(struct tty_struct *tty) 13403f542974SPaul B Schroeder { 134195da310eSAlan Cox struct usb_serial_port *port = tty->driver_data; 13423f542974SPaul B Schroeder int i; 13433f542974SPaul B Schroeder int room = 0; 13440de9a702SOliver Neukum unsigned long flags; 13453f542974SPaul B Schroeder struct moschip_port *mos7840_port; 13463f542974SPaul B Schroeder 134784fe6e79STony Cook dbg("%s", " mos7840_write_room:entering ..........."); 13483f542974SPaul B Schroeder 1349441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 135084fe6e79STony Cook dbg("%s", "Invalid port"); 135184fe6e79STony Cook dbg("%s", " mos7840_write_room:leaving ..........."); 13523f542974SPaul B Schroeder return -1; 13533f542974SPaul B Schroeder } 13543f542974SPaul B Schroeder 13553f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 13563f542974SPaul B Schroeder if (mos7840_port == NULL) { 135784fe6e79STony Cook dbg("%s", "mos7840_break:leaving ..........."); 13583f542974SPaul B Schroeder return -1; 13593f542974SPaul B Schroeder } 13603f542974SPaul B Schroeder 13610de9a702SOliver Neukum spin_lock_irqsave(&mos7840_port->pool_lock, flags); 13623f542974SPaul B Schroeder for (i = 0; i < NUM_URBS; ++i) { 1363880af9dbSAlan Cox if (!mos7840_port->busy[i]) 13643f542974SPaul B Schroeder room += URB_TRANSFER_BUFFER_SIZE; 13653f542974SPaul B Schroeder } 13660de9a702SOliver Neukum spin_unlock_irqrestore(&mos7840_port->pool_lock, flags); 13673f542974SPaul B Schroeder 13680de9a702SOliver Neukum room = (room == 0) ? 0 : room - URB_TRANSFER_BUFFER_SIZE + 1; 1369441b62c1SHarvey Harrison dbg("%s - returns %d", __func__, room); 13700de9a702SOliver Neukum return room; 13713f542974SPaul B Schroeder 13723f542974SPaul B Schroeder } 13733f542974SPaul B Schroeder 13743f542974SPaul B Schroeder /***************************************************************************** 13753f542974SPaul B Schroeder * mos7840_write 13763f542974SPaul B Schroeder * this function is called by the tty driver when data should be written to 13773f542974SPaul B Schroeder * the port. 13783f542974SPaul B Schroeder * If successful, we return the number of bytes written, otherwise we 13793f542974SPaul B Schroeder * return a negative error number. 13803f542974SPaul B Schroeder *****************************************************************************/ 13813f542974SPaul B Schroeder 138295da310eSAlan Cox static int mos7840_write(struct tty_struct *tty, struct usb_serial_port *port, 13833f542974SPaul B Schroeder const unsigned char *data, int count) 13843f542974SPaul B Schroeder { 13853f542974SPaul B Schroeder int status; 13863f542974SPaul B Schroeder int i; 13873f542974SPaul B Schroeder int bytes_sent = 0; 13883f542974SPaul B Schroeder int transfer_size; 13890de9a702SOliver Neukum unsigned long flags; 13903f542974SPaul B Schroeder 13913f542974SPaul B Schroeder struct moschip_port *mos7840_port; 13923f542974SPaul B Schroeder struct usb_serial *serial; 13933f542974SPaul B Schroeder struct urb *urb; 1394880af9dbSAlan Cox /* __u16 Data; */ 13953f542974SPaul B Schroeder const unsigned char *current_position = data; 13963f542974SPaul B Schroeder unsigned char *data1; 139784fe6e79STony Cook dbg("%s", "entering ..........."); 139884fe6e79STony Cook /* dbg("mos7840_write: mos7840_port->shadowLCR is %x", 1399880af9dbSAlan Cox mos7840_port->shadowLCR); */ 14003f542974SPaul B Schroeder 14013f542974SPaul B Schroeder #ifdef NOTMOS7840 14023f542974SPaul B Schroeder Data = 0x00; 14033f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); 14043f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 140584fe6e79STony Cook dbg("mos7840_write: LINE_CONTROL_REGISTER is %x", Data); 140684fe6e79STony Cook dbg("mos7840_write: mos7840_port->shadowLCR is %x", 14073f542974SPaul B Schroeder mos7840_port->shadowLCR); 14083f542974SPaul B Schroeder 1409880af9dbSAlan Cox /* Data = 0x03; */ 1410880af9dbSAlan Cox /* status = mos7840_set_uart_reg(port,LINE_CONTROL_REGISTER,Data); */ 1411880af9dbSAlan Cox /* mos7840_port->shadowLCR=Data;//Need to add later */ 14123f542974SPaul B Schroeder 1413880af9dbSAlan Cox Data |= SERIAL_LCR_DLAB; /* data latch enable in LCR 0x80 */ 14143f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 14153f542974SPaul B Schroeder 1416880af9dbSAlan Cox /* Data = 0x0c; */ 1417880af9dbSAlan Cox /* status = mos7840_set_uart_reg(port,DIVISOR_LATCH_LSB,Data); */ 14183f542974SPaul B Schroeder Data = 0x00; 14193f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, DIVISOR_LATCH_LSB, &Data); 142084fe6e79STony Cook dbg("mos7840_write:DLL value is %x", Data); 14213f542974SPaul B Schroeder 14223f542974SPaul B Schroeder Data = 0x0; 14233f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, DIVISOR_LATCH_MSB, &Data); 142484fe6e79STony Cook dbg("mos7840_write:DLM value is %x", Data); 14253f542974SPaul B Schroeder 14263f542974SPaul B Schroeder Data = Data & ~SERIAL_LCR_DLAB; 142784fe6e79STony Cook dbg("mos7840_write: mos7840_port->shadowLCR is %x", 14283f542974SPaul B Schroeder mos7840_port->shadowLCR); 14293f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 14303f542974SPaul B Schroeder #endif 14313f542974SPaul B Schroeder 1432441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 143384fe6e79STony Cook dbg("%s", "Port Paranoia failed"); 14343f542974SPaul B Schroeder return -1; 14353f542974SPaul B Schroeder } 14363f542974SPaul B Schroeder 14373f542974SPaul B Schroeder serial = port->serial; 1438441b62c1SHarvey Harrison if (mos7840_serial_paranoia_check(serial, __func__)) { 143984fe6e79STony Cook dbg("%s", "Serial Paranoia failed"); 14403f542974SPaul B Schroeder return -1; 14413f542974SPaul B Schroeder } 14423f542974SPaul B Schroeder 14433f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 14443f542974SPaul B Schroeder if (mos7840_port == NULL) { 144584fe6e79STony Cook dbg("%s", "mos7840_port is NULL"); 14463f542974SPaul B Schroeder return -1; 14473f542974SPaul B Schroeder } 14483f542974SPaul B Schroeder 14493f542974SPaul B Schroeder /* try to find a free urb in the list */ 14503f542974SPaul B Schroeder urb = NULL; 14513f542974SPaul B Schroeder 14520de9a702SOliver Neukum spin_lock_irqsave(&mos7840_port->pool_lock, flags); 14533f542974SPaul B Schroeder for (i = 0; i < NUM_URBS; ++i) { 14540de9a702SOliver Neukum if (!mos7840_port->busy[i]) { 14550de9a702SOliver Neukum mos7840_port->busy[i] = 1; 14563f542974SPaul B Schroeder urb = mos7840_port->write_urb_pool[i]; 145784fe6e79STony Cook dbg("URB:%d", i); 14583f542974SPaul B Schroeder break; 14593f542974SPaul B Schroeder } 14603f542974SPaul B Schroeder } 14610de9a702SOliver Neukum spin_unlock_irqrestore(&mos7840_port->pool_lock, flags); 14623f542974SPaul B Schroeder 14633f542974SPaul B Schroeder if (urb == NULL) { 1464441b62c1SHarvey Harrison dbg("%s - no more free urbs", __func__); 14653f542974SPaul B Schroeder goto exit; 14663f542974SPaul B Schroeder } 14673f542974SPaul B Schroeder 14683f542974SPaul B Schroeder if (urb->transfer_buffer == NULL) { 14693f542974SPaul B Schroeder urb->transfer_buffer = 14703f542974SPaul B Schroeder kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL); 14713f542974SPaul B Schroeder 14723f542974SPaul B Schroeder if (urb->transfer_buffer == NULL) { 1473194343d9SGreg Kroah-Hartman dev_err(&port->dev, "%s no more kernel memory...\n", 1474194343d9SGreg Kroah-Hartman __func__); 14753f542974SPaul B Schroeder goto exit; 14763f542974SPaul B Schroeder } 14773f542974SPaul B Schroeder } 14783f542974SPaul B Schroeder transfer_size = min(count, URB_TRANSFER_BUFFER_SIZE); 14793f542974SPaul B Schroeder 14803f542974SPaul B Schroeder memcpy(urb->transfer_buffer, current_position, transfer_size); 14813f542974SPaul B Schroeder 14823f542974SPaul B Schroeder /* fill urb with data and submit */ 14833f542974SPaul B Schroeder usb_fill_bulk_urb(urb, 14843f542974SPaul B Schroeder serial->dev, 14853f542974SPaul B Schroeder usb_sndbulkpipe(serial->dev, 14863f542974SPaul B Schroeder port->bulk_out_endpointAddress), 14873f542974SPaul B Schroeder urb->transfer_buffer, 14883f542974SPaul B Schroeder transfer_size, 14893f542974SPaul B Schroeder mos7840_bulk_out_data_callback, mos7840_port); 14903f542974SPaul B Schroeder 14913f542974SPaul B Schroeder data1 = urb->transfer_buffer; 149284fe6e79STony Cook dbg("bulkout endpoint is %d", port->bulk_out_endpointAddress); 14933f542974SPaul B Schroeder 14943f542974SPaul B Schroeder /* send it down the pipe */ 14953f542974SPaul B Schroeder status = usb_submit_urb(urb, GFP_ATOMIC); 14963f542974SPaul B Schroeder 14973f542974SPaul B Schroeder if (status) { 14980de9a702SOliver Neukum mos7840_port->busy[i] = 0; 1499194343d9SGreg Kroah-Hartman dev_err(&port->dev, "%s - usb_submit_urb(write bulk) failed " 1500194343d9SGreg Kroah-Hartman "with status = %d\n", __func__, status); 15013f542974SPaul B Schroeder bytes_sent = status; 15023f542974SPaul B Schroeder goto exit; 15033f542974SPaul B Schroeder } 15043f542974SPaul B Schroeder bytes_sent = transfer_size; 15053f542974SPaul B Schroeder mos7840_port->icount.tx += transfer_size; 15060de9a702SOliver Neukum smp_wmb(); 150784fe6e79STony Cook dbg("mos7840_port->icount.tx is %d:", mos7840_port->icount.tx); 15083f542974SPaul B Schroeder exit: 15093f542974SPaul B Schroeder return bytes_sent; 15103f542974SPaul B Schroeder 15113f542974SPaul B Schroeder } 15123f542974SPaul B Schroeder 15133f542974SPaul B Schroeder /***************************************************************************** 15143f542974SPaul B Schroeder * mos7840_throttle 15153f542974SPaul B Schroeder * this function is called by the tty driver when it wants to stop the data 15163f542974SPaul B Schroeder * being read from the port. 15173f542974SPaul B Schroeder *****************************************************************************/ 15183f542974SPaul B Schroeder 151995da310eSAlan Cox static void mos7840_throttle(struct tty_struct *tty) 15203f542974SPaul B Schroeder { 152195da310eSAlan Cox struct usb_serial_port *port = tty->driver_data; 15223f542974SPaul B Schroeder struct moschip_port *mos7840_port; 15233f542974SPaul B Schroeder int status; 15243f542974SPaul B Schroeder 1525441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 152684fe6e79STony Cook dbg("%s", "Invalid port"); 15273f542974SPaul B Schroeder return; 15283f542974SPaul B Schroeder } 15293f542974SPaul B Schroeder 153084fe6e79STony Cook dbg("- port %d", port->number); 15313f542974SPaul B Schroeder 15323f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 15333f542974SPaul B Schroeder 15343f542974SPaul B Schroeder if (mos7840_port == NULL) 15353f542974SPaul B Schroeder return; 15363f542974SPaul B Schroeder 15373f542974SPaul B Schroeder if (!mos7840_port->open) { 153884fe6e79STony Cook dbg("%s", "port not opened"); 15393f542974SPaul B Schroeder return; 15403f542974SPaul B Schroeder } 15413f542974SPaul B Schroeder 154284fe6e79STony Cook dbg("%s", "Entering .........."); 15433f542974SPaul B Schroeder 15443f542974SPaul B Schroeder /* if we are implementing XON/XOFF, send the stop character */ 15453f542974SPaul B Schroeder if (I_IXOFF(tty)) { 15463f542974SPaul B Schroeder unsigned char stop_char = STOP_CHAR(tty); 154795da310eSAlan Cox status = mos7840_write(tty, port, &stop_char, 1); 154895da310eSAlan Cox if (status <= 0) 15493f542974SPaul B Schroeder return; 15503f542974SPaul B Schroeder } 15513f542974SPaul B Schroeder /* if we are implementing RTS/CTS, toggle that line */ 15523f542974SPaul B Schroeder if (tty->termios->c_cflag & CRTSCTS) { 15533f542974SPaul B Schroeder mos7840_port->shadowMCR &= ~MCR_RTS; 155495da310eSAlan Cox status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, 15553f542974SPaul B Schroeder mos7840_port->shadowMCR); 155695da310eSAlan Cox if (status < 0) 15573f542974SPaul B Schroeder return; 15583f542974SPaul B Schroeder } 15593f542974SPaul B Schroeder 15603f542974SPaul B Schroeder return; 15613f542974SPaul B Schroeder } 15623f542974SPaul B Schroeder 15633f542974SPaul B Schroeder /***************************************************************************** 15643f542974SPaul B Schroeder * mos7840_unthrottle 1565880af9dbSAlan Cox * this function is called by the tty driver when it wants to resume 1566880af9dbSAlan Cox * the data being read from the port (called after mos7840_throttle is 1567880af9dbSAlan Cox * called) 15683f542974SPaul B Schroeder *****************************************************************************/ 156995da310eSAlan Cox static void mos7840_unthrottle(struct tty_struct *tty) 15703f542974SPaul B Schroeder { 157195da310eSAlan Cox struct usb_serial_port *port = tty->driver_data; 15723f542974SPaul B Schroeder int status; 15733f542974SPaul B Schroeder struct moschip_port *mos7840_port = mos7840_get_port_private(port); 15743f542974SPaul B Schroeder 1575441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 157684fe6e79STony Cook dbg("%s", "Invalid port"); 15773f542974SPaul B Schroeder return; 15783f542974SPaul B Schroeder } 15793f542974SPaul B Schroeder 15803f542974SPaul B Schroeder if (mos7840_port == NULL) 15813f542974SPaul B Schroeder return; 15823f542974SPaul B Schroeder 15833f542974SPaul B Schroeder if (!mos7840_port->open) { 1584441b62c1SHarvey Harrison dbg("%s - port not opened", __func__); 15853f542974SPaul B Schroeder return; 15863f542974SPaul B Schroeder } 15873f542974SPaul B Schroeder 158884fe6e79STony Cook dbg("%s", "Entering .........."); 15893f542974SPaul B Schroeder 15903f542974SPaul B Schroeder /* if we are implementing XON/XOFF, send the start character */ 15913f542974SPaul B Schroeder if (I_IXOFF(tty)) { 15923f542974SPaul B Schroeder unsigned char start_char = START_CHAR(tty); 159395da310eSAlan Cox status = mos7840_write(tty, port, &start_char, 1); 159495da310eSAlan Cox if (status <= 0) 15953f542974SPaul B Schroeder return; 15963f542974SPaul B Schroeder } 15973f542974SPaul B Schroeder 15983f542974SPaul B Schroeder /* if we are implementing RTS/CTS, toggle that line */ 15993f542974SPaul B Schroeder if (tty->termios->c_cflag & CRTSCTS) { 16003f542974SPaul B Schroeder mos7840_port->shadowMCR |= MCR_RTS; 160195da310eSAlan Cox status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, 16023f542974SPaul B Schroeder mos7840_port->shadowMCR); 160395da310eSAlan Cox if (status < 0) 16043f542974SPaul B Schroeder return; 16053f542974SPaul B Schroeder } 16063f542974SPaul B Schroeder } 16073f542974SPaul B Schroeder 160895da310eSAlan Cox static int mos7840_tiocmget(struct tty_struct *tty, struct file *file) 16093f542974SPaul B Schroeder { 161095da310eSAlan Cox struct usb_serial_port *port = tty->driver_data; 16113f542974SPaul B Schroeder struct moschip_port *mos7840_port; 16123f542974SPaul B Schroeder unsigned int result; 16133f542974SPaul B Schroeder __u16 msr; 16143f542974SPaul B Schroeder __u16 mcr; 1615880af9dbSAlan Cox int status; 16163f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 16173f542974SPaul B Schroeder 1618441b62c1SHarvey Harrison dbg("%s - port %d", __func__, port->number); 16193f542974SPaul B Schroeder 16203f542974SPaul B Schroeder if (mos7840_port == NULL) 16213f542974SPaul B Schroeder return -ENODEV; 16223f542974SPaul B Schroeder 16233f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, MODEM_STATUS_REGISTER, &msr); 16243f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, MODEM_CONTROL_REGISTER, &mcr); 16253f542974SPaul B Schroeder result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0) 16263f542974SPaul B Schroeder | ((mcr & MCR_RTS) ? TIOCM_RTS : 0) 16273f542974SPaul B Schroeder | ((mcr & MCR_LOOPBACK) ? TIOCM_LOOP : 0) 16283f542974SPaul B Schroeder | ((msr & MOS7840_MSR_CTS) ? TIOCM_CTS : 0) 16293f542974SPaul B Schroeder | ((msr & MOS7840_MSR_CD) ? TIOCM_CAR : 0) 16303f542974SPaul B Schroeder | ((msr & MOS7840_MSR_RI) ? TIOCM_RI : 0) 16313f542974SPaul B Schroeder | ((msr & MOS7840_MSR_DSR) ? TIOCM_DSR : 0); 16323f542974SPaul B Schroeder 1633441b62c1SHarvey Harrison dbg("%s - 0x%04X", __func__, result); 16343f542974SPaul B Schroeder 16353f542974SPaul B Schroeder return result; 16363f542974SPaul B Schroeder } 16373f542974SPaul B Schroeder 163895da310eSAlan Cox static int mos7840_tiocmset(struct tty_struct *tty, struct file *file, 16393f542974SPaul B Schroeder unsigned int set, unsigned int clear) 16403f542974SPaul B Schroeder { 164195da310eSAlan Cox struct usb_serial_port *port = tty->driver_data; 16423f542974SPaul B Schroeder struct moschip_port *mos7840_port; 16433f542974SPaul B Schroeder unsigned int mcr; 164487521c46SRoel Kluin int status; 16453f542974SPaul B Schroeder 1646441b62c1SHarvey Harrison dbg("%s - port %d", __func__, port->number); 16473f542974SPaul B Schroeder 16483f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 16493f542974SPaul B Schroeder 16503f542974SPaul B Schroeder if (mos7840_port == NULL) 16513f542974SPaul B Schroeder return -ENODEV; 16523f542974SPaul B Schroeder 1653e2984494SAlan Cox /* FIXME: What locks the port registers ? */ 16543f542974SPaul B Schroeder mcr = mos7840_port->shadowMCR; 16553f542974SPaul B Schroeder if (clear & TIOCM_RTS) 16563f542974SPaul B Schroeder mcr &= ~MCR_RTS; 16573f542974SPaul B Schroeder if (clear & TIOCM_DTR) 16583f542974SPaul B Schroeder mcr &= ~MCR_DTR; 16593f542974SPaul B Schroeder if (clear & TIOCM_LOOP) 16603f542974SPaul B Schroeder mcr &= ~MCR_LOOPBACK; 16613f542974SPaul B Schroeder 16623f542974SPaul B Schroeder if (set & TIOCM_RTS) 16633f542974SPaul B Schroeder mcr |= MCR_RTS; 16643f542974SPaul B Schroeder if (set & TIOCM_DTR) 16653f542974SPaul B Schroeder mcr |= MCR_DTR; 16663f542974SPaul B Schroeder if (set & TIOCM_LOOP) 16673f542974SPaul B Schroeder mcr |= MCR_LOOPBACK; 16683f542974SPaul B Schroeder 16693f542974SPaul B Schroeder mos7840_port->shadowMCR = mcr; 16703f542974SPaul B Schroeder 16713f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, mcr); 16723f542974SPaul B Schroeder if (status < 0) { 167384fe6e79STony Cook dbg("setting MODEM_CONTROL_REGISTER Failed"); 167487521c46SRoel Kluin return status; 16753f542974SPaul B Schroeder } 16763f542974SPaul B Schroeder 16773f542974SPaul B Schroeder return 0; 16783f542974SPaul B Schroeder } 16793f542974SPaul B Schroeder 16803f542974SPaul B Schroeder /***************************************************************************** 16813f542974SPaul B Schroeder * mos7840_calc_baud_rate_divisor 16823f542974SPaul B Schroeder * this function calculates the proper baud rate divisor for the specified 16833f542974SPaul B Schroeder * baud rate. 16843f542974SPaul B Schroeder *****************************************************************************/ 16853f542974SPaul B Schroeder static int mos7840_calc_baud_rate_divisor(int baudRate, int *divisor, 16863f542974SPaul B Schroeder __u16 *clk_sel_val) 16873f542974SPaul B Schroeder { 16883f542974SPaul B Schroeder 1689441b62c1SHarvey Harrison dbg("%s - %d", __func__, baudRate); 16903f542974SPaul B Schroeder 16913f542974SPaul B Schroeder if (baudRate <= 115200) { 16923f542974SPaul B Schroeder *divisor = 115200 / baudRate; 16933f542974SPaul B Schroeder *clk_sel_val = 0x0; 16943f542974SPaul B Schroeder } 16953f542974SPaul B Schroeder if ((baudRate > 115200) && (baudRate <= 230400)) { 16963f542974SPaul B Schroeder *divisor = 230400 / baudRate; 16973f542974SPaul B Schroeder *clk_sel_val = 0x10; 16983f542974SPaul B Schroeder } else if ((baudRate > 230400) && (baudRate <= 403200)) { 16993f542974SPaul B Schroeder *divisor = 403200 / baudRate; 17003f542974SPaul B Schroeder *clk_sel_val = 0x20; 17013f542974SPaul B Schroeder } else if ((baudRate > 403200) && (baudRate <= 460800)) { 17023f542974SPaul B Schroeder *divisor = 460800 / baudRate; 17033f542974SPaul B Schroeder *clk_sel_val = 0x30; 17043f542974SPaul B Schroeder } else if ((baudRate > 460800) && (baudRate <= 806400)) { 17053f542974SPaul B Schroeder *divisor = 806400 / baudRate; 17063f542974SPaul B Schroeder *clk_sel_val = 0x40; 17073f542974SPaul B Schroeder } else if ((baudRate > 806400) && (baudRate <= 921600)) { 17083f542974SPaul B Schroeder *divisor = 921600 / baudRate; 17093f542974SPaul B Schroeder *clk_sel_val = 0x50; 17103f542974SPaul B Schroeder } else if ((baudRate > 921600) && (baudRate <= 1572864)) { 17113f542974SPaul B Schroeder *divisor = 1572864 / baudRate; 17123f542974SPaul B Schroeder *clk_sel_val = 0x60; 17133f542974SPaul B Schroeder } else if ((baudRate > 1572864) && (baudRate <= 3145728)) { 17143f542974SPaul B Schroeder *divisor = 3145728 / baudRate; 17153f542974SPaul B Schroeder *clk_sel_val = 0x70; 17163f542974SPaul B Schroeder } 17173f542974SPaul B Schroeder return 0; 17183f542974SPaul B Schroeder 17193f542974SPaul B Schroeder #ifdef NOTMCS7840 17203f542974SPaul B Schroeder 17213f542974SPaul B Schroeder for (i = 0; i < ARRAY_SIZE(mos7840_divisor_table); i++) { 17223f542974SPaul B Schroeder if (mos7840_divisor_table[i].BaudRate == baudrate) { 17233f542974SPaul B Schroeder *divisor = mos7840_divisor_table[i].Divisor; 17243f542974SPaul B Schroeder return 0; 17253f542974SPaul B Schroeder } 17263f542974SPaul B Schroeder } 17273f542974SPaul B Schroeder 17283f542974SPaul B Schroeder /* After trying for all the standard baud rates * 17293f542974SPaul B Schroeder * Try calculating the divisor for this baud rate */ 17303f542974SPaul B Schroeder 17313f542974SPaul B Schroeder if (baudrate > 75 && baudrate < 230400) { 17323f542974SPaul B Schroeder /* get the divisor */ 17333f542974SPaul B Schroeder custom = (__u16) (230400L / baudrate); 17343f542974SPaul B Schroeder 17353f542974SPaul B Schroeder /* Check for round off */ 17363f542974SPaul B Schroeder round1 = (__u16) (2304000L / baudrate); 17373f542974SPaul B Schroeder round = (__u16) (round1 - (custom * 10)); 1738880af9dbSAlan Cox if (round > 4) 17393f542974SPaul B Schroeder custom++; 17403f542974SPaul B Schroeder *divisor = custom; 17413f542974SPaul B Schroeder 174284fe6e79STony Cook dbg(" Baud %d = %d", baudrate, custom); 17433f542974SPaul B Schroeder return 0; 17443f542974SPaul B Schroeder } 17453f542974SPaul B Schroeder 174684fe6e79STony Cook dbg("%s", " Baud calculation Failed..."); 17473f542974SPaul B Schroeder return -1; 17483f542974SPaul B Schroeder #endif 17493f542974SPaul B Schroeder } 17503f542974SPaul B Schroeder 17513f542974SPaul B Schroeder /***************************************************************************** 17523f542974SPaul B Schroeder * mos7840_send_cmd_write_baud_rate 17533f542974SPaul B Schroeder * this function sends the proper command to change the baud rate of the 17543f542974SPaul B Schroeder * specified port. 17553f542974SPaul B Schroeder *****************************************************************************/ 17563f542974SPaul B Schroeder 17573f542974SPaul B Schroeder static int mos7840_send_cmd_write_baud_rate(struct moschip_port *mos7840_port, 17583f542974SPaul B Schroeder int baudRate) 17593f542974SPaul B Schroeder { 17603f542974SPaul B Schroeder int divisor = 0; 17613f542974SPaul B Schroeder int status; 17623f542974SPaul B Schroeder __u16 Data; 17633f542974SPaul B Schroeder unsigned char number; 17643f542974SPaul B Schroeder __u16 clk_sel_val; 17653f542974SPaul B Schroeder struct usb_serial_port *port; 17663f542974SPaul B Schroeder 17673f542974SPaul B Schroeder if (mos7840_port == NULL) 17683f542974SPaul B Schroeder return -1; 17693f542974SPaul B Schroeder 17703f542974SPaul B Schroeder port = (struct usb_serial_port *)mos7840_port->port; 1771441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 177284fe6e79STony Cook dbg("%s", "Invalid port"); 17733f542974SPaul B Schroeder return -1; 17743f542974SPaul B Schroeder } 17753f542974SPaul B Schroeder 1776441b62c1SHarvey Harrison if (mos7840_serial_paranoia_check(port->serial, __func__)) { 177784fe6e79STony Cook dbg("%s", "Invalid Serial"); 17783f542974SPaul B Schroeder return -1; 17793f542974SPaul B Schroeder } 17803f542974SPaul B Schroeder 178184fe6e79STony Cook dbg("%s", "Entering .........."); 17823f542974SPaul B Schroeder 17833f542974SPaul B Schroeder number = mos7840_port->port->number - mos7840_port->port->serial->minor; 17843f542974SPaul B Schroeder 1785441b62c1SHarvey Harrison dbg("%s - port = %d, baud = %d", __func__, 17863f542974SPaul B Schroeder mos7840_port->port->number, baudRate); 1787880af9dbSAlan Cox /* reset clk_uart_sel in spregOffset */ 17883f542974SPaul B Schroeder if (baudRate > 115200) { 17893f542974SPaul B Schroeder #ifdef HW_flow_control 1790880af9dbSAlan Cox /* NOTE: need to see the pther register to modify */ 1791880af9dbSAlan Cox /* setting h/w flow control bit to 1 */ 17923f542974SPaul B Schroeder Data = 0x2b; 17933f542974SPaul B Schroeder mos7840_port->shadowMCR = Data; 1794880af9dbSAlan Cox status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, 1795880af9dbSAlan Cox Data); 17963f542974SPaul B Schroeder if (status < 0) { 179784fe6e79STony Cook dbg("Writing spreg failed in set_serial_baud"); 17983f542974SPaul B Schroeder return -1; 17993f542974SPaul B Schroeder } 18003f542974SPaul B Schroeder #endif 18013f542974SPaul B Schroeder 18023f542974SPaul B Schroeder } else { 18033f542974SPaul B Schroeder #ifdef HW_flow_control 1804880af9dbSAlan Cox / *setting h/w flow control bit to 0 */ 18053f542974SPaul B Schroeder Data = 0xb; 18063f542974SPaul B Schroeder mos7840_port->shadowMCR = Data; 1807880af9dbSAlan Cox status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, 1808880af9dbSAlan Cox Data); 18093f542974SPaul B Schroeder if (status < 0) { 181084fe6e79STony Cook dbg("Writing spreg failed in set_serial_baud"); 18113f542974SPaul B Schroeder return -1; 18123f542974SPaul B Schroeder } 18133f542974SPaul B Schroeder #endif 18143f542974SPaul B Schroeder 18153f542974SPaul B Schroeder } 18163f542974SPaul B Schroeder 1817880af9dbSAlan Cox if (1) { /* baudRate <= 115200) */ 18183f542974SPaul B Schroeder clk_sel_val = 0x0; 18193f542974SPaul B Schroeder Data = 0x0; 1820880af9dbSAlan Cox status = mos7840_calc_baud_rate_divisor(baudRate, &divisor, 18213f542974SPaul B Schroeder &clk_sel_val); 1822880af9dbSAlan Cox status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, 18233f542974SPaul B Schroeder &Data); 18243f542974SPaul B Schroeder if (status < 0) { 182584fe6e79STony Cook dbg("reading spreg failed in set_serial_baud"); 18263f542974SPaul B Schroeder return -1; 18273f542974SPaul B Schroeder } 18283f542974SPaul B Schroeder Data = (Data & 0x8f) | clk_sel_val; 1829880af9dbSAlan Cox status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, 1830880af9dbSAlan Cox Data); 18313f542974SPaul B Schroeder if (status < 0) { 183284fe6e79STony Cook dbg("Writing spreg failed in set_serial_baud"); 18333f542974SPaul B Schroeder return -1; 18343f542974SPaul B Schroeder } 18353f542974SPaul B Schroeder /* Calculate the Divisor */ 18363f542974SPaul B Schroeder 18373f542974SPaul B Schroeder if (status) { 1838194343d9SGreg Kroah-Hartman dev_err(&port->dev, "%s - bad baud rate\n", __func__); 18393f542974SPaul B Schroeder return status; 18403f542974SPaul B Schroeder } 18413f542974SPaul B Schroeder /* Enable access to divisor latch */ 18423f542974SPaul B Schroeder Data = mos7840_port->shadowLCR | SERIAL_LCR_DLAB; 18433f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 18443f542974SPaul B Schroeder mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 18453f542974SPaul B Schroeder 18463f542974SPaul B Schroeder /* Write the divisor */ 18473f542974SPaul B Schroeder Data = (unsigned char)(divisor & 0xff); 184884fe6e79STony Cook dbg("set_serial_baud Value to write DLL is %x", Data); 18493f542974SPaul B Schroeder mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data); 18503f542974SPaul B Schroeder 18513f542974SPaul B Schroeder Data = (unsigned char)((divisor & 0xff00) >> 8); 185284fe6e79STony Cook dbg("set_serial_baud Value to write DLM is %x", Data); 18533f542974SPaul B Schroeder mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data); 18543f542974SPaul B Schroeder 18553f542974SPaul B Schroeder /* Disable access to divisor latch */ 18563f542974SPaul B Schroeder Data = mos7840_port->shadowLCR & ~SERIAL_LCR_DLAB; 18573f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 18583f542974SPaul B Schroeder mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 18593f542974SPaul B Schroeder 18603f542974SPaul B Schroeder } 18613f542974SPaul B Schroeder return status; 18623f542974SPaul B Schroeder } 18633f542974SPaul B Schroeder 18643f542974SPaul B Schroeder /***************************************************************************** 18653f542974SPaul B Schroeder * mos7840_change_port_settings 18663f542974SPaul B Schroeder * This routine is called to set the UART on the device to match 18673f542974SPaul B Schroeder * the specified new settings. 18683f542974SPaul B Schroeder *****************************************************************************/ 18693f542974SPaul B Schroeder 187095da310eSAlan Cox static void mos7840_change_port_settings(struct tty_struct *tty, 187195da310eSAlan Cox struct moschip_port *mos7840_port, struct ktermios *old_termios) 18723f542974SPaul B Schroeder { 18733f542974SPaul B Schroeder int baud; 18743f542974SPaul B Schroeder unsigned cflag; 18753f542974SPaul B Schroeder unsigned iflag; 18763f542974SPaul B Schroeder __u8 lData; 18773f542974SPaul B Schroeder __u8 lParity; 18783f542974SPaul B Schroeder __u8 lStop; 18793f542974SPaul B Schroeder int status; 18803f542974SPaul B Schroeder __u16 Data; 18813f542974SPaul B Schroeder struct usb_serial_port *port; 18823f542974SPaul B Schroeder struct usb_serial *serial; 18833f542974SPaul B Schroeder 18843f542974SPaul B Schroeder if (mos7840_port == NULL) 18853f542974SPaul B Schroeder return; 18863f542974SPaul B Schroeder 18873f542974SPaul B Schroeder port = (struct usb_serial_port *)mos7840_port->port; 18883f542974SPaul B Schroeder 1889441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 189084fe6e79STony Cook dbg("%s", "Invalid port"); 18913f542974SPaul B Schroeder return; 18923f542974SPaul B Schroeder } 18933f542974SPaul B Schroeder 1894441b62c1SHarvey Harrison if (mos7840_serial_paranoia_check(port->serial, __func__)) { 189584fe6e79STony Cook dbg("%s", "Invalid Serial"); 18963f542974SPaul B Schroeder return; 18973f542974SPaul B Schroeder } 18983f542974SPaul B Schroeder 18993f542974SPaul B Schroeder serial = port->serial; 19003f542974SPaul B Schroeder 1901441b62c1SHarvey Harrison dbg("%s - port %d", __func__, mos7840_port->port->number); 19023f542974SPaul B Schroeder 19033f542974SPaul B Schroeder if (!mos7840_port->open) { 1904441b62c1SHarvey Harrison dbg("%s - port not opened", __func__); 19053f542974SPaul B Schroeder return; 19063f542974SPaul B Schroeder } 19073f542974SPaul B Schroeder 190884fe6e79STony Cook dbg("%s", "Entering .........."); 19093f542974SPaul B Schroeder 19103f542974SPaul B Schroeder lData = LCR_BITS_8; 19113f542974SPaul B Schroeder lStop = LCR_STOP_1; 19123f542974SPaul B Schroeder lParity = LCR_PAR_NONE; 19133f542974SPaul B Schroeder 19143f542974SPaul B Schroeder cflag = tty->termios->c_cflag; 19153f542974SPaul B Schroeder iflag = tty->termios->c_iflag; 19163f542974SPaul B Schroeder 19173f542974SPaul B Schroeder /* Change the number of bits */ 19183f542974SPaul B Schroeder if (cflag & CSIZE) { 19193f542974SPaul B Schroeder switch (cflag & CSIZE) { 19203f542974SPaul B Schroeder case CS5: 19213f542974SPaul B Schroeder lData = LCR_BITS_5; 19223f542974SPaul B Schroeder break; 19233f542974SPaul B Schroeder 19243f542974SPaul B Schroeder case CS6: 19253f542974SPaul B Schroeder lData = LCR_BITS_6; 19263f542974SPaul B Schroeder break; 19273f542974SPaul B Schroeder 19283f542974SPaul B Schroeder case CS7: 19293f542974SPaul B Schroeder lData = LCR_BITS_7; 19303f542974SPaul B Schroeder break; 19313f542974SPaul B Schroeder default: 19323f542974SPaul B Schroeder case CS8: 19333f542974SPaul B Schroeder lData = LCR_BITS_8; 19343f542974SPaul B Schroeder break; 19353f542974SPaul B Schroeder } 19363f542974SPaul B Schroeder } 19373f542974SPaul B Schroeder /* Change the Parity bit */ 19383f542974SPaul B Schroeder if (cflag & PARENB) { 19393f542974SPaul B Schroeder if (cflag & PARODD) { 19403f542974SPaul B Schroeder lParity = LCR_PAR_ODD; 1941441b62c1SHarvey Harrison dbg("%s - parity = odd", __func__); 19423f542974SPaul B Schroeder } else { 19433f542974SPaul B Schroeder lParity = LCR_PAR_EVEN; 1944441b62c1SHarvey Harrison dbg("%s - parity = even", __func__); 19453f542974SPaul B Schroeder } 19463f542974SPaul B Schroeder 19473f542974SPaul B Schroeder } else { 1948441b62c1SHarvey Harrison dbg("%s - parity = none", __func__); 19493f542974SPaul B Schroeder } 19503f542974SPaul B Schroeder 1951880af9dbSAlan Cox if (cflag & CMSPAR) 19523f542974SPaul B Schroeder lParity = lParity | 0x20; 19533f542974SPaul B Schroeder 19543f542974SPaul B Schroeder /* Change the Stop bit */ 19553f542974SPaul B Schroeder if (cflag & CSTOPB) { 19563f542974SPaul B Schroeder lStop = LCR_STOP_2; 1957441b62c1SHarvey Harrison dbg("%s - stop bits = 2", __func__); 19583f542974SPaul B Schroeder } else { 19593f542974SPaul B Schroeder lStop = LCR_STOP_1; 1960441b62c1SHarvey Harrison dbg("%s - stop bits = 1", __func__); 19613f542974SPaul B Schroeder } 19623f542974SPaul B Schroeder 19633f542974SPaul B Schroeder /* Update the LCR with the correct value */ 19643f542974SPaul B Schroeder mos7840_port->shadowLCR &= 19653f542974SPaul B Schroeder ~(LCR_BITS_MASK | LCR_STOP_MASK | LCR_PAR_MASK); 19663f542974SPaul B Schroeder mos7840_port->shadowLCR |= (lData | lParity | lStop); 19673f542974SPaul B Schroeder 196884fe6e79STony Cook dbg("mos7840_change_port_settings mos7840_port->shadowLCR is %x", 19693f542974SPaul B Schroeder mos7840_port->shadowLCR); 19703f542974SPaul B Schroeder /* Disable Interrupts */ 19713f542974SPaul B Schroeder Data = 0x00; 19723f542974SPaul B Schroeder mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 19733f542974SPaul B Schroeder 19743f542974SPaul B Schroeder Data = 0x00; 19753f542974SPaul B Schroeder mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); 19763f542974SPaul B Schroeder 19773f542974SPaul B Schroeder Data = 0xcf; 19783f542974SPaul B Schroeder mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); 19793f542974SPaul B Schroeder 19803f542974SPaul B Schroeder /* Send the updated LCR value to the mos7840 */ 19813f542974SPaul B Schroeder Data = mos7840_port->shadowLCR; 19823f542974SPaul B Schroeder 19833f542974SPaul B Schroeder mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 19843f542974SPaul B Schroeder 19853f542974SPaul B Schroeder Data = 0x00b; 19863f542974SPaul B Schroeder mos7840_port->shadowMCR = Data; 19873f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 19883f542974SPaul B Schroeder Data = 0x00b; 19893f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 19903f542974SPaul B Schroeder 19913f542974SPaul B Schroeder /* set up the MCR register and send it to the mos7840 */ 19923f542974SPaul B Schroeder 19933f542974SPaul B Schroeder mos7840_port->shadowMCR = MCR_MASTER_IE; 1994880af9dbSAlan Cox if (cflag & CBAUD) 19953f542974SPaul B Schroeder mos7840_port->shadowMCR |= (MCR_DTR | MCR_RTS); 19963f542974SPaul B Schroeder 1997880af9dbSAlan Cox if (cflag & CRTSCTS) 19983f542974SPaul B Schroeder mos7840_port->shadowMCR |= (MCR_XON_ANY); 1999880af9dbSAlan Cox else 20003f542974SPaul B Schroeder mos7840_port->shadowMCR &= ~(MCR_XON_ANY); 20013f542974SPaul B Schroeder 20023f542974SPaul B Schroeder Data = mos7840_port->shadowMCR; 20033f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 20043f542974SPaul B Schroeder 20053f542974SPaul B Schroeder /* Determine divisor based on baud rate */ 20063f542974SPaul B Schroeder baud = tty_get_baud_rate(tty); 20073f542974SPaul B Schroeder 20083f542974SPaul B Schroeder if (!baud) { 20093f542974SPaul B Schroeder /* pick a default, any default... */ 201084fe6e79STony Cook dbg("%s", "Picked default baud..."); 20113f542974SPaul B Schroeder baud = 9600; 20123f542974SPaul B Schroeder } 20133f542974SPaul B Schroeder 2014441b62c1SHarvey Harrison dbg("%s - baud rate = %d", __func__, baud); 20153f542974SPaul B Schroeder status = mos7840_send_cmd_write_baud_rate(mos7840_port, baud); 20163f542974SPaul B Schroeder 20173f542974SPaul B Schroeder /* Enable Interrupts */ 20183f542974SPaul B Schroeder Data = 0x0c; 20193f542974SPaul B Schroeder mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 20203f542974SPaul B Schroeder 202150de36f7SGreg Kroah-Hartman if (mos7840_port->read_urb_busy == false) { 20223f542974SPaul B Schroeder mos7840_port->read_urb->dev = serial->dev; 202350de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = true; 20243f542974SPaul B Schroeder status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC); 20253f542974SPaul B Schroeder if (status) { 20263f542974SPaul B Schroeder dbg("usb_submit_urb(read bulk) failed, status = %d", 20273f542974SPaul B Schroeder status); 202850de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 20293f542974SPaul B Schroeder } 20303f542974SPaul B Schroeder } 20313f542974SPaul B Schroeder wake_up(&mos7840_port->delta_msr_wait); 20323f542974SPaul B Schroeder mos7840_port->delta_msr_cond = 1; 203384fe6e79STony Cook dbg("mos7840_change_port_settings mos7840_port->shadowLCR is End %x", 20343f542974SPaul B Schroeder mos7840_port->shadowLCR); 20353f542974SPaul B Schroeder 20363f542974SPaul B Schroeder return; 20373f542974SPaul B Schroeder } 20383f542974SPaul B Schroeder 20393f542974SPaul B Schroeder /***************************************************************************** 20403f542974SPaul B Schroeder * mos7840_set_termios 20413f542974SPaul B Schroeder * this function is called by the tty driver when it wants to change 20423f542974SPaul B Schroeder * the termios structure 20433f542974SPaul B Schroeder *****************************************************************************/ 20443f542974SPaul B Schroeder 204595da310eSAlan Cox static void mos7840_set_termios(struct tty_struct *tty, 204695da310eSAlan Cox struct usb_serial_port *port, 2047606d099cSAlan Cox struct ktermios *old_termios) 20483f542974SPaul B Schroeder { 20493f542974SPaul B Schroeder int status; 20503f542974SPaul B Schroeder unsigned int cflag; 20513f542974SPaul B Schroeder struct usb_serial *serial; 20523f542974SPaul B Schroeder struct moschip_port *mos7840_port; 205384fe6e79STony Cook dbg("mos7840_set_termios: START"); 2054441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 205584fe6e79STony Cook dbg("%s", "Invalid port"); 20563f542974SPaul B Schroeder return; 20573f542974SPaul B Schroeder } 20583f542974SPaul B Schroeder 20593f542974SPaul B Schroeder serial = port->serial; 20603f542974SPaul B Schroeder 2061441b62c1SHarvey Harrison if (mos7840_serial_paranoia_check(serial, __func__)) { 206284fe6e79STony Cook dbg("%s", "Invalid Serial"); 20633f542974SPaul B Schroeder return; 20643f542974SPaul B Schroeder } 20653f542974SPaul B Schroeder 20663f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 20673f542974SPaul B Schroeder 20683f542974SPaul B Schroeder if (mos7840_port == NULL) 20693f542974SPaul B Schroeder return; 20703f542974SPaul B Schroeder 20713f542974SPaul B Schroeder if (!mos7840_port->open) { 2072441b62c1SHarvey Harrison dbg("%s - port not opened", __func__); 20733f542974SPaul B Schroeder return; 20743f542974SPaul B Schroeder } 20753f542974SPaul B Schroeder 207684fe6e79STony Cook dbg("%s", "setting termios - "); 20773f542974SPaul B Schroeder 20783f542974SPaul B Schroeder cflag = tty->termios->c_cflag; 20793f542974SPaul B Schroeder 2080441b62c1SHarvey Harrison dbg("%s - clfag %08x iflag %08x", __func__, 20813f542974SPaul B Schroeder tty->termios->c_cflag, RELEVANT_IFLAG(tty->termios->c_iflag)); 2082441b62c1SHarvey Harrison dbg("%s - old clfag %08x old iflag %08x", __func__, 20833f542974SPaul B Schroeder old_termios->c_cflag, RELEVANT_IFLAG(old_termios->c_iflag)); 2084441b62c1SHarvey Harrison dbg("%s - port %d", __func__, port->number); 20853f542974SPaul B Schroeder 20863f542974SPaul B Schroeder /* change the port settings to the new ones specified */ 20873f542974SPaul B Schroeder 208895da310eSAlan Cox mos7840_change_port_settings(tty, mos7840_port, old_termios); 20893f542974SPaul B Schroeder 20903f542974SPaul B Schroeder if (!mos7840_port->read_urb) { 209184fe6e79STony Cook dbg("%s", "URB KILLED !!!!!"); 20923f542974SPaul B Schroeder return; 20933f542974SPaul B Schroeder } 20943f542974SPaul B Schroeder 209550de36f7SGreg Kroah-Hartman if (mos7840_port->read_urb_busy == false) { 20963f542974SPaul B Schroeder mos7840_port->read_urb->dev = serial->dev; 209750de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = true; 20983f542974SPaul B Schroeder status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC); 20993f542974SPaul B Schroeder if (status) { 21003f542974SPaul B Schroeder dbg("usb_submit_urb(read bulk) failed, status = %d", 21013f542974SPaul B Schroeder status); 210250de36f7SGreg Kroah-Hartman mos7840_port->read_urb_busy = false; 21033f542974SPaul B Schroeder } 21043f542974SPaul B Schroeder } 21053f542974SPaul B Schroeder return; 21063f542974SPaul B Schroeder } 21073f542974SPaul B Schroeder 21083f542974SPaul B Schroeder /***************************************************************************** 21093f542974SPaul B Schroeder * mos7840_get_lsr_info - get line status register info 21103f542974SPaul B Schroeder * 21113f542974SPaul B Schroeder * Purpose: Let user call ioctl() to get info when the UART physically 21123f542974SPaul B Schroeder * is emptied. On bus types like RS485, the transmitter must 21133f542974SPaul B Schroeder * release the bus after transmitting. This must be done when 21143f542974SPaul B Schroeder * the transmit shift register is empty, not be done when the 21153f542974SPaul B Schroeder * transmit holding register is empty. This functionality 21163f542974SPaul B Schroeder * allows an RS485 driver to be written in user space. 21173f542974SPaul B Schroeder *****************************************************************************/ 21183f542974SPaul B Schroeder 211995da310eSAlan Cox static int mos7840_get_lsr_info(struct tty_struct *tty, 212097c4965dSAl Viro unsigned int __user *value) 21213f542974SPaul B Schroeder { 21223f542974SPaul B Schroeder int count; 21233f542974SPaul B Schroeder unsigned int result = 0; 21243f542974SPaul B Schroeder 212595da310eSAlan Cox count = mos7840_chars_in_buffer(tty); 21263f542974SPaul B Schroeder if (count == 0) { 2127441b62c1SHarvey Harrison dbg("%s -- Empty", __func__); 21283f542974SPaul B Schroeder result = TIOCSER_TEMT; 21293f542974SPaul B Schroeder } 21303f542974SPaul B Schroeder 21313f542974SPaul B Schroeder if (copy_to_user(value, &result, sizeof(int))) 21323f542974SPaul B Schroeder return -EFAULT; 21333f542974SPaul B Schroeder return 0; 21343f542974SPaul B Schroeder } 21353f542974SPaul B Schroeder 21363f542974SPaul B Schroeder /***************************************************************************** 21373f542974SPaul B Schroeder * mos7840_set_modem_info 21383f542974SPaul B Schroeder * function to set modem info 21393f542974SPaul B Schroeder *****************************************************************************/ 21403f542974SPaul B Schroeder 214195da310eSAlan Cox /* FIXME: Should be using the model control hooks */ 214295da310eSAlan Cox 21433f542974SPaul B Schroeder static int mos7840_set_modem_info(struct moschip_port *mos7840_port, 214497c4965dSAl Viro unsigned int cmd, unsigned int __user *value) 21453f542974SPaul B Schroeder { 21463f542974SPaul B Schroeder unsigned int mcr; 21473f542974SPaul B Schroeder unsigned int arg; 21483f542974SPaul B Schroeder __u16 Data; 21493f542974SPaul B Schroeder int status; 21503f542974SPaul B Schroeder struct usb_serial_port *port; 21513f542974SPaul B Schroeder 21523f542974SPaul B Schroeder if (mos7840_port == NULL) 21533f542974SPaul B Schroeder return -1; 21543f542974SPaul B Schroeder 21553f542974SPaul B Schroeder port = (struct usb_serial_port *)mos7840_port->port; 2156441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 215784fe6e79STony Cook dbg("%s", "Invalid port"); 21583f542974SPaul B Schroeder return -1; 21593f542974SPaul B Schroeder } 21603f542974SPaul B Schroeder 21613f542974SPaul B Schroeder mcr = mos7840_port->shadowMCR; 21623f542974SPaul B Schroeder 21633f542974SPaul B Schroeder if (copy_from_user(&arg, value, sizeof(int))) 21643f542974SPaul B Schroeder return -EFAULT; 21653f542974SPaul B Schroeder 21663f542974SPaul B Schroeder switch (cmd) { 21673f542974SPaul B Schroeder case TIOCMBIS: 21683f542974SPaul B Schroeder if (arg & TIOCM_RTS) 21693f542974SPaul B Schroeder mcr |= MCR_RTS; 21703f542974SPaul B Schroeder if (arg & TIOCM_DTR) 21713f542974SPaul B Schroeder mcr |= MCR_RTS; 21723f542974SPaul B Schroeder if (arg & TIOCM_LOOP) 21733f542974SPaul B Schroeder mcr |= MCR_LOOPBACK; 21743f542974SPaul B Schroeder break; 21753f542974SPaul B Schroeder 21763f542974SPaul B Schroeder case TIOCMBIC: 21773f542974SPaul B Schroeder if (arg & TIOCM_RTS) 21783f542974SPaul B Schroeder mcr &= ~MCR_RTS; 21793f542974SPaul B Schroeder if (arg & TIOCM_DTR) 21803f542974SPaul B Schroeder mcr &= ~MCR_RTS; 21813f542974SPaul B Schroeder if (arg & TIOCM_LOOP) 21823f542974SPaul B Schroeder mcr &= ~MCR_LOOPBACK; 21833f542974SPaul B Schroeder break; 21843f542974SPaul B Schroeder 21853f542974SPaul B Schroeder case TIOCMSET: 21863f542974SPaul B Schroeder /* turn off the RTS and DTR and LOOPBACK 21873f542974SPaul B Schroeder * and then only turn on what was asked to */ 21883f542974SPaul B Schroeder mcr &= ~(MCR_RTS | MCR_DTR | MCR_LOOPBACK); 21893f542974SPaul B Schroeder mcr |= ((arg & TIOCM_RTS) ? MCR_RTS : 0); 21903f542974SPaul B Schroeder mcr |= ((arg & TIOCM_DTR) ? MCR_DTR : 0); 21913f542974SPaul B Schroeder mcr |= ((arg & TIOCM_LOOP) ? MCR_LOOPBACK : 0); 21923f542974SPaul B Schroeder break; 21933f542974SPaul B Schroeder } 21943f542974SPaul B Schroeder 21956b447f04SAlan Cox lock_kernel(); 21963f542974SPaul B Schroeder mos7840_port->shadowMCR = mcr; 21973f542974SPaul B Schroeder 21983f542974SPaul B Schroeder Data = mos7840_port->shadowMCR; 21993f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 22006b447f04SAlan Cox unlock_kernel(); 22013f542974SPaul B Schroeder if (status < 0) { 220284fe6e79STony Cook dbg("setting MODEM_CONTROL_REGISTER Failed"); 22033f542974SPaul B Schroeder return -1; 22043f542974SPaul B Schroeder } 22053f542974SPaul B Schroeder 22063f542974SPaul B Schroeder return 0; 22073f542974SPaul B Schroeder } 22083f542974SPaul B Schroeder 22093f542974SPaul B Schroeder /***************************************************************************** 22103f542974SPaul B Schroeder * mos7840_get_modem_info 22113f542974SPaul B Schroeder * function to get modem info 22123f542974SPaul B Schroeder *****************************************************************************/ 22133f542974SPaul B Schroeder 22143f542974SPaul B Schroeder static int mos7840_get_modem_info(struct moschip_port *mos7840_port, 221597c4965dSAl Viro unsigned int __user *value) 22163f542974SPaul B Schroeder { 22173f542974SPaul B Schroeder unsigned int result = 0; 22183f542974SPaul B Schroeder __u16 msr; 22193f542974SPaul B Schroeder unsigned int mcr = mos7840_port->shadowMCR; 2220880af9dbSAlan Cox mos7840_get_uart_reg(mos7840_port->port, 222195da310eSAlan Cox MODEM_STATUS_REGISTER, &msr); 22223f542974SPaul B Schroeder result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0) /* 0x002 */ 22233f542974SPaul B Schroeder |((mcr & MCR_RTS) ? TIOCM_RTS : 0) /* 0x004 */ 22243f542974SPaul B Schroeder |((msr & MOS7840_MSR_CTS) ? TIOCM_CTS : 0) /* 0x020 */ 22253f542974SPaul B Schroeder |((msr & MOS7840_MSR_CD) ? TIOCM_CAR : 0) /* 0x040 */ 22263f542974SPaul B Schroeder |((msr & MOS7840_MSR_RI) ? TIOCM_RI : 0) /* 0x080 */ 22273f542974SPaul B Schroeder |((msr & MOS7840_MSR_DSR) ? TIOCM_DSR : 0); /* 0x100 */ 22283f542974SPaul B Schroeder 2229441b62c1SHarvey Harrison dbg("%s -- %x", __func__, result); 22303f542974SPaul B Schroeder 22313f542974SPaul B Schroeder if (copy_to_user(value, &result, sizeof(int))) 22323f542974SPaul B Schroeder return -EFAULT; 22333f542974SPaul B Schroeder return 0; 22343f542974SPaul B Schroeder } 22353f542974SPaul B Schroeder 22363f542974SPaul B Schroeder /***************************************************************************** 22373f542974SPaul B Schroeder * mos7840_get_serial_info 22383f542974SPaul B Schroeder * function to get information about serial port 22393f542974SPaul B Schroeder *****************************************************************************/ 22403f542974SPaul B Schroeder 22413f542974SPaul B Schroeder static int mos7840_get_serial_info(struct moschip_port *mos7840_port, 224297c4965dSAl Viro struct serial_struct __user *retinfo) 22433f542974SPaul B Schroeder { 22443f542974SPaul B Schroeder struct serial_struct tmp; 22453f542974SPaul B Schroeder 22463f542974SPaul B Schroeder if (mos7840_port == NULL) 22473f542974SPaul B Schroeder return -1; 22483f542974SPaul B Schroeder 22493f542974SPaul B Schroeder if (!retinfo) 22503f542974SPaul B Schroeder return -EFAULT; 22513f542974SPaul B Schroeder 22523f542974SPaul B Schroeder memset(&tmp, 0, sizeof(tmp)); 22533f542974SPaul B Schroeder 22543f542974SPaul B Schroeder tmp.type = PORT_16550A; 22553f542974SPaul B Schroeder tmp.line = mos7840_port->port->serial->minor; 22563f542974SPaul B Schroeder tmp.port = mos7840_port->port->number; 22573f542974SPaul B Schroeder tmp.irq = 0; 22583f542974SPaul B Schroeder tmp.flags = ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ; 22593f542974SPaul B Schroeder tmp.xmit_fifo_size = NUM_URBS * URB_TRANSFER_BUFFER_SIZE; 22603f542974SPaul B Schroeder tmp.baud_base = 9600; 22613f542974SPaul B Schroeder tmp.close_delay = 5 * HZ; 22623f542974SPaul B Schroeder tmp.closing_wait = 30 * HZ; 22633f542974SPaul B Schroeder 22643f542974SPaul B Schroeder if (copy_to_user(retinfo, &tmp, sizeof(*retinfo))) 22653f542974SPaul B Schroeder return -EFAULT; 22663f542974SPaul B Schroeder return 0; 22673f542974SPaul B Schroeder } 22683f542974SPaul B Schroeder 22693f542974SPaul B Schroeder /***************************************************************************** 22703f542974SPaul B Schroeder * SerialIoctl 22713f542974SPaul B Schroeder * this function handles any ioctl calls to the driver 22723f542974SPaul B Schroeder *****************************************************************************/ 22733f542974SPaul B Schroeder 227495da310eSAlan Cox static int mos7840_ioctl(struct tty_struct *tty, struct file *file, 22753f542974SPaul B Schroeder unsigned int cmd, unsigned long arg) 22763f542974SPaul B Schroeder { 227795da310eSAlan Cox struct usb_serial_port *port = tty->driver_data; 227897c4965dSAl Viro void __user *argp = (void __user *)arg; 22793f542974SPaul B Schroeder struct moschip_port *mos7840_port; 22803f542974SPaul B Schroeder 22813f542974SPaul B Schroeder struct async_icount cnow; 22823f542974SPaul B Schroeder struct async_icount cprev; 22833f542974SPaul B Schroeder struct serial_icounter_struct icount; 22843f542974SPaul B Schroeder int mosret = 0; 22853f542974SPaul B Schroeder 2286441b62c1SHarvey Harrison if (mos7840_port_paranoia_check(port, __func__)) { 228784fe6e79STony Cook dbg("%s", "Invalid port"); 22883f542974SPaul B Schroeder return -1; 22893f542974SPaul B Schroeder } 22903f542974SPaul B Schroeder 22913f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 22923f542974SPaul B Schroeder 22933f542974SPaul B Schroeder if (mos7840_port == NULL) 22943f542974SPaul B Schroeder return -1; 22953f542974SPaul B Schroeder 2296441b62c1SHarvey Harrison dbg("%s - port %d, cmd = 0x%x", __func__, port->number, cmd); 22973f542974SPaul B Schroeder 22983f542974SPaul B Schroeder switch (cmd) { 22993f542974SPaul B Schroeder /* return number of bytes available */ 23003f542974SPaul B Schroeder 23013f542974SPaul B Schroeder case TIOCSERGETLSR: 2302441b62c1SHarvey Harrison dbg("%s (%d) TIOCSERGETLSR", __func__, port->number); 230395da310eSAlan Cox return mos7840_get_lsr_info(tty, argp); 23043f542974SPaul B Schroeder return 0; 23053f542974SPaul B Schroeder 230695da310eSAlan Cox /* FIXME: use the modem hooks and remove this */ 23073f542974SPaul B Schroeder case TIOCMBIS: 23083f542974SPaul B Schroeder case TIOCMBIC: 23093f542974SPaul B Schroeder case TIOCMSET: 2310441b62c1SHarvey Harrison dbg("%s (%d) TIOCMSET/TIOCMBIC/TIOCMSET", __func__, 23113f542974SPaul B Schroeder port->number); 23123f542974SPaul B Schroeder mosret = 231397c4965dSAl Viro mos7840_set_modem_info(mos7840_port, cmd, argp); 23143f542974SPaul B Schroeder return mosret; 23153f542974SPaul B Schroeder 23163f542974SPaul B Schroeder case TIOCMGET: 2317441b62c1SHarvey Harrison dbg("%s (%d) TIOCMGET", __func__, port->number); 231897c4965dSAl Viro return mos7840_get_modem_info(mos7840_port, argp); 23193f542974SPaul B Schroeder 23203f542974SPaul B Schroeder case TIOCGSERIAL: 2321441b62c1SHarvey Harrison dbg("%s (%d) TIOCGSERIAL", __func__, port->number); 232297c4965dSAl Viro return mos7840_get_serial_info(mos7840_port, argp); 23233f542974SPaul B Schroeder 23243f542974SPaul B Schroeder case TIOCSSERIAL: 2325441b62c1SHarvey Harrison dbg("%s (%d) TIOCSSERIAL", __func__, port->number); 23263f542974SPaul B Schroeder break; 23273f542974SPaul B Schroeder 23283f542974SPaul B Schroeder case TIOCMIWAIT: 2329441b62c1SHarvey Harrison dbg("%s (%d) TIOCMIWAIT", __func__, port->number); 23303f542974SPaul B Schroeder cprev = mos7840_port->icount; 23313f542974SPaul B Schroeder while (1) { 2332880af9dbSAlan Cox /* interruptible_sleep_on(&mos7840_port->delta_msr_wait); */ 23333f542974SPaul B Schroeder mos7840_port->delta_msr_cond = 0; 23343f542974SPaul B Schroeder wait_event_interruptible(mos7840_port->delta_msr_wait, 23353f542974SPaul B Schroeder (mos7840_port-> 23363f542974SPaul B Schroeder delta_msr_cond == 1)); 23373f542974SPaul B Schroeder 23383f542974SPaul B Schroeder /* see if a signal did it */ 23393f542974SPaul B Schroeder if (signal_pending(current)) 23403f542974SPaul B Schroeder return -ERESTARTSYS; 23413f542974SPaul B Schroeder cnow = mos7840_port->icount; 23420de9a702SOliver Neukum smp_rmb(); 23433f542974SPaul B Schroeder if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr && 23443f542974SPaul B Schroeder cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) 23453f542974SPaul B Schroeder return -EIO; /* no change => error */ 23463f542974SPaul B Schroeder if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) || 23473f542974SPaul B Schroeder ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) || 23483f542974SPaul B Schroeder ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) || 23493f542974SPaul B Schroeder ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) { 23503f542974SPaul B Schroeder return 0; 23513f542974SPaul B Schroeder } 23523f542974SPaul B Schroeder cprev = cnow; 23533f542974SPaul B Schroeder } 23543f542974SPaul B Schroeder /* NOTREACHED */ 23553f542974SPaul B Schroeder break; 23563f542974SPaul B Schroeder 23573f542974SPaul B Schroeder case TIOCGICOUNT: 23583f542974SPaul B Schroeder cnow = mos7840_port->icount; 23590de9a702SOliver Neukum smp_rmb(); 23603f542974SPaul B Schroeder icount.cts = cnow.cts; 23613f542974SPaul B Schroeder icount.dsr = cnow.dsr; 23623f542974SPaul B Schroeder icount.rng = cnow.rng; 23633f542974SPaul B Schroeder icount.dcd = cnow.dcd; 23643f542974SPaul B Schroeder icount.rx = cnow.rx; 23653f542974SPaul B Schroeder icount.tx = cnow.tx; 23663f542974SPaul B Schroeder icount.frame = cnow.frame; 23673f542974SPaul B Schroeder icount.overrun = cnow.overrun; 23683f542974SPaul B Schroeder icount.parity = cnow.parity; 23693f542974SPaul B Schroeder icount.brk = cnow.brk; 23703f542974SPaul B Schroeder icount.buf_overrun = cnow.buf_overrun; 23713f542974SPaul B Schroeder 2372441b62c1SHarvey Harrison dbg("%s (%d) TIOCGICOUNT RX=%d, TX=%d", __func__, 23733f542974SPaul B Schroeder port->number, icount.rx, icount.tx); 237497c4965dSAl Viro if (copy_to_user(argp, &icount, sizeof(icount))) 23753f542974SPaul B Schroeder return -EFAULT; 23763f542974SPaul B Schroeder return 0; 23773f542974SPaul B Schroeder default: 23783f542974SPaul B Schroeder break; 23793f542974SPaul B Schroeder } 23803f542974SPaul B Schroeder return -ENOIOCTLCMD; 23813f542974SPaul B Schroeder } 23823f542974SPaul B Schroeder 23833f542974SPaul B Schroeder static int mos7840_calc_num_ports(struct usb_serial *serial) 23843f542974SPaul B Schroeder { 23850de9a702SOliver Neukum int mos7840_num_ports = 0; 23863f542974SPaul B Schroeder 238784fe6e79STony Cook dbg("numberofendpoints: cur %d, alt %d", 238884fe6e79STony Cook (int)serial->interface->cur_altsetting->desc.bNumEndpoints, 23893f542974SPaul B Schroeder (int)serial->interface->altsetting->desc.bNumEndpoints); 23903f542974SPaul B Schroeder if (serial->interface->cur_altsetting->desc.bNumEndpoints == 5) { 23910de9a702SOliver Neukum mos7840_num_ports = serial->num_ports = 2; 23923f542974SPaul B Schroeder } else if (serial->interface->cur_altsetting->desc.bNumEndpoints == 9) { 23930de9a702SOliver Neukum serial->num_bulk_in = 4; 23940de9a702SOliver Neukum serial->num_bulk_out = 4; 23950de9a702SOliver Neukum mos7840_num_ports = serial->num_ports = 4; 23963f542974SPaul B Schroeder } 239784fe6e79STony Cook dbg ("mos7840_num_ports = %d", mos7840_num_ports); 23983f542974SPaul B Schroeder return mos7840_num_ports; 23993f542974SPaul B Schroeder } 24003f542974SPaul B Schroeder 24013f542974SPaul B Schroeder /**************************************************************************** 24023f542974SPaul B Schroeder * mos7840_startup 24033f542974SPaul B Schroeder ****************************************************************************/ 24043f542974SPaul B Schroeder 24053f542974SPaul B Schroeder static int mos7840_startup(struct usb_serial *serial) 24063f542974SPaul B Schroeder { 24073f542974SPaul B Schroeder struct moschip_port *mos7840_port; 24083f542974SPaul B Schroeder struct usb_device *dev; 24093f542974SPaul B Schroeder int i, status; 24103f542974SPaul B Schroeder 24113f542974SPaul B Schroeder __u16 Data; 241284fe6e79STony Cook dbg("%s", "mos7840_startup :Entering.........."); 24133f542974SPaul B Schroeder 24143f542974SPaul B Schroeder if (!serial) { 241584fe6e79STony Cook dbg("%s", "Invalid Handler"); 24163f542974SPaul B Schroeder return -1; 24173f542974SPaul B Schroeder } 24183f542974SPaul B Schroeder 24193f542974SPaul B Schroeder dev = serial->dev; 24203f542974SPaul B Schroeder 242184fe6e79STony Cook dbg("%s", "Entering..."); 242284fe6e79STony Cook dbg ("mos7840_startup: serial = %p", serial); 24233f542974SPaul B Schroeder 24243f542974SPaul B Schroeder /* we set up the pointers to the endpoints in the mos7840_open * 24253f542974SPaul B Schroeder * function, as the structures aren't created yet. */ 24263f542974SPaul B Schroeder 24273f542974SPaul B Schroeder /* set up port private structures */ 24283f542974SPaul B Schroeder for (i = 0; i < serial->num_ports; ++i) { 242984fe6e79STony Cook dbg ("mos7840_startup: configuring port %d............", i); 24307ac9da10SBurman Yan mos7840_port = kzalloc(sizeof(struct moschip_port), GFP_KERNEL); 24313f542974SPaul B Schroeder if (mos7840_port == NULL) { 2432194343d9SGreg Kroah-Hartman dev_err(&dev->dev, "%s - Out of memory\n", __func__); 24330de9a702SOliver Neukum status = -ENOMEM; 24340de9a702SOliver Neukum i--; /* don't follow NULL pointer cleaning up */ 24350de9a702SOliver Neukum goto error; 24363f542974SPaul B Schroeder } 24373f542974SPaul B Schroeder 2438880af9dbSAlan Cox /* Initialize all port interrupt end point to port 0 int 2439880af9dbSAlan Cox * endpoint. Our device has only one interrupt end point 2440880af9dbSAlan Cox * common to all port */ 24413f542974SPaul B Schroeder 24423f542974SPaul B Schroeder mos7840_port->port = serial->port[i]; 24433f542974SPaul B Schroeder mos7840_set_port_private(serial->port[i], mos7840_port); 24440de9a702SOliver Neukum spin_lock_init(&mos7840_port->pool_lock); 24453f542974SPaul B Schroeder 244637768adfSTony Cook /* minor is not initialised until later by 244737768adfSTony Cook * usb-serial.c:get_free_serial() and cannot therefore be used 244837768adfSTony Cook * to index device instances */ 244937768adfSTony Cook mos7840_port->port_num = i + 1; 245037768adfSTony Cook dbg ("serial->port[i]->number = %d", serial->port[i]->number); 245137768adfSTony Cook dbg ("serial->port[i]->serial->minor = %d", serial->port[i]->serial->minor); 245237768adfSTony Cook dbg ("mos7840_port->port_num = %d", mos7840_port->port_num); 245337768adfSTony Cook dbg ("serial->minor = %d", serial->minor); 24543f542974SPaul B Schroeder 24553f542974SPaul B Schroeder if (mos7840_port->port_num == 1) { 24563f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0x0; 24573f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0x1; 24583f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x4; 24593f542974SPaul B Schroeder } else if ((mos7840_port->port_num == 2) 24600de9a702SOliver Neukum && (serial->num_ports == 4)) { 24613f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0x8; 24623f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0x9; 24633f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x16; 24643f542974SPaul B Schroeder } else if ((mos7840_port->port_num == 2) 24650de9a702SOliver Neukum && (serial->num_ports == 2)) { 24663f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0xa; 24673f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0xb; 24683f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x19; 24693f542974SPaul B Schroeder } else if ((mos7840_port->port_num == 3) 24700de9a702SOliver Neukum && (serial->num_ports == 4)) { 24713f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0xa; 24723f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0xb; 24733f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x19; 24743f542974SPaul B Schroeder } else if ((mos7840_port->port_num == 4) 24750de9a702SOliver Neukum && (serial->num_ports == 4)) { 24763f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0xc; 24773f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0xd; 24783f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x1c; 24793f542974SPaul B Schroeder } 24803f542974SPaul B Schroeder mos7840_dump_serial_port(mos7840_port); 24813f542974SPaul B Schroeder mos7840_set_port_private(serial->port[i], mos7840_port); 24823f542974SPaul B Schroeder 2483880af9dbSAlan Cox /* enable rx_disable bit in control register */ 2484880af9dbSAlan Cox status = mos7840_get_reg_sync(serial->port[i], 24853f542974SPaul B Schroeder mos7840_port->ControlRegOffset, &Data); 24863f542974SPaul B Schroeder if (status < 0) { 248784fe6e79STony Cook dbg("Reading ControlReg failed status-0x%x", status); 24883f542974SPaul B Schroeder break; 24893f542974SPaul B Schroeder } else 249084fe6e79STony Cook dbg("ControlReg Reading success val is %x, status%d", 24913f542974SPaul B Schroeder Data, status); 2492880af9dbSAlan Cox Data |= 0x08; /* setting driver done bit */ 2493880af9dbSAlan Cox Data |= 0x04; /* sp1_bit to have cts change reflect in 2494880af9dbSAlan Cox modem status reg */ 24953f542974SPaul B Schroeder 2496880af9dbSAlan Cox /* Data |= 0x20; //rx_disable bit */ 2497880af9dbSAlan Cox status = mos7840_set_reg_sync(serial->port[i], 24983f542974SPaul B Schroeder mos7840_port->ControlRegOffset, Data); 24993f542974SPaul B Schroeder if (status < 0) { 250084fe6e79STony Cook dbg("Writing ControlReg failed(rx_disable) status-0x%x", status); 25013f542974SPaul B Schroeder break; 25023f542974SPaul B Schroeder } else 250384fe6e79STony Cook dbg("ControlReg Writing success(rx_disable) status%d", 25043f542974SPaul B Schroeder status); 25053f542974SPaul B Schroeder 2506880af9dbSAlan Cox /* Write default values in DCR (i.e 0x01 in DCR0, 0x05 in DCR2 2507880af9dbSAlan Cox and 0x24 in DCR3 */ 25083f542974SPaul B Schroeder Data = 0x01; 2509880af9dbSAlan Cox status = mos7840_set_reg_sync(serial->port[i], 2510880af9dbSAlan Cox (__u16) (mos7840_port->DcrRegOffset + 0), Data); 25113f542974SPaul B Schroeder if (status < 0) { 251284fe6e79STony Cook dbg("Writing DCR0 failed status-0x%x", status); 25133f542974SPaul B Schroeder break; 25143f542974SPaul B Schroeder } else 251584fe6e79STony Cook dbg("DCR0 Writing success status%d", status); 25163f542974SPaul B Schroeder 25173f542974SPaul B Schroeder Data = 0x05; 2518880af9dbSAlan Cox status = mos7840_set_reg_sync(serial->port[i], 2519880af9dbSAlan Cox (__u16) (mos7840_port->DcrRegOffset + 1), Data); 25203f542974SPaul B Schroeder if (status < 0) { 252184fe6e79STony Cook dbg("Writing DCR1 failed status-0x%x", status); 25223f542974SPaul B Schroeder break; 25233f542974SPaul B Schroeder } else 252484fe6e79STony Cook dbg("DCR1 Writing success status%d", status); 25253f542974SPaul B Schroeder 25263f542974SPaul B Schroeder Data = 0x24; 2527880af9dbSAlan Cox status = mos7840_set_reg_sync(serial->port[i], 2528880af9dbSAlan Cox (__u16) (mos7840_port->DcrRegOffset + 2), Data); 25293f542974SPaul B Schroeder if (status < 0) { 253084fe6e79STony Cook dbg("Writing DCR2 failed status-0x%x", status); 25313f542974SPaul B Schroeder break; 25323f542974SPaul B Schroeder } else 253384fe6e79STony Cook dbg("DCR2 Writing success status%d", status); 25343f542974SPaul B Schroeder 2535880af9dbSAlan Cox /* write values in clkstart0x0 and clkmulti 0x20 */ 25363f542974SPaul B Schroeder Data = 0x0; 2537880af9dbSAlan Cox status = mos7840_set_reg_sync(serial->port[i], 25383f542974SPaul B Schroeder CLK_START_VALUE_REGISTER, Data); 25393f542974SPaul B Schroeder if (status < 0) { 254084fe6e79STony Cook dbg("Writing CLK_START_VALUE_REGISTER failed status-0x%x", status); 25413f542974SPaul B Schroeder break; 25423f542974SPaul B Schroeder } else 254384fe6e79STony Cook dbg("CLK_START_VALUE_REGISTER Writing success status%d", status); 25443f542974SPaul B Schroeder 25453f542974SPaul B Schroeder Data = 0x20; 2546880af9dbSAlan Cox status = mos7840_set_reg_sync(serial->port[i], 2547880af9dbSAlan Cox CLK_MULTI_REGISTER, Data); 25483f542974SPaul B Schroeder if (status < 0) { 254984fe6e79STony Cook dbg("Writing CLK_MULTI_REGISTER failed status-0x%x", 25503f542974SPaul B Schroeder status); 25510de9a702SOliver Neukum goto error; 25523f542974SPaul B Schroeder } else 255384fe6e79STony Cook dbg("CLK_MULTI_REGISTER Writing success status%d", 25543f542974SPaul B Schroeder status); 25553f542974SPaul B Schroeder 2556880af9dbSAlan Cox /* write value 0x0 to scratchpad register */ 25573f542974SPaul B Schroeder Data = 0x00; 2558880af9dbSAlan Cox status = mos7840_set_uart_reg(serial->port[i], 2559880af9dbSAlan Cox SCRATCH_PAD_REGISTER, Data); 25603f542974SPaul B Schroeder if (status < 0) { 256184fe6e79STony Cook dbg("Writing SCRATCH_PAD_REGISTER failed status-0x%x", 25623f542974SPaul B Schroeder status); 25633f542974SPaul B Schroeder break; 25643f542974SPaul B Schroeder } else 256584fe6e79STony Cook dbg("SCRATCH_PAD_REGISTER Writing success status%d", 25663f542974SPaul B Schroeder status); 25673f542974SPaul B Schroeder 2568880af9dbSAlan Cox /* Zero Length flag register */ 25693f542974SPaul B Schroeder if ((mos7840_port->port_num != 1) 25700de9a702SOliver Neukum && (serial->num_ports == 2)) { 25713f542974SPaul B Schroeder 25723f542974SPaul B Schroeder Data = 0xff; 25733f542974SPaul B Schroeder status = mos7840_set_reg_sync(serial->port[i], 25743f542974SPaul B Schroeder (__u16) (ZLP_REG1 + 2575880af9dbSAlan Cox ((__u16)mos7840_port->port_num)), Data); 257684fe6e79STony Cook dbg("ZLIP offset %x", 25773f542974SPaul B Schroeder (__u16) (ZLP_REG1 + 25783f542974SPaul B Schroeder ((__u16) mos7840_port->port_num))); 25793f542974SPaul B Schroeder if (status < 0) { 258084fe6e79STony Cook dbg("Writing ZLP_REG%d failed status-0x%x", 25813f542974SPaul B Schroeder i + 2, status); 25823f542974SPaul B Schroeder break; 25833f542974SPaul B Schroeder } else 258484fe6e79STony Cook dbg("ZLP_REG%d Writing success status%d", 25853f542974SPaul B Schroeder i + 2, status); 25863f542974SPaul B Schroeder } else { 25873f542974SPaul B Schroeder Data = 0xff; 25883f542974SPaul B Schroeder status = mos7840_set_reg_sync(serial->port[i], 25893f542974SPaul B Schroeder (__u16) (ZLP_REG1 + 2590880af9dbSAlan Cox ((__u16)mos7840_port->port_num) - 0x1), Data); 259184fe6e79STony Cook dbg("ZLIP offset %x", 25923f542974SPaul B Schroeder (__u16) (ZLP_REG1 + 25933f542974SPaul B Schroeder ((__u16) mos7840_port->port_num) - 0x1)); 25943f542974SPaul B Schroeder if (status < 0) { 259584fe6e79STony Cook dbg("Writing ZLP_REG%d failed status-0x%x", 25963f542974SPaul B Schroeder i + 1, status); 25973f542974SPaul B Schroeder break; 25983f542974SPaul B Schroeder } else 259984fe6e79STony Cook dbg("ZLP_REG%d Writing success status%d", 26003f542974SPaul B Schroeder i + 1, status); 26013f542974SPaul B Schroeder 26023f542974SPaul B Schroeder } 26030de9a702SOliver Neukum mos7840_port->control_urb = usb_alloc_urb(0, GFP_KERNEL); 26043f542974SPaul B Schroeder mos7840_port->ctrl_buf = kmalloc(16, GFP_KERNEL); 2605880af9dbSAlan Cox mos7840_port->dr = kmalloc(sizeof(struct usb_ctrlrequest), 2606880af9dbSAlan Cox GFP_KERNEL); 2607880af9dbSAlan Cox if (!mos7840_port->control_urb || !mos7840_port->ctrl_buf || 2608880af9dbSAlan Cox !mos7840_port->dr) { 26090de9a702SOliver Neukum status = -ENOMEM; 26100de9a702SOliver Neukum goto error; 26110de9a702SOliver Neukum } 26123f542974SPaul B Schroeder } 261384fe6e79STony Cook dbg ("mos7840_startup: all ports configured..........."); 26143f542974SPaul B Schroeder 2615880af9dbSAlan Cox /* Zero Length flag enable */ 26163f542974SPaul B Schroeder Data = 0x0f; 26173f542974SPaul B Schroeder status = mos7840_set_reg_sync(serial->port[0], ZLP_REG5, Data); 26183f542974SPaul B Schroeder if (status < 0) { 261984fe6e79STony Cook dbg("Writing ZLP_REG5 failed status-0x%x", status); 26207ced46c3SRoel Kluin goto error; 26213f542974SPaul B Schroeder } else 262284fe6e79STony Cook dbg("ZLP_REG5 Writing success status%d", status); 26233f542974SPaul B Schroeder 26243f542974SPaul B Schroeder /* setting configuration feature to one */ 26253f542974SPaul B Schroeder usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), 262697c4965dSAl Viro (__u8) 0x03, 0x00, 0x01, 0x00, NULL, 0x00, 5 * HZ); 26273f542974SPaul B Schroeder return 0; 26280de9a702SOliver Neukum error: 26290de9a702SOliver Neukum for (/* nothing */; i >= 0; i--) { 26300de9a702SOliver Neukum mos7840_port = mos7840_get_port_private(serial->port[i]); 26310de9a702SOliver Neukum 26320de9a702SOliver Neukum kfree(mos7840_port->dr); 26330de9a702SOliver Neukum kfree(mos7840_port->ctrl_buf); 26340de9a702SOliver Neukum usb_free_urb(mos7840_port->control_urb); 26350de9a702SOliver Neukum kfree(mos7840_port); 26360de9a702SOliver Neukum serial->port[i] = NULL; 26370de9a702SOliver Neukum } 26380de9a702SOliver Neukum return status; 26393f542974SPaul B Schroeder } 26403f542974SPaul B Schroeder 26413f542974SPaul B Schroeder /**************************************************************************** 2642f9c99bb8SAlan Stern * mos7840_disconnect 26433f542974SPaul B Schroeder * This function is called whenever the device is removed from the usb bus. 26443f542974SPaul B Schroeder ****************************************************************************/ 26453f542974SPaul B Schroeder 2646f9c99bb8SAlan Stern static void mos7840_disconnect(struct usb_serial *serial) 26473f542974SPaul B Schroeder { 26483f542974SPaul B Schroeder int i; 26490de9a702SOliver Neukum unsigned long flags; 26503f542974SPaul B Schroeder struct moschip_port *mos7840_port; 2651f9c99bb8SAlan Stern dbg("%s", " disconnect :entering.........."); 26523f542974SPaul B Schroeder 26533f542974SPaul B Schroeder if (!serial) { 265484fe6e79STony Cook dbg("%s", "Invalid Handler"); 26553f542974SPaul B Schroeder return; 26563f542974SPaul B Schroeder } 26573f542974SPaul B Schroeder 26583f542974SPaul B Schroeder /* check for the ports to be closed,close the ports and disconnect */ 26593f542974SPaul B Schroeder 26603f542974SPaul B Schroeder /* free private structure allocated for serial port * 26613f542974SPaul B Schroeder * stop reads and writes on all ports */ 26623f542974SPaul B Schroeder 26633f542974SPaul B Schroeder for (i = 0; i < serial->num_ports; ++i) { 26643f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(serial->port[i]); 266537768adfSTony Cook dbg ("mos7840_port %d = %p", i, mos7840_port); 266637768adfSTony Cook if (mos7840_port) { 26670de9a702SOliver Neukum spin_lock_irqsave(&mos7840_port->pool_lock, flags); 26680de9a702SOliver Neukum mos7840_port->zombie = 1; 26690de9a702SOliver Neukum spin_unlock_irqrestore(&mos7840_port->pool_lock, flags); 26703f542974SPaul B Schroeder usb_kill_urb(mos7840_port->control_urb); 2671f9c99bb8SAlan Stern } 2672f9c99bb8SAlan Stern } 2673f9c99bb8SAlan Stern 2674f9c99bb8SAlan Stern dbg("%s", "Thank u :: "); 2675f9c99bb8SAlan Stern 2676f9c99bb8SAlan Stern } 2677f9c99bb8SAlan Stern 2678f9c99bb8SAlan Stern /**************************************************************************** 2679f9c99bb8SAlan Stern * mos7840_release 2680f9c99bb8SAlan Stern * This function is called when the usb_serial structure is freed. 2681f9c99bb8SAlan Stern ****************************************************************************/ 2682f9c99bb8SAlan Stern 2683f9c99bb8SAlan Stern static void mos7840_release(struct usb_serial *serial) 2684f9c99bb8SAlan Stern { 2685f9c99bb8SAlan Stern int i; 2686f9c99bb8SAlan Stern struct moschip_port *mos7840_port; 2687f9c99bb8SAlan Stern dbg("%s", " release :entering.........."); 2688f9c99bb8SAlan Stern 2689f9c99bb8SAlan Stern if (!serial) { 2690f9c99bb8SAlan Stern dbg("%s", "Invalid Handler"); 2691f9c99bb8SAlan Stern return; 2692f9c99bb8SAlan Stern } 2693f9c99bb8SAlan Stern 2694f9c99bb8SAlan Stern /* check for the ports to be closed,close the ports and disconnect */ 2695f9c99bb8SAlan Stern 2696f9c99bb8SAlan Stern /* free private structure allocated for serial port * 2697f9c99bb8SAlan Stern * stop reads and writes on all ports */ 2698f9c99bb8SAlan Stern 2699f9c99bb8SAlan Stern for (i = 0; i < serial->num_ports; ++i) { 2700f9c99bb8SAlan Stern mos7840_port = mos7840_get_port_private(serial->port[i]); 2701f9c99bb8SAlan Stern dbg("mos7840_port %d = %p", i, mos7840_port); 2702f9c99bb8SAlan Stern if (mos7840_port) { 27030de9a702SOliver Neukum kfree(mos7840_port->ctrl_buf); 27040de9a702SOliver Neukum kfree(mos7840_port->dr); 27053f542974SPaul B Schroeder kfree(mos7840_port); 270637768adfSTony Cook } 27073f542974SPaul B Schroeder } 27083f542974SPaul B Schroeder 270984fe6e79STony Cook dbg("%s", "Thank u :: "); 27103f542974SPaul B Schroeder 27113f542974SPaul B Schroeder } 27123f542974SPaul B Schroeder 2713d9b1b787SJohannes Hölzl static struct usb_driver io_driver = { 2714d9b1b787SJohannes Hölzl .name = "mos7840", 2715d9b1b787SJohannes Hölzl .probe = usb_serial_probe, 2716d9b1b787SJohannes Hölzl .disconnect = usb_serial_disconnect, 2717d9b1b787SJohannes Hölzl .id_table = moschip_id_table_combined, 2718d9b1b787SJohannes Hölzl .no_dynamic_id = 1, 2719d9b1b787SJohannes Hölzl }; 2720d9b1b787SJohannes Hölzl 27213f542974SPaul B Schroeder static struct usb_serial_driver moschip7840_4port_device = { 27223f542974SPaul B Schroeder .driver = { 27233f542974SPaul B Schroeder .owner = THIS_MODULE, 27243f542974SPaul B Schroeder .name = "mos7840", 27253f542974SPaul B Schroeder }, 27263f542974SPaul B Schroeder .description = DRIVER_DESC, 2727d9b1b787SJohannes Hölzl .usb_driver = &io_driver, 27283f542974SPaul B Schroeder .id_table = moschip_port_id_table, 27293f542974SPaul B Schroeder .num_ports = 4, 27303f542974SPaul B Schroeder .open = mos7840_open, 27313f542974SPaul B Schroeder .close = mos7840_close, 27323f542974SPaul B Schroeder .write = mos7840_write, 27333f542974SPaul B Schroeder .write_room = mos7840_write_room, 27343f542974SPaul B Schroeder .chars_in_buffer = mos7840_chars_in_buffer, 27353f542974SPaul B Schroeder .throttle = mos7840_throttle, 27363f542974SPaul B Schroeder .unthrottle = mos7840_unthrottle, 27373f542974SPaul B Schroeder .calc_num_ports = mos7840_calc_num_ports, 27383f542974SPaul B Schroeder #ifdef MCSSerialProbe 27393f542974SPaul B Schroeder .probe = mos7840_serial_probe, 27403f542974SPaul B Schroeder #endif 27413f542974SPaul B Schroeder .ioctl = mos7840_ioctl, 27423f542974SPaul B Schroeder .set_termios = mos7840_set_termios, 27433f542974SPaul B Schroeder .break_ctl = mos7840_break, 27443f542974SPaul B Schroeder .tiocmget = mos7840_tiocmget, 27453f542974SPaul B Schroeder .tiocmset = mos7840_tiocmset, 27463f542974SPaul B Schroeder .attach = mos7840_startup, 2747f9c99bb8SAlan Stern .disconnect = mos7840_disconnect, 2748f9c99bb8SAlan Stern .release = mos7840_release, 27493f542974SPaul B Schroeder .read_bulk_callback = mos7840_bulk_in_callback, 27503f542974SPaul B Schroeder .read_int_callback = mos7840_interrupt_callback, 27513f542974SPaul B Schroeder }; 27523f542974SPaul B Schroeder 27533f542974SPaul B Schroeder /**************************************************************************** 27543f542974SPaul B Schroeder * moschip7840_init 27553f542974SPaul B Schroeder * This is called by the module subsystem, or on startup to initialize us 27563f542974SPaul B Schroeder ****************************************************************************/ 27573f542974SPaul B Schroeder static int __init moschip7840_init(void) 27583f542974SPaul B Schroeder { 27593f542974SPaul B Schroeder int retval; 27603f542974SPaul B Schroeder 276184fe6e79STony Cook dbg("%s", " mos7840_init :entering.........."); 27623f542974SPaul B Schroeder 27633f542974SPaul B Schroeder /* Register with the usb serial */ 27643f542974SPaul B Schroeder retval = usb_serial_register(&moschip7840_4port_device); 27653f542974SPaul B Schroeder 27663f542974SPaul B Schroeder if (retval) 27673f542974SPaul B Schroeder goto failed_port_device_register; 27683f542974SPaul B Schroeder 276984fe6e79STony Cook dbg("%s", "Entering..."); 2770c197a8dbSGreg Kroah-Hartman printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":" 2771c197a8dbSGreg Kroah-Hartman DRIVER_DESC "\n"); 27723f542974SPaul B Schroeder 27733f542974SPaul B Schroeder /* Register with the usb */ 27743f542974SPaul B Schroeder retval = usb_register(&io_driver); 27753f542974SPaul B Schroeder if (retval == 0) { 277684fe6e79STony Cook dbg("%s", "Leaving..."); 27773f542974SPaul B Schroeder return 0; 27783f542974SPaul B Schroeder } 27793f542974SPaul B Schroeder usb_serial_deregister(&moschip7840_4port_device); 27803f542974SPaul B Schroeder failed_port_device_register: 27813f542974SPaul B Schroeder return retval; 27823f542974SPaul B Schroeder } 27833f542974SPaul B Schroeder 27843f542974SPaul B Schroeder /**************************************************************************** 27853f542974SPaul B Schroeder * moschip7840_exit 27863f542974SPaul B Schroeder * Called when the driver is about to be unloaded. 27873f542974SPaul B Schroeder ****************************************************************************/ 27883f542974SPaul B Schroeder static void __exit moschip7840_exit(void) 27893f542974SPaul B Schroeder { 27903f542974SPaul B Schroeder 279184fe6e79STony Cook dbg("%s", " mos7840_exit :entering.........."); 27923f542974SPaul B Schroeder 27933f542974SPaul B Schroeder usb_deregister(&io_driver); 27943f542974SPaul B Schroeder 27953f542974SPaul B Schroeder usb_serial_deregister(&moschip7840_4port_device); 27963f542974SPaul B Schroeder 279784fe6e79STony Cook dbg("%s", "Entering..."); 27983f542974SPaul B Schroeder } 27993f542974SPaul B Schroeder 28003f542974SPaul B Schroeder module_init(moschip7840_init); 28013f542974SPaul B Schroeder module_exit(moschip7840_exit); 28023f542974SPaul B Schroeder 28033f542974SPaul B Schroeder /* Module information */ 28043f542974SPaul B Schroeder MODULE_DESCRIPTION(DRIVER_DESC); 28053f542974SPaul B Schroeder MODULE_LICENSE("GPL"); 28063f542974SPaul B Schroeder 28073f542974SPaul B Schroeder module_param(debug, bool, S_IRUGO | S_IWUSR); 28083f542974SPaul B Schroeder MODULE_PARM_DESC(debug, "Debug enabled or not"); 2809