1*3f542974SPaul B Schroeder /* 2*3f542974SPaul B Schroeder * This program is free software; you can redistribute it and/or modify 3*3f542974SPaul B Schroeder * it under the terms of the GNU General Public License as published by 4*3f542974SPaul B Schroeder * the Free Software Foundation; either version 2 of the License, or 5*3f542974SPaul B Schroeder * (at your option) any later version. 6*3f542974SPaul B Schroeder * 7*3f542974SPaul B Schroeder * This program is distributed in the hope that it will be useful, 8*3f542974SPaul B Schroeder * but WITHOUT ANY WARRANTY; without even the implied warranty of 9*3f542974SPaul B Schroeder * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 10*3f542974SPaul B Schroeder * GNU General Public License for more details. 11*3f542974SPaul B Schroeder * 12*3f542974SPaul B Schroeder * You should have received a copy of the GNU General Public License 13*3f542974SPaul B Schroeder * along with this program; if not, write to the Free Software 14*3f542974SPaul B Schroeder * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 15*3f542974SPaul B Schroeder * 16*3f542974SPaul B Schroeder * Clean ups from Moschip version and a few ioctl implementations by: 17*3f542974SPaul B Schroeder * Paul B Schroeder <pschroeder "at" uplogix "dot" com> 18*3f542974SPaul B Schroeder * 19*3f542974SPaul B Schroeder * Originally based on drivers/usb/serial/io_edgeport.c which is: 20*3f542974SPaul B Schroeder * Copyright (C) 2000 Inside Out Networks, All rights reserved. 21*3f542974SPaul B Schroeder * Copyright (C) 2001-2002 Greg Kroah-Hartman <greg@kroah.com> 22*3f542974SPaul B Schroeder * 23*3f542974SPaul B Schroeder */ 24*3f542974SPaul B Schroeder 25*3f542974SPaul B Schroeder #include <linux/kernel.h> 26*3f542974SPaul B Schroeder #include <linux/errno.h> 27*3f542974SPaul B Schroeder #include <linux/init.h> 28*3f542974SPaul B Schroeder #include <linux/slab.h> 29*3f542974SPaul B Schroeder #include <linux/tty.h> 30*3f542974SPaul B Schroeder #include <linux/tty_driver.h> 31*3f542974SPaul B Schroeder #include <linux/tty_flip.h> 32*3f542974SPaul B Schroeder #include <linux/module.h> 33*3f542974SPaul B Schroeder #include <linux/serial.h> 34*3f542974SPaul B Schroeder #include <linux/usb.h> 35*3f542974SPaul B Schroeder #include <linux/usb/serial.h> 36*3f542974SPaul B Schroeder #include <asm/uaccess.h> 37*3f542974SPaul B Schroeder 38*3f542974SPaul B Schroeder /* 39*3f542974SPaul B Schroeder * Version Information 40*3f542974SPaul B Schroeder */ 41*3f542974SPaul B Schroeder #define DRIVER_VERSION "1.3.1" 42*3f542974SPaul B Schroeder #define DRIVER_DESC "Moschip 7840/7820 USB Serial Driver" 43*3f542974SPaul B Schroeder 44*3f542974SPaul B Schroeder /* 45*3f542974SPaul B Schroeder * 16C50 UART register defines 46*3f542974SPaul B Schroeder */ 47*3f542974SPaul B Schroeder 48*3f542974SPaul B Schroeder #define LCR_BITS_5 0x00 /* 5 bits/char */ 49*3f542974SPaul B Schroeder #define LCR_BITS_6 0x01 /* 6 bits/char */ 50*3f542974SPaul B Schroeder #define LCR_BITS_7 0x02 /* 7 bits/char */ 51*3f542974SPaul B Schroeder #define LCR_BITS_8 0x03 /* 8 bits/char */ 52*3f542974SPaul B Schroeder #define LCR_BITS_MASK 0x03 /* Mask for bits/char field */ 53*3f542974SPaul B Schroeder 54*3f542974SPaul B Schroeder #define LCR_STOP_1 0x00 /* 1 stop bit */ 55*3f542974SPaul B Schroeder #define LCR_STOP_1_5 0x04 /* 1.5 stop bits (if 5 bits/char) */ 56*3f542974SPaul B Schroeder #define LCR_STOP_2 0x04 /* 2 stop bits (if 6-8 bits/char) */ 57*3f542974SPaul B Schroeder #define LCR_STOP_MASK 0x04 /* Mask for stop bits field */ 58*3f542974SPaul B Schroeder 59*3f542974SPaul B Schroeder #define LCR_PAR_NONE 0x00 /* No parity */ 60*3f542974SPaul B Schroeder #define LCR_PAR_ODD 0x08 /* Odd parity */ 61*3f542974SPaul B Schroeder #define LCR_PAR_EVEN 0x18 /* Even parity */ 62*3f542974SPaul B Schroeder #define LCR_PAR_MARK 0x28 /* Force parity bit to 1 */ 63*3f542974SPaul B Schroeder #define LCR_PAR_SPACE 0x38 /* Force parity bit to 0 */ 64*3f542974SPaul B Schroeder #define LCR_PAR_MASK 0x38 /* Mask for parity field */ 65*3f542974SPaul B Schroeder 66*3f542974SPaul B Schroeder #define LCR_SET_BREAK 0x40 /* Set Break condition */ 67*3f542974SPaul B Schroeder #define LCR_DL_ENABLE 0x80 /* Enable access to divisor latch */ 68*3f542974SPaul B Schroeder 69*3f542974SPaul B Schroeder #define MCR_DTR 0x01 /* Assert DTR */ 70*3f542974SPaul B Schroeder #define MCR_RTS 0x02 /* Assert RTS */ 71*3f542974SPaul B Schroeder #define MCR_OUT1 0x04 /* Loopback only: Sets state of RI */ 72*3f542974SPaul B Schroeder #define MCR_MASTER_IE 0x08 /* Enable interrupt outputs */ 73*3f542974SPaul B Schroeder #define MCR_LOOPBACK 0x10 /* Set internal (digital) loopback mode */ 74*3f542974SPaul B Schroeder #define MCR_XON_ANY 0x20 /* Enable any char to exit XOFF mode */ 75*3f542974SPaul B Schroeder 76*3f542974SPaul B Schroeder #define MOS7840_MSR_CTS 0x10 /* Current state of CTS */ 77*3f542974SPaul B Schroeder #define MOS7840_MSR_DSR 0x20 /* Current state of DSR */ 78*3f542974SPaul B Schroeder #define MOS7840_MSR_RI 0x40 /* Current state of RI */ 79*3f542974SPaul B Schroeder #define MOS7840_MSR_CD 0x80 /* Current state of CD */ 80*3f542974SPaul B Schroeder 81*3f542974SPaul B Schroeder /* 82*3f542974SPaul B Schroeder * Defines used for sending commands to port 83*3f542974SPaul B Schroeder */ 84*3f542974SPaul B Schroeder 85*3f542974SPaul B Schroeder #define WAIT_FOR_EVER (HZ * 0 ) /* timeout urb is wait for ever */ 86*3f542974SPaul B Schroeder #define MOS_WDR_TIMEOUT (HZ * 5 ) /* default urb timeout */ 87*3f542974SPaul B Schroeder 88*3f542974SPaul B Schroeder #define MOS_PORT1 0x0200 89*3f542974SPaul B Schroeder #define MOS_PORT2 0x0300 90*3f542974SPaul B Schroeder #define MOS_VENREG 0x0000 91*3f542974SPaul B Schroeder #define MOS_MAX_PORT 0x02 92*3f542974SPaul B Schroeder #define MOS_WRITE 0x0E 93*3f542974SPaul B Schroeder #define MOS_READ 0x0D 94*3f542974SPaul B Schroeder 95*3f542974SPaul B Schroeder /* Requests */ 96*3f542974SPaul B Schroeder #define MCS_RD_RTYPE 0xC0 97*3f542974SPaul B Schroeder #define MCS_WR_RTYPE 0x40 98*3f542974SPaul B Schroeder #define MCS_RDREQ 0x0D 99*3f542974SPaul B Schroeder #define MCS_WRREQ 0x0E 100*3f542974SPaul B Schroeder #define MCS_CTRL_TIMEOUT 500 101*3f542974SPaul B Schroeder #define VENDOR_READ_LENGTH (0x01) 102*3f542974SPaul B Schroeder 103*3f542974SPaul B Schroeder #define MAX_NAME_LEN 64 104*3f542974SPaul B Schroeder 105*3f542974SPaul B Schroeder #define ZLP_REG1 0x3A //Zero_Flag_Reg1 58 106*3f542974SPaul B Schroeder #define ZLP_REG5 0x3E //Zero_Flag_Reg5 62 107*3f542974SPaul B Schroeder 108*3f542974SPaul B Schroeder /* For higher baud Rates use TIOCEXBAUD */ 109*3f542974SPaul B Schroeder #define TIOCEXBAUD 0x5462 110*3f542974SPaul B Schroeder 111*3f542974SPaul B Schroeder /* vendor id and device id defines */ 112*3f542974SPaul B Schroeder 113*3f542974SPaul B Schroeder #define USB_VENDOR_ID_MOSCHIP 0x9710 114*3f542974SPaul B Schroeder #define MOSCHIP_DEVICE_ID_7840 0x7840 115*3f542974SPaul B Schroeder #define MOSCHIP_DEVICE_ID_7820 0x7820 116*3f542974SPaul B Schroeder 117*3f542974SPaul B Schroeder /* Interrupt Rotinue Defines */ 118*3f542974SPaul B Schroeder 119*3f542974SPaul B Schroeder #define SERIAL_IIR_RLS 0x06 120*3f542974SPaul B Schroeder #define SERIAL_IIR_MS 0x00 121*3f542974SPaul B Schroeder 122*3f542974SPaul B Schroeder /* 123*3f542974SPaul B Schroeder * Emulation of the bit mask on the LINE STATUS REGISTER. 124*3f542974SPaul B Schroeder */ 125*3f542974SPaul B Schroeder #define SERIAL_LSR_DR 0x0001 126*3f542974SPaul B Schroeder #define SERIAL_LSR_OE 0x0002 127*3f542974SPaul B Schroeder #define SERIAL_LSR_PE 0x0004 128*3f542974SPaul B Schroeder #define SERIAL_LSR_FE 0x0008 129*3f542974SPaul B Schroeder #define SERIAL_LSR_BI 0x0010 130*3f542974SPaul B Schroeder 131*3f542974SPaul B Schroeder #define MOS_MSR_DELTA_CTS 0x10 132*3f542974SPaul B Schroeder #define MOS_MSR_DELTA_DSR 0x20 133*3f542974SPaul B Schroeder #define MOS_MSR_DELTA_RI 0x40 134*3f542974SPaul B Schroeder #define MOS_MSR_DELTA_CD 0x80 135*3f542974SPaul B Schroeder 136*3f542974SPaul B Schroeder // Serial Port register Address 137*3f542974SPaul B Schroeder #define INTERRUPT_ENABLE_REGISTER ((__u16)(0x01)) 138*3f542974SPaul B Schroeder #define FIFO_CONTROL_REGISTER ((__u16)(0x02)) 139*3f542974SPaul B Schroeder #define LINE_CONTROL_REGISTER ((__u16)(0x03)) 140*3f542974SPaul B Schroeder #define MODEM_CONTROL_REGISTER ((__u16)(0x04)) 141*3f542974SPaul B Schroeder #define LINE_STATUS_REGISTER ((__u16)(0x05)) 142*3f542974SPaul B Schroeder #define MODEM_STATUS_REGISTER ((__u16)(0x06)) 143*3f542974SPaul B Schroeder #define SCRATCH_PAD_REGISTER ((__u16)(0x07)) 144*3f542974SPaul B Schroeder #define DIVISOR_LATCH_LSB ((__u16)(0x00)) 145*3f542974SPaul B Schroeder #define DIVISOR_LATCH_MSB ((__u16)(0x01)) 146*3f542974SPaul B Schroeder 147*3f542974SPaul B Schroeder #define CLK_MULTI_REGISTER ((__u16)(0x02)) 148*3f542974SPaul B Schroeder #define CLK_START_VALUE_REGISTER ((__u16)(0x03)) 149*3f542974SPaul B Schroeder 150*3f542974SPaul B Schroeder #define SERIAL_LCR_DLAB ((__u16)(0x0080)) 151*3f542974SPaul B Schroeder 152*3f542974SPaul B Schroeder /* 153*3f542974SPaul B Schroeder * URB POOL related defines 154*3f542974SPaul B Schroeder */ 155*3f542974SPaul B Schroeder #define NUM_URBS 16 /* URB Count */ 156*3f542974SPaul B Schroeder #define URB_TRANSFER_BUFFER_SIZE 32 /* URB Size */ 157*3f542974SPaul B Schroeder 158*3f542974SPaul B Schroeder 159*3f542974SPaul B Schroeder static struct usb_device_id moschip_port_id_table[] = { 160*3f542974SPaul B Schroeder {USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)}, 161*3f542974SPaul B Schroeder {USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)}, 162*3f542974SPaul B Schroeder {} /* terminating entry */ 163*3f542974SPaul B Schroeder }; 164*3f542974SPaul B Schroeder 165*3f542974SPaul B Schroeder static __devinitdata struct usb_device_id moschip_id_table_combined[] = { 166*3f542974SPaul B Schroeder {USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)}, 167*3f542974SPaul B Schroeder {USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)}, 168*3f542974SPaul B Schroeder {} /* terminating entry */ 169*3f542974SPaul B Schroeder }; 170*3f542974SPaul B Schroeder 171*3f542974SPaul B Schroeder MODULE_DEVICE_TABLE(usb, moschip_id_table_combined); 172*3f542974SPaul B Schroeder 173*3f542974SPaul B Schroeder /* This structure holds all of the local port information */ 174*3f542974SPaul B Schroeder 175*3f542974SPaul B Schroeder struct moschip_port { 176*3f542974SPaul B Schroeder int port_num; /*Actual port number in the device(1,2,etc) */ 177*3f542974SPaul B Schroeder struct urb *write_urb; /* write URB for this port */ 178*3f542974SPaul B Schroeder struct urb *read_urb; /* read URB for this port */ 179*3f542974SPaul B Schroeder __u8 shadowLCR; /* last LCR value received */ 180*3f542974SPaul B Schroeder __u8 shadowMCR; /* last MCR value received */ 181*3f542974SPaul B Schroeder char open; 182*3f542974SPaul B Schroeder wait_queue_head_t wait_chase; /* for handling sleeping while waiting for chase to finish */ 183*3f542974SPaul B Schroeder wait_queue_head_t delta_msr_wait; /* for handling sleeping while waiting for msr change to happen */ 184*3f542974SPaul B Schroeder int delta_msr_cond; 185*3f542974SPaul B Schroeder struct async_icount icount; 186*3f542974SPaul B Schroeder struct usb_serial_port *port; /* loop back to the owner of this object */ 187*3f542974SPaul B Schroeder 188*3f542974SPaul B Schroeder /*Offsets */ 189*3f542974SPaul B Schroeder __u8 SpRegOffset; 190*3f542974SPaul B Schroeder __u8 ControlRegOffset; 191*3f542974SPaul B Schroeder __u8 DcrRegOffset; 192*3f542974SPaul B Schroeder //for processing control URBS in interrupt context 193*3f542974SPaul B Schroeder struct urb *control_urb; 194*3f542974SPaul B Schroeder char *ctrl_buf; 195*3f542974SPaul B Schroeder int MsrLsr; 196*3f542974SPaul B Schroeder 197*3f542974SPaul B Schroeder struct urb *write_urb_pool[NUM_URBS]; 198*3f542974SPaul B Schroeder }; 199*3f542974SPaul B Schroeder 200*3f542974SPaul B Schroeder 201*3f542974SPaul B Schroeder static int debug; 202*3f542974SPaul B Schroeder static int mos7840_num_ports; //this says the number of ports in the device 203*3f542974SPaul B Schroeder static int mos7840_num_open_ports; 204*3f542974SPaul B Schroeder 205*3f542974SPaul B Schroeder 206*3f542974SPaul B Schroeder /* 207*3f542974SPaul B Schroeder * mos7840_set_reg_sync 208*3f542974SPaul B Schroeder * To set the Control register by calling usb_fill_control_urb function 209*3f542974SPaul B Schroeder * by passing usb_sndctrlpipe function as parameter. 210*3f542974SPaul B Schroeder */ 211*3f542974SPaul B Schroeder 212*3f542974SPaul B Schroeder static int mos7840_set_reg_sync(struct usb_serial_port *port, __u16 reg, 213*3f542974SPaul B Schroeder __u16 val) 214*3f542974SPaul B Schroeder { 215*3f542974SPaul B Schroeder struct usb_device *dev = port->serial->dev; 216*3f542974SPaul B Schroeder val = val & 0x00ff; 217*3f542974SPaul B Schroeder dbg("mos7840_set_reg_sync offset is %x, value %x\n", reg, val); 218*3f542974SPaul B Schroeder 219*3f542974SPaul B Schroeder return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ, 220*3f542974SPaul B Schroeder MCS_WR_RTYPE, val, reg, NULL, 0, 221*3f542974SPaul B Schroeder MOS_WDR_TIMEOUT); 222*3f542974SPaul B Schroeder } 223*3f542974SPaul B Schroeder 224*3f542974SPaul B Schroeder /* 225*3f542974SPaul B Schroeder * mos7840_get_reg_sync 226*3f542974SPaul B Schroeder * To set the Uart register by calling usb_fill_control_urb function by 227*3f542974SPaul B Schroeder * passing usb_rcvctrlpipe function as parameter. 228*3f542974SPaul B Schroeder */ 229*3f542974SPaul B Schroeder 230*3f542974SPaul B Schroeder static int mos7840_get_reg_sync(struct usb_serial_port *port, __u16 reg, 231*3f542974SPaul B Schroeder __u16 * val) 232*3f542974SPaul B Schroeder { 233*3f542974SPaul B Schroeder struct usb_device *dev = port->serial->dev; 234*3f542974SPaul B Schroeder int ret = 0; 235*3f542974SPaul B Schroeder 236*3f542974SPaul B Schroeder ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ, 237*3f542974SPaul B Schroeder MCS_RD_RTYPE, 0, reg, val, VENDOR_READ_LENGTH, 238*3f542974SPaul B Schroeder MOS_WDR_TIMEOUT); 239*3f542974SPaul B Schroeder dbg("mos7840_get_reg_sync offset is %x, return val %x\n", reg, *val); 240*3f542974SPaul B Schroeder *val = (*val) & 0x00ff; 241*3f542974SPaul B Schroeder return ret; 242*3f542974SPaul B Schroeder } 243*3f542974SPaul B Schroeder 244*3f542974SPaul B Schroeder /* 245*3f542974SPaul B Schroeder * mos7840_set_uart_reg 246*3f542974SPaul B Schroeder * To set the Uart register by calling usb_fill_control_urb function by 247*3f542974SPaul B Schroeder * passing usb_sndctrlpipe function as parameter. 248*3f542974SPaul B Schroeder */ 249*3f542974SPaul B Schroeder 250*3f542974SPaul B Schroeder static int mos7840_set_uart_reg(struct usb_serial_port *port, __u16 reg, 251*3f542974SPaul B Schroeder __u16 val) 252*3f542974SPaul B Schroeder { 253*3f542974SPaul B Schroeder 254*3f542974SPaul B Schroeder struct usb_device *dev = port->serial->dev; 255*3f542974SPaul B Schroeder val = val & 0x00ff; 256*3f542974SPaul B Schroeder // For the UART control registers, the application number need to be Or'ed 257*3f542974SPaul B Schroeder if (mos7840_num_ports == 4) { 258*3f542974SPaul B Schroeder val |= 259*3f542974SPaul B Schroeder (((__u16) port->number - (__u16) (port->serial->minor)) + 260*3f542974SPaul B Schroeder 1) << 8; 261*3f542974SPaul B Schroeder dbg("mos7840_set_uart_reg application number is %x\n", val); 262*3f542974SPaul B Schroeder } else { 263*3f542974SPaul B Schroeder if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) { 264*3f542974SPaul B Schroeder val |= 265*3f542974SPaul B Schroeder (((__u16) port->number - 266*3f542974SPaul B Schroeder (__u16) (port->serial->minor)) + 1) << 8; 267*3f542974SPaul B Schroeder dbg("mos7840_set_uart_reg application number is %x\n", 268*3f542974SPaul B Schroeder val); 269*3f542974SPaul B Schroeder } else { 270*3f542974SPaul B Schroeder val |= 271*3f542974SPaul B Schroeder (((__u16) port->number - 272*3f542974SPaul B Schroeder (__u16) (port->serial->minor)) + 2) << 8; 273*3f542974SPaul B Schroeder dbg("mos7840_set_uart_reg application number is %x\n", 274*3f542974SPaul B Schroeder val); 275*3f542974SPaul B Schroeder } 276*3f542974SPaul B Schroeder } 277*3f542974SPaul B Schroeder return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ, 278*3f542974SPaul B Schroeder MCS_WR_RTYPE, val, reg, NULL, 0, 279*3f542974SPaul B Schroeder MOS_WDR_TIMEOUT); 280*3f542974SPaul B Schroeder 281*3f542974SPaul B Schroeder } 282*3f542974SPaul B Schroeder 283*3f542974SPaul B Schroeder /* 284*3f542974SPaul B Schroeder * mos7840_get_uart_reg 285*3f542974SPaul B Schroeder * To set the Control register by calling usb_fill_control_urb function 286*3f542974SPaul B Schroeder * by passing usb_rcvctrlpipe function as parameter. 287*3f542974SPaul B Schroeder */ 288*3f542974SPaul B Schroeder static int mos7840_get_uart_reg(struct usb_serial_port *port, __u16 reg, 289*3f542974SPaul B Schroeder __u16 * val) 290*3f542974SPaul B Schroeder { 291*3f542974SPaul B Schroeder struct usb_device *dev = port->serial->dev; 292*3f542974SPaul B Schroeder int ret = 0; 293*3f542974SPaul B Schroeder __u16 Wval; 294*3f542974SPaul B Schroeder 295*3f542974SPaul B Schroeder //dbg("application number is %4x \n",(((__u16)port->number - (__u16)(port->serial->minor))+1)<<8); 296*3f542974SPaul B Schroeder /*Wval is same as application number */ 297*3f542974SPaul B Schroeder if (mos7840_num_ports == 4) { 298*3f542974SPaul B Schroeder Wval = 299*3f542974SPaul B Schroeder (((__u16) port->number - (__u16) (port->serial->minor)) + 300*3f542974SPaul B Schroeder 1) << 8; 301*3f542974SPaul B Schroeder dbg("mos7840_get_uart_reg application number is %x\n", Wval); 302*3f542974SPaul B Schroeder } else { 303*3f542974SPaul B Schroeder if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) { 304*3f542974SPaul B Schroeder Wval = 305*3f542974SPaul B Schroeder (((__u16) port->number - 306*3f542974SPaul B Schroeder (__u16) (port->serial->minor)) + 1) << 8; 307*3f542974SPaul B Schroeder dbg("mos7840_get_uart_reg application number is %x\n", 308*3f542974SPaul B Schroeder Wval); 309*3f542974SPaul B Schroeder } else { 310*3f542974SPaul B Schroeder Wval = 311*3f542974SPaul B Schroeder (((__u16) port->number - 312*3f542974SPaul B Schroeder (__u16) (port->serial->minor)) + 2) << 8; 313*3f542974SPaul B Schroeder dbg("mos7840_get_uart_reg application number is %x\n", 314*3f542974SPaul B Schroeder Wval); 315*3f542974SPaul B Schroeder } 316*3f542974SPaul B Schroeder } 317*3f542974SPaul B Schroeder ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ, 318*3f542974SPaul B Schroeder MCS_RD_RTYPE, Wval, reg, val, VENDOR_READ_LENGTH, 319*3f542974SPaul B Schroeder MOS_WDR_TIMEOUT); 320*3f542974SPaul B Schroeder *val = (*val) & 0x00ff; 321*3f542974SPaul B Schroeder return ret; 322*3f542974SPaul B Schroeder } 323*3f542974SPaul B Schroeder 324*3f542974SPaul B Schroeder static void mos7840_dump_serial_port(struct moschip_port *mos7840_port) 325*3f542974SPaul B Schroeder { 326*3f542974SPaul B Schroeder 327*3f542974SPaul B Schroeder dbg("***************************************\n"); 328*3f542974SPaul B Schroeder dbg("SpRegOffset is %2x\n", mos7840_port->SpRegOffset); 329*3f542974SPaul B Schroeder dbg("ControlRegOffset is %2x \n", mos7840_port->ControlRegOffset); 330*3f542974SPaul B Schroeder dbg("DCRRegOffset is %2x \n", mos7840_port->DcrRegOffset); 331*3f542974SPaul B Schroeder dbg("***************************************\n"); 332*3f542974SPaul B Schroeder 333*3f542974SPaul B Schroeder } 334*3f542974SPaul B Schroeder 335*3f542974SPaul B Schroeder /************************************************************************/ 336*3f542974SPaul B Schroeder /************************************************************************/ 337*3f542974SPaul B Schroeder /* I N T E R F A C E F U N C T I O N S */ 338*3f542974SPaul B Schroeder /* I N T E R F A C E F U N C T I O N S */ 339*3f542974SPaul B Schroeder /************************************************************************/ 340*3f542974SPaul B Schroeder /************************************************************************/ 341*3f542974SPaul B Schroeder 342*3f542974SPaul B Schroeder static inline void mos7840_set_port_private(struct usb_serial_port *port, 343*3f542974SPaul B Schroeder struct moschip_port *data) 344*3f542974SPaul B Schroeder { 345*3f542974SPaul B Schroeder usb_set_serial_port_data(port, (void *)data); 346*3f542974SPaul B Schroeder } 347*3f542974SPaul B Schroeder 348*3f542974SPaul B Schroeder static inline struct moschip_port *mos7840_get_port_private(struct 349*3f542974SPaul B Schroeder usb_serial_port 350*3f542974SPaul B Schroeder *port) 351*3f542974SPaul B Schroeder { 352*3f542974SPaul B Schroeder return (struct moschip_port *)usb_get_serial_port_data(port); 353*3f542974SPaul B Schroeder } 354*3f542974SPaul B Schroeder 355*3f542974SPaul B Schroeder static int mos7840_handle_new_msr(struct moschip_port *port, __u8 new_msr) 356*3f542974SPaul B Schroeder { 357*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 358*3f542974SPaul B Schroeder struct async_icount *icount; 359*3f542974SPaul B Schroeder mos7840_port = port; 360*3f542974SPaul B Schroeder icount = &mos7840_port->icount; 361*3f542974SPaul B Schroeder if (new_msr & 362*3f542974SPaul B Schroeder (MOS_MSR_DELTA_CTS | MOS_MSR_DELTA_DSR | MOS_MSR_DELTA_RI | 363*3f542974SPaul B Schroeder MOS_MSR_DELTA_CD)) { 364*3f542974SPaul B Schroeder icount = &mos7840_port->icount; 365*3f542974SPaul B Schroeder 366*3f542974SPaul B Schroeder /* update input line counters */ 367*3f542974SPaul B Schroeder if (new_msr & MOS_MSR_DELTA_CTS) { 368*3f542974SPaul B Schroeder icount->cts++; 369*3f542974SPaul B Schroeder } 370*3f542974SPaul B Schroeder if (new_msr & MOS_MSR_DELTA_DSR) { 371*3f542974SPaul B Schroeder icount->dsr++; 372*3f542974SPaul B Schroeder } 373*3f542974SPaul B Schroeder if (new_msr & MOS_MSR_DELTA_CD) { 374*3f542974SPaul B Schroeder icount->dcd++; 375*3f542974SPaul B Schroeder } 376*3f542974SPaul B Schroeder if (new_msr & MOS_MSR_DELTA_RI) { 377*3f542974SPaul B Schroeder icount->rng++; 378*3f542974SPaul B Schroeder } 379*3f542974SPaul B Schroeder } 380*3f542974SPaul B Schroeder 381*3f542974SPaul B Schroeder return 0; 382*3f542974SPaul B Schroeder } 383*3f542974SPaul B Schroeder 384*3f542974SPaul B Schroeder static int mos7840_handle_new_lsr(struct moschip_port *port, __u8 new_lsr) 385*3f542974SPaul B Schroeder { 386*3f542974SPaul B Schroeder struct async_icount *icount; 387*3f542974SPaul B Schroeder 388*3f542974SPaul B Schroeder dbg("%s - %02x", __FUNCTION__, new_lsr); 389*3f542974SPaul B Schroeder 390*3f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_BI) { 391*3f542974SPaul B Schroeder // 392*3f542974SPaul B Schroeder // Parity and Framing errors only count if they 393*3f542974SPaul B Schroeder // occur exclusive of a break being 394*3f542974SPaul B Schroeder // received. 395*3f542974SPaul B Schroeder // 396*3f542974SPaul B Schroeder new_lsr &= (__u8) (SERIAL_LSR_OE | SERIAL_LSR_BI); 397*3f542974SPaul B Schroeder } 398*3f542974SPaul B Schroeder 399*3f542974SPaul B Schroeder /* update input line counters */ 400*3f542974SPaul B Schroeder icount = &port->icount; 401*3f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_BI) { 402*3f542974SPaul B Schroeder icount->brk++; 403*3f542974SPaul B Schroeder } 404*3f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_OE) { 405*3f542974SPaul B Schroeder icount->overrun++; 406*3f542974SPaul B Schroeder } 407*3f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_PE) { 408*3f542974SPaul B Schroeder icount->parity++; 409*3f542974SPaul B Schroeder } 410*3f542974SPaul B Schroeder if (new_lsr & SERIAL_LSR_FE) { 411*3f542974SPaul B Schroeder icount->frame++; 412*3f542974SPaul B Schroeder } 413*3f542974SPaul B Schroeder 414*3f542974SPaul B Schroeder return 0; 415*3f542974SPaul B Schroeder } 416*3f542974SPaul B Schroeder 417*3f542974SPaul B Schroeder /************************************************************************/ 418*3f542974SPaul B Schroeder /************************************************************************/ 419*3f542974SPaul B Schroeder /* U S B C A L L B A C K F U N C T I O N S */ 420*3f542974SPaul B Schroeder /* U S B C A L L B A C K F U N C T I O N S */ 421*3f542974SPaul B Schroeder /************************************************************************/ 422*3f542974SPaul B Schroeder /************************************************************************/ 423*3f542974SPaul B Schroeder 424*3f542974SPaul B Schroeder static void mos7840_control_callback(struct urb *urb, struct pt_regs *regs) 425*3f542974SPaul B Schroeder { 426*3f542974SPaul B Schroeder unsigned char *data; 427*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 428*3f542974SPaul B Schroeder __u8 regval = 0x0; 429*3f542974SPaul B Schroeder 430*3f542974SPaul B Schroeder if (!urb) { 431*3f542974SPaul B Schroeder dbg("%s", "Invalid Pointer !!!!:\n"); 432*3f542974SPaul B Schroeder return; 433*3f542974SPaul B Schroeder } 434*3f542974SPaul B Schroeder 435*3f542974SPaul B Schroeder switch (urb->status) { 436*3f542974SPaul B Schroeder case 0: 437*3f542974SPaul B Schroeder /* success */ 438*3f542974SPaul B Schroeder break; 439*3f542974SPaul B Schroeder case -ECONNRESET: 440*3f542974SPaul B Schroeder case -ENOENT: 441*3f542974SPaul B Schroeder case -ESHUTDOWN: 442*3f542974SPaul B Schroeder /* this urb is terminated, clean up */ 443*3f542974SPaul B Schroeder dbg("%s - urb shutting down with status: %d", __FUNCTION__, 444*3f542974SPaul B Schroeder urb->status); 445*3f542974SPaul B Schroeder return; 446*3f542974SPaul B Schroeder default: 447*3f542974SPaul B Schroeder dbg("%s - nonzero urb status received: %d", __FUNCTION__, 448*3f542974SPaul B Schroeder urb->status); 449*3f542974SPaul B Schroeder goto exit; 450*3f542974SPaul B Schroeder } 451*3f542974SPaul B Schroeder 452*3f542974SPaul B Schroeder mos7840_port = (struct moschip_port *)urb->context; 453*3f542974SPaul B Schroeder 454*3f542974SPaul B Schroeder dbg("%s urb buffer size is %d\n", __FUNCTION__, urb->actual_length); 455*3f542974SPaul B Schroeder dbg("%s mos7840_port->MsrLsr is %d port %d\n", __FUNCTION__, 456*3f542974SPaul B Schroeder mos7840_port->MsrLsr, mos7840_port->port_num); 457*3f542974SPaul B Schroeder data = urb->transfer_buffer; 458*3f542974SPaul B Schroeder regval = (__u8) data[0]; 459*3f542974SPaul B Schroeder dbg("%s data is %x\n", __FUNCTION__, regval); 460*3f542974SPaul B Schroeder if (mos7840_port->MsrLsr == 0) 461*3f542974SPaul B Schroeder mos7840_handle_new_msr(mos7840_port, regval); 462*3f542974SPaul B Schroeder else if (mos7840_port->MsrLsr == 1) 463*3f542974SPaul B Schroeder mos7840_handle_new_lsr(mos7840_port, regval); 464*3f542974SPaul B Schroeder 465*3f542974SPaul B Schroeder exit: 466*3f542974SPaul B Schroeder return; 467*3f542974SPaul B Schroeder } 468*3f542974SPaul B Schroeder 469*3f542974SPaul B Schroeder static int mos7840_get_reg(struct moschip_port *mcs, __u16 Wval, __u16 reg, 470*3f542974SPaul B Schroeder __u16 * val) 471*3f542974SPaul B Schroeder { 472*3f542974SPaul B Schroeder struct usb_device *dev = mcs->port->serial->dev; 473*3f542974SPaul B Schroeder struct usb_ctrlrequest *dr = NULL; 474*3f542974SPaul B Schroeder unsigned char *buffer = NULL; 475*3f542974SPaul B Schroeder int ret = 0; 476*3f542974SPaul B Schroeder buffer = (__u8 *) mcs->ctrl_buf; 477*3f542974SPaul B Schroeder 478*3f542974SPaul B Schroeder // dr=(struct usb_ctrlrequest *)(buffer); 479*3f542974SPaul B Schroeder dr = (void *)(buffer + 2); 480*3f542974SPaul B Schroeder dr->bRequestType = MCS_RD_RTYPE; 481*3f542974SPaul B Schroeder dr->bRequest = MCS_RDREQ; 482*3f542974SPaul B Schroeder dr->wValue = cpu_to_le16(Wval); //0; 483*3f542974SPaul B Schroeder dr->wIndex = cpu_to_le16(reg); 484*3f542974SPaul B Schroeder dr->wLength = cpu_to_le16(2); 485*3f542974SPaul B Schroeder 486*3f542974SPaul B Schroeder usb_fill_control_urb(mcs->control_urb, dev, usb_rcvctrlpipe(dev, 0), 487*3f542974SPaul B Schroeder (unsigned char *)dr, buffer, 2, 488*3f542974SPaul B Schroeder mos7840_control_callback, mcs); 489*3f542974SPaul B Schroeder mcs->control_urb->transfer_buffer_length = 2; 490*3f542974SPaul B Schroeder ret = usb_submit_urb(mcs->control_urb, GFP_ATOMIC); 491*3f542974SPaul B Schroeder return ret; 492*3f542974SPaul B Schroeder } 493*3f542974SPaul B Schroeder 494*3f542974SPaul B Schroeder /***************************************************************************** 495*3f542974SPaul B Schroeder * mos7840_interrupt_callback 496*3f542974SPaul B Schroeder * this is the callback function for when we have received data on the 497*3f542974SPaul B Schroeder * interrupt endpoint. 498*3f542974SPaul B Schroeder *****************************************************************************/ 499*3f542974SPaul B Schroeder 500*3f542974SPaul B Schroeder static void mos7840_interrupt_callback(struct urb *urb, struct pt_regs *regs) 501*3f542974SPaul B Schroeder { 502*3f542974SPaul B Schroeder int result; 503*3f542974SPaul B Schroeder int length; 504*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 505*3f542974SPaul B Schroeder struct usb_serial *serial; 506*3f542974SPaul B Schroeder __u16 Data; 507*3f542974SPaul B Schroeder unsigned char *data; 508*3f542974SPaul B Schroeder __u8 sp[5], st; 509*3f542974SPaul B Schroeder int i; 510*3f542974SPaul B Schroeder __u16 wval; 511*3f542974SPaul B Schroeder 512*3f542974SPaul B Schroeder dbg("%s", " : Entering\n"); 513*3f542974SPaul B Schroeder if (!urb) { 514*3f542974SPaul B Schroeder dbg("%s", "Invalid Pointer !!!!:\n"); 515*3f542974SPaul B Schroeder return; 516*3f542974SPaul B Schroeder } 517*3f542974SPaul B Schroeder 518*3f542974SPaul B Schroeder switch (urb->status) { 519*3f542974SPaul B Schroeder case 0: 520*3f542974SPaul B Schroeder /* success */ 521*3f542974SPaul B Schroeder break; 522*3f542974SPaul B Schroeder case -ECONNRESET: 523*3f542974SPaul B Schroeder case -ENOENT: 524*3f542974SPaul B Schroeder case -ESHUTDOWN: 525*3f542974SPaul B Schroeder /* this urb is terminated, clean up */ 526*3f542974SPaul B Schroeder dbg("%s - urb shutting down with status: %d", __FUNCTION__, 527*3f542974SPaul B Schroeder urb->status); 528*3f542974SPaul B Schroeder return; 529*3f542974SPaul B Schroeder default: 530*3f542974SPaul B Schroeder dbg("%s - nonzero urb status received: %d", __FUNCTION__, 531*3f542974SPaul B Schroeder urb->status); 532*3f542974SPaul B Schroeder goto exit; 533*3f542974SPaul B Schroeder } 534*3f542974SPaul B Schroeder 535*3f542974SPaul B Schroeder length = urb->actual_length; 536*3f542974SPaul B Schroeder data = urb->transfer_buffer; 537*3f542974SPaul B Schroeder 538*3f542974SPaul B Schroeder serial = (struct usb_serial *)urb->context; 539*3f542974SPaul B Schroeder 540*3f542974SPaul B Schroeder /* Moschip get 5 bytes 541*3f542974SPaul B Schroeder * Byte 1 IIR Port 1 (port.number is 0) 542*3f542974SPaul B Schroeder * Byte 2 IIR Port 2 (port.number is 1) 543*3f542974SPaul B Schroeder * Byte 3 IIR Port 3 (port.number is 2) 544*3f542974SPaul B Schroeder * Byte 4 IIR Port 4 (port.number is 3) 545*3f542974SPaul B Schroeder * Byte 5 FIFO status for both */ 546*3f542974SPaul B Schroeder 547*3f542974SPaul B Schroeder if (length && length > 5) { 548*3f542974SPaul B Schroeder dbg("%s \n", "Wrong data !!!"); 549*3f542974SPaul B Schroeder return; 550*3f542974SPaul B Schroeder } 551*3f542974SPaul B Schroeder 552*3f542974SPaul B Schroeder sp[0] = (__u8) data[0]; 553*3f542974SPaul B Schroeder sp[1] = (__u8) data[1]; 554*3f542974SPaul B Schroeder sp[2] = (__u8) data[2]; 555*3f542974SPaul B Schroeder sp[3] = (__u8) data[3]; 556*3f542974SPaul B Schroeder st = (__u8) data[4]; 557*3f542974SPaul B Schroeder 558*3f542974SPaul B Schroeder for (i = 0; i < serial->num_ports; i++) { 559*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(serial->port[i]); 560*3f542974SPaul B Schroeder wval = 561*3f542974SPaul B Schroeder (((__u16) serial->port[i]->number - 562*3f542974SPaul B Schroeder (__u16) (serial->minor)) + 1) << 8; 563*3f542974SPaul B Schroeder if (mos7840_port->open) { 564*3f542974SPaul B Schroeder if (sp[i] & 0x01) { 565*3f542974SPaul B Schroeder dbg("SP%d No Interrupt !!!\n", i); 566*3f542974SPaul B Schroeder } else { 567*3f542974SPaul B Schroeder switch (sp[i] & 0x0f) { 568*3f542974SPaul B Schroeder case SERIAL_IIR_RLS: 569*3f542974SPaul B Schroeder dbg("Serial Port %d: Receiver status error or ", i); 570*3f542974SPaul B Schroeder dbg("address bit detected in 9-bit mode\n"); 571*3f542974SPaul B Schroeder mos7840_port->MsrLsr = 1; 572*3f542974SPaul B Schroeder mos7840_get_reg(mos7840_port, wval, 573*3f542974SPaul B Schroeder LINE_STATUS_REGISTER, 574*3f542974SPaul B Schroeder &Data); 575*3f542974SPaul B Schroeder break; 576*3f542974SPaul B Schroeder case SERIAL_IIR_MS: 577*3f542974SPaul B Schroeder dbg("Serial Port %d: Modem status change\n", i); 578*3f542974SPaul B Schroeder mos7840_port->MsrLsr = 0; 579*3f542974SPaul B Schroeder mos7840_get_reg(mos7840_port, wval, 580*3f542974SPaul B Schroeder MODEM_STATUS_REGISTER, 581*3f542974SPaul B Schroeder &Data); 582*3f542974SPaul B Schroeder break; 583*3f542974SPaul B Schroeder } 584*3f542974SPaul B Schroeder } 585*3f542974SPaul B Schroeder } 586*3f542974SPaul B Schroeder } 587*3f542974SPaul B Schroeder exit: 588*3f542974SPaul B Schroeder result = usb_submit_urb(urb, GFP_ATOMIC); 589*3f542974SPaul B Schroeder if (result) { 590*3f542974SPaul B Schroeder dev_err(&urb->dev->dev, 591*3f542974SPaul B Schroeder "%s - Error %d submitting interrupt urb\n", 592*3f542974SPaul B Schroeder __FUNCTION__, result); 593*3f542974SPaul B Schroeder } 594*3f542974SPaul B Schroeder 595*3f542974SPaul B Schroeder return; 596*3f542974SPaul B Schroeder 597*3f542974SPaul B Schroeder } 598*3f542974SPaul B Schroeder 599*3f542974SPaul B Schroeder static int mos7840_port_paranoia_check(struct usb_serial_port *port, 600*3f542974SPaul B Schroeder const char *function) 601*3f542974SPaul B Schroeder { 602*3f542974SPaul B Schroeder if (!port) { 603*3f542974SPaul B Schroeder dbg("%s - port == NULL", function); 604*3f542974SPaul B Schroeder return -1; 605*3f542974SPaul B Schroeder } 606*3f542974SPaul B Schroeder if (!port->serial) { 607*3f542974SPaul B Schroeder dbg("%s - port->serial == NULL", function); 608*3f542974SPaul B Schroeder return -1; 609*3f542974SPaul B Schroeder } 610*3f542974SPaul B Schroeder 611*3f542974SPaul B Schroeder return 0; 612*3f542974SPaul B Schroeder } 613*3f542974SPaul B Schroeder 614*3f542974SPaul B Schroeder /* Inline functions to check the sanity of a pointer that is passed to us */ 615*3f542974SPaul B Schroeder static int mos7840_serial_paranoia_check(struct usb_serial *serial, 616*3f542974SPaul B Schroeder const char *function) 617*3f542974SPaul B Schroeder { 618*3f542974SPaul B Schroeder if (!serial) { 619*3f542974SPaul B Schroeder dbg("%s - serial == NULL", function); 620*3f542974SPaul B Schroeder return -1; 621*3f542974SPaul B Schroeder } 622*3f542974SPaul B Schroeder if (!serial->type) { 623*3f542974SPaul B Schroeder dbg("%s - serial->type == NULL!", function); 624*3f542974SPaul B Schroeder return -1; 625*3f542974SPaul B Schroeder } 626*3f542974SPaul B Schroeder 627*3f542974SPaul B Schroeder return 0; 628*3f542974SPaul B Schroeder } 629*3f542974SPaul B Schroeder 630*3f542974SPaul B Schroeder static struct usb_serial *mos7840_get_usb_serial(struct usb_serial_port *port, 631*3f542974SPaul B Schroeder const char *function) 632*3f542974SPaul B Schroeder { 633*3f542974SPaul B Schroeder /* if no port was specified, or it fails a paranoia check */ 634*3f542974SPaul B Schroeder if (!port || 635*3f542974SPaul B Schroeder mos7840_port_paranoia_check(port, function) || 636*3f542974SPaul B Schroeder mos7840_serial_paranoia_check(port->serial, function)) { 637*3f542974SPaul B Schroeder /* then say that we don't have a valid usb_serial thing, which will * end up genrating -ENODEV return values */ 638*3f542974SPaul B Schroeder return NULL; 639*3f542974SPaul B Schroeder } 640*3f542974SPaul B Schroeder 641*3f542974SPaul B Schroeder return port->serial; 642*3f542974SPaul B Schroeder } 643*3f542974SPaul B Schroeder 644*3f542974SPaul B Schroeder /***************************************************************************** 645*3f542974SPaul B Schroeder * mos7840_bulk_in_callback 646*3f542974SPaul B Schroeder * this is the callback function for when we have received data on the 647*3f542974SPaul B Schroeder * bulk in endpoint. 648*3f542974SPaul B Schroeder *****************************************************************************/ 649*3f542974SPaul B Schroeder 650*3f542974SPaul B Schroeder static void mos7840_bulk_in_callback(struct urb *urb, struct pt_regs *regs) 651*3f542974SPaul B Schroeder { 652*3f542974SPaul B Schroeder int status; 653*3f542974SPaul B Schroeder unsigned char *data; 654*3f542974SPaul B Schroeder struct usb_serial *serial; 655*3f542974SPaul B Schroeder struct usb_serial_port *port; 656*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 657*3f542974SPaul B Schroeder struct tty_struct *tty; 658*3f542974SPaul B Schroeder 659*3f542974SPaul B Schroeder if (!urb) { 660*3f542974SPaul B Schroeder dbg("%s", "Invalid Pointer !!!!:\n"); 661*3f542974SPaul B Schroeder return; 662*3f542974SPaul B Schroeder } 663*3f542974SPaul B Schroeder 664*3f542974SPaul B Schroeder if (urb->status) { 665*3f542974SPaul B Schroeder dbg("nonzero read bulk status received: %d", urb->status); 666*3f542974SPaul B Schroeder return; 667*3f542974SPaul B Schroeder } 668*3f542974SPaul B Schroeder 669*3f542974SPaul B Schroeder mos7840_port = (struct moschip_port *)urb->context; 670*3f542974SPaul B Schroeder if (!mos7840_port) { 671*3f542974SPaul B Schroeder dbg("%s", "NULL mos7840_port pointer \n"); 672*3f542974SPaul B Schroeder return; 673*3f542974SPaul B Schroeder } 674*3f542974SPaul B Schroeder 675*3f542974SPaul B Schroeder port = (struct usb_serial_port *)mos7840_port->port; 676*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 677*3f542974SPaul B Schroeder dbg("%s", "Port Paranoia failed \n"); 678*3f542974SPaul B Schroeder return; 679*3f542974SPaul B Schroeder } 680*3f542974SPaul B Schroeder 681*3f542974SPaul B Schroeder serial = mos7840_get_usb_serial(port, __FUNCTION__); 682*3f542974SPaul B Schroeder if (!serial) { 683*3f542974SPaul B Schroeder dbg("%s\n", "Bad serial pointer "); 684*3f542974SPaul B Schroeder return; 685*3f542974SPaul B Schroeder } 686*3f542974SPaul B Schroeder 687*3f542974SPaul B Schroeder dbg("%s\n", "Entering... \n"); 688*3f542974SPaul B Schroeder 689*3f542974SPaul B Schroeder data = urb->transfer_buffer; 690*3f542974SPaul B Schroeder 691*3f542974SPaul B Schroeder dbg("%s", "Entering ........... \n"); 692*3f542974SPaul B Schroeder 693*3f542974SPaul B Schroeder if (urb->actual_length) { 694*3f542974SPaul B Schroeder tty = mos7840_port->port->tty; 695*3f542974SPaul B Schroeder if (tty) { 696*3f542974SPaul B Schroeder tty_buffer_request_room(tty, urb->actual_length); 697*3f542974SPaul B Schroeder tty_insert_flip_string(tty, data, urb->actual_length); 698*3f542974SPaul B Schroeder dbg(" %s \n", data); 699*3f542974SPaul B Schroeder tty_flip_buffer_push(tty); 700*3f542974SPaul B Schroeder } 701*3f542974SPaul B Schroeder mos7840_port->icount.rx += urb->actual_length; 702*3f542974SPaul B Schroeder dbg("mos7840_port->icount.rx is %d:\n", 703*3f542974SPaul B Schroeder mos7840_port->icount.rx); 704*3f542974SPaul B Schroeder } 705*3f542974SPaul B Schroeder 706*3f542974SPaul B Schroeder if (!mos7840_port->read_urb) { 707*3f542974SPaul B Schroeder dbg("%s", "URB KILLED !!!\n"); 708*3f542974SPaul B Schroeder return; 709*3f542974SPaul B Schroeder } 710*3f542974SPaul B Schroeder 711*3f542974SPaul B Schroeder if (mos7840_port->read_urb->status != -EINPROGRESS) { 712*3f542974SPaul B Schroeder mos7840_port->read_urb->dev = serial->dev; 713*3f542974SPaul B Schroeder 714*3f542974SPaul B Schroeder status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC); 715*3f542974SPaul B Schroeder 716*3f542974SPaul B Schroeder if (status) { 717*3f542974SPaul B Schroeder dbg(" usb_submit_urb(read bulk) failed, status = %d", 718*3f542974SPaul B Schroeder status); 719*3f542974SPaul B Schroeder } 720*3f542974SPaul B Schroeder } 721*3f542974SPaul B Schroeder } 722*3f542974SPaul B Schroeder 723*3f542974SPaul B Schroeder /***************************************************************************** 724*3f542974SPaul B Schroeder * mos7840_bulk_out_data_callback 725*3f542974SPaul B Schroeder * this is the callback function for when we have finished sending serial data 726*3f542974SPaul B Schroeder * on the bulk out endpoint. 727*3f542974SPaul B Schroeder *****************************************************************************/ 728*3f542974SPaul B Schroeder 729*3f542974SPaul B Schroeder static void mos7840_bulk_out_data_callback(struct urb *urb, 730*3f542974SPaul B Schroeder struct pt_regs *regs) 731*3f542974SPaul B Schroeder { 732*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 733*3f542974SPaul B Schroeder struct tty_struct *tty; 734*3f542974SPaul B Schroeder if (!urb) { 735*3f542974SPaul B Schroeder dbg("%s", "Invalid Pointer !!!!:\n"); 736*3f542974SPaul B Schroeder return; 737*3f542974SPaul B Schroeder } 738*3f542974SPaul B Schroeder 739*3f542974SPaul B Schroeder if (urb->status) { 740*3f542974SPaul B Schroeder dbg("nonzero write bulk status received:%d\n", urb->status); 741*3f542974SPaul B Schroeder return; 742*3f542974SPaul B Schroeder } 743*3f542974SPaul B Schroeder 744*3f542974SPaul B Schroeder mos7840_port = (struct moschip_port *)urb->context; 745*3f542974SPaul B Schroeder if (!mos7840_port) { 746*3f542974SPaul B Schroeder dbg("%s", "NULL mos7840_port pointer \n"); 747*3f542974SPaul B Schroeder return; 748*3f542974SPaul B Schroeder } 749*3f542974SPaul B Schroeder 750*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(mos7840_port->port, __FUNCTION__)) { 751*3f542974SPaul B Schroeder dbg("%s", "Port Paranoia failed \n"); 752*3f542974SPaul B Schroeder return; 753*3f542974SPaul B Schroeder } 754*3f542974SPaul B Schroeder 755*3f542974SPaul B Schroeder dbg("%s \n", "Entering ........."); 756*3f542974SPaul B Schroeder 757*3f542974SPaul B Schroeder tty = mos7840_port->port->tty; 758*3f542974SPaul B Schroeder 759*3f542974SPaul B Schroeder if (tty && mos7840_port->open) { 760*3f542974SPaul B Schroeder /* let the tty driver wakeup if it has a special * 761*3f542974SPaul B Schroeder * write_wakeup function */ 762*3f542974SPaul B Schroeder 763*3f542974SPaul B Schroeder if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) 764*3f542974SPaul B Schroeder && tty->ldisc.write_wakeup) { 765*3f542974SPaul B Schroeder (tty->ldisc.write_wakeup) (tty); 766*3f542974SPaul B Schroeder } 767*3f542974SPaul B Schroeder 768*3f542974SPaul B Schroeder /* tell the tty driver that something has changed */ 769*3f542974SPaul B Schroeder wake_up_interruptible(&tty->write_wait); 770*3f542974SPaul B Schroeder } 771*3f542974SPaul B Schroeder 772*3f542974SPaul B Schroeder } 773*3f542974SPaul B Schroeder 774*3f542974SPaul B Schroeder /************************************************************************/ 775*3f542974SPaul 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 */ 776*3f542974SPaul B Schroeder /************************************************************************/ 777*3f542974SPaul B Schroeder #ifdef MCSSerialProbe 778*3f542974SPaul B Schroeder static int mos7840_serial_probe(struct usb_serial *serial, 779*3f542974SPaul B Schroeder const struct usb_device_id *id) 780*3f542974SPaul B Schroeder { 781*3f542974SPaul B Schroeder 782*3f542974SPaul B Schroeder /*need to implement the mode_reg reading and updating\ 783*3f542974SPaul B Schroeder structures usb_serial_ device_type\ 784*3f542974SPaul B Schroeder (i.e num_ports, num_bulkin,bulkout etc) */ 785*3f542974SPaul B Schroeder /* Also we can update the changes attach */ 786*3f542974SPaul B Schroeder return 1; 787*3f542974SPaul B Schroeder } 788*3f542974SPaul B Schroeder #endif 789*3f542974SPaul B Schroeder 790*3f542974SPaul B Schroeder /***************************************************************************** 791*3f542974SPaul B Schroeder * mos7840_open 792*3f542974SPaul B Schroeder * this function is called by the tty driver when a port is opened 793*3f542974SPaul B Schroeder * If successful, we return 0 794*3f542974SPaul B Schroeder * Otherwise we return a negative error number. 795*3f542974SPaul B Schroeder *****************************************************************************/ 796*3f542974SPaul B Schroeder 797*3f542974SPaul B Schroeder static int mos7840_open(struct usb_serial_port *port, struct file *filp) 798*3f542974SPaul B Schroeder { 799*3f542974SPaul B Schroeder int response; 800*3f542974SPaul B Schroeder int j; 801*3f542974SPaul B Schroeder struct usb_serial *serial; 802*3f542974SPaul B Schroeder struct urb *urb; 803*3f542974SPaul B Schroeder __u16 Data; 804*3f542974SPaul B Schroeder int status; 805*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 806*3f542974SPaul B Schroeder 807*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 808*3f542974SPaul B Schroeder dbg("%s", "Port Paranoia failed \n"); 809*3f542974SPaul B Schroeder return -ENODEV; 810*3f542974SPaul B Schroeder } 811*3f542974SPaul B Schroeder 812*3f542974SPaul B Schroeder mos7840_num_open_ports++; 813*3f542974SPaul B Schroeder serial = port->serial; 814*3f542974SPaul B Schroeder 815*3f542974SPaul B Schroeder if (mos7840_serial_paranoia_check(serial, __FUNCTION__)) { 816*3f542974SPaul B Schroeder dbg("%s", "Serial Paranoia failed \n"); 817*3f542974SPaul B Schroeder return -ENODEV; 818*3f542974SPaul B Schroeder } 819*3f542974SPaul B Schroeder 820*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 821*3f542974SPaul B Schroeder 822*3f542974SPaul B Schroeder if (mos7840_port == NULL) 823*3f542974SPaul B Schroeder return -ENODEV; 824*3f542974SPaul B Schroeder 825*3f542974SPaul B Schroeder usb_clear_halt(serial->dev, port->write_urb->pipe); 826*3f542974SPaul B Schroeder usb_clear_halt(serial->dev, port->read_urb->pipe); 827*3f542974SPaul B Schroeder 828*3f542974SPaul B Schroeder /* Initialising the write urb pool */ 829*3f542974SPaul B Schroeder for (j = 0; j < NUM_URBS; ++j) { 830*3f542974SPaul B Schroeder urb = usb_alloc_urb(0, SLAB_ATOMIC); 831*3f542974SPaul B Schroeder mos7840_port->write_urb_pool[j] = urb; 832*3f542974SPaul B Schroeder 833*3f542974SPaul B Schroeder if (urb == NULL) { 834*3f542974SPaul B Schroeder err("No more urbs???"); 835*3f542974SPaul B Schroeder continue; 836*3f542974SPaul B Schroeder } 837*3f542974SPaul B Schroeder 838*3f542974SPaul B Schroeder urb->transfer_buffer = NULL; 839*3f542974SPaul B Schroeder urb->transfer_buffer = 840*3f542974SPaul B Schroeder kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL); 841*3f542974SPaul B Schroeder if (!urb->transfer_buffer) { 842*3f542974SPaul B Schroeder err("%s-out of memory for urb buffers.", __FUNCTION__); 843*3f542974SPaul B Schroeder continue; 844*3f542974SPaul B Schroeder } 845*3f542974SPaul B Schroeder } 846*3f542974SPaul B Schroeder 847*3f542974SPaul B Schroeder /***************************************************************************** 848*3f542974SPaul B Schroeder * Initialize MCS7840 -- Write Init values to corresponding Registers 849*3f542974SPaul B Schroeder * 850*3f542974SPaul B Schroeder * Register Index 851*3f542974SPaul B Schroeder * 1 : IER 852*3f542974SPaul B Schroeder * 2 : FCR 853*3f542974SPaul B Schroeder * 3 : LCR 854*3f542974SPaul B Schroeder * 4 : MCR 855*3f542974SPaul B Schroeder * 856*3f542974SPaul B Schroeder * 0x08 : SP1/2 Control Reg 857*3f542974SPaul B Schroeder *****************************************************************************/ 858*3f542974SPaul B Schroeder 859*3f542974SPaul B Schroeder //NEED to check the following Block 860*3f542974SPaul B Schroeder 861*3f542974SPaul B Schroeder status = 0; 862*3f542974SPaul B Schroeder Data = 0x0; 863*3f542974SPaul B Schroeder status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data); 864*3f542974SPaul B Schroeder if (status < 0) { 865*3f542974SPaul B Schroeder dbg("Reading Spreg failed\n"); 866*3f542974SPaul B Schroeder return -1; 867*3f542974SPaul B Schroeder } 868*3f542974SPaul B Schroeder Data |= 0x80; 869*3f542974SPaul B Schroeder status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); 870*3f542974SPaul B Schroeder if (status < 0) { 871*3f542974SPaul B Schroeder dbg("writing Spreg failed\n"); 872*3f542974SPaul B Schroeder return -1; 873*3f542974SPaul B Schroeder } 874*3f542974SPaul B Schroeder 875*3f542974SPaul B Schroeder Data &= ~0x80; 876*3f542974SPaul B Schroeder status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); 877*3f542974SPaul B Schroeder if (status < 0) { 878*3f542974SPaul B Schroeder dbg("writing Spreg failed\n"); 879*3f542974SPaul B Schroeder return -1; 880*3f542974SPaul B Schroeder } 881*3f542974SPaul B Schroeder //End of block to be checked 882*3f542974SPaul B Schroeder 883*3f542974SPaul B Schroeder status = 0; 884*3f542974SPaul B Schroeder Data = 0x0; 885*3f542974SPaul B Schroeder status = 886*3f542974SPaul B Schroeder mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, &Data); 887*3f542974SPaul B Schroeder if (status < 0) { 888*3f542974SPaul B Schroeder dbg("Reading Controlreg failed\n"); 889*3f542974SPaul B Schroeder return -1; 890*3f542974SPaul B Schroeder } 891*3f542974SPaul B Schroeder Data |= 0x08; //Driver done bit 892*3f542974SPaul B Schroeder Data |= 0x20; //rx_disable 893*3f542974SPaul B Schroeder status = 0; 894*3f542974SPaul B Schroeder status = 895*3f542974SPaul B Schroeder mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, Data); 896*3f542974SPaul B Schroeder if (status < 0) { 897*3f542974SPaul B Schroeder dbg("writing Controlreg failed\n"); 898*3f542974SPaul B Schroeder return -1; 899*3f542974SPaul B Schroeder } 900*3f542974SPaul B Schroeder //do register settings here 901*3f542974SPaul B Schroeder // Set all regs to the device default values. 902*3f542974SPaul B Schroeder //////////////////////////////////// 903*3f542974SPaul B Schroeder // First Disable all interrupts. 904*3f542974SPaul B Schroeder //////////////////////////////////// 905*3f542974SPaul B Schroeder 906*3f542974SPaul B Schroeder Data = 0x00; 907*3f542974SPaul B Schroeder status = 0; 908*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 909*3f542974SPaul B Schroeder if (status < 0) { 910*3f542974SPaul B Schroeder dbg("disableing interrupts failed\n"); 911*3f542974SPaul B Schroeder return -1; 912*3f542974SPaul B Schroeder } 913*3f542974SPaul B Schroeder // Set FIFO_CONTROL_REGISTER to the default value 914*3f542974SPaul B Schroeder Data = 0x00; 915*3f542974SPaul B Schroeder status = 0; 916*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); 917*3f542974SPaul B Schroeder if (status < 0) { 918*3f542974SPaul B Schroeder dbg("Writing FIFO_CONTROL_REGISTER failed\n"); 919*3f542974SPaul B Schroeder return -1; 920*3f542974SPaul B Schroeder } 921*3f542974SPaul B Schroeder 922*3f542974SPaul B Schroeder Data = 0xcf; 923*3f542974SPaul B Schroeder status = 0; 924*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); 925*3f542974SPaul B Schroeder if (status < 0) { 926*3f542974SPaul B Schroeder dbg("Writing FIFO_CONTROL_REGISTER failed\n"); 927*3f542974SPaul B Schroeder return -1; 928*3f542974SPaul B Schroeder } 929*3f542974SPaul B Schroeder 930*3f542974SPaul B Schroeder Data = 0x03; 931*3f542974SPaul B Schroeder status = 0; 932*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 933*3f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 934*3f542974SPaul B Schroeder 935*3f542974SPaul B Schroeder Data = 0x0b; 936*3f542974SPaul B Schroeder status = 0; 937*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 938*3f542974SPaul B Schroeder mos7840_port->shadowMCR = Data; 939*3f542974SPaul B Schroeder 940*3f542974SPaul B Schroeder Data = 0x00; 941*3f542974SPaul B Schroeder status = 0; 942*3f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); 943*3f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 944*3f542974SPaul B Schroeder 945*3f542974SPaul B Schroeder Data |= SERIAL_LCR_DLAB; //data latch enable in LCR 0x80 946*3f542974SPaul B Schroeder status = 0; 947*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 948*3f542974SPaul B Schroeder 949*3f542974SPaul B Schroeder Data = 0x0c; 950*3f542974SPaul B Schroeder status = 0; 951*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data); 952*3f542974SPaul B Schroeder 953*3f542974SPaul B Schroeder Data = 0x0; 954*3f542974SPaul B Schroeder status = 0; 955*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data); 956*3f542974SPaul B Schroeder 957*3f542974SPaul B Schroeder Data = 0x00; 958*3f542974SPaul B Schroeder status = 0; 959*3f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); 960*3f542974SPaul B Schroeder 961*3f542974SPaul B Schroeder Data = Data & ~SERIAL_LCR_DLAB; 962*3f542974SPaul B Schroeder status = 0; 963*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 964*3f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 965*3f542974SPaul B Schroeder 966*3f542974SPaul B Schroeder //clearing Bulkin and Bulkout Fifo 967*3f542974SPaul B Schroeder Data = 0x0; 968*3f542974SPaul B Schroeder status = 0; 969*3f542974SPaul B Schroeder status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data); 970*3f542974SPaul B Schroeder 971*3f542974SPaul B Schroeder Data = Data | 0x0c; 972*3f542974SPaul B Schroeder status = 0; 973*3f542974SPaul B Schroeder status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); 974*3f542974SPaul B Schroeder 975*3f542974SPaul B Schroeder Data = Data & ~0x0c; 976*3f542974SPaul B Schroeder status = 0; 977*3f542974SPaul B Schroeder status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); 978*3f542974SPaul B Schroeder //Finally enable all interrupts 979*3f542974SPaul B Schroeder Data = 0x0; 980*3f542974SPaul B Schroeder Data = 0x0c; 981*3f542974SPaul B Schroeder status = 0; 982*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 983*3f542974SPaul B Schroeder 984*3f542974SPaul B Schroeder //clearing rx_disable 985*3f542974SPaul B Schroeder Data = 0x0; 986*3f542974SPaul B Schroeder status = 0; 987*3f542974SPaul B Schroeder status = 988*3f542974SPaul B Schroeder mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, &Data); 989*3f542974SPaul B Schroeder Data = Data & ~0x20; 990*3f542974SPaul B Schroeder status = 0; 991*3f542974SPaul B Schroeder status = 992*3f542974SPaul B Schroeder mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, Data); 993*3f542974SPaul B Schroeder 994*3f542974SPaul B Schroeder // rx_negate 995*3f542974SPaul B Schroeder Data = 0x0; 996*3f542974SPaul B Schroeder status = 0; 997*3f542974SPaul B Schroeder status = 998*3f542974SPaul B Schroeder mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, &Data); 999*3f542974SPaul B Schroeder Data = Data | 0x10; 1000*3f542974SPaul B Schroeder status = 0; 1001*3f542974SPaul B Schroeder status = 1002*3f542974SPaul B Schroeder mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, Data); 1003*3f542974SPaul B Schroeder 1004*3f542974SPaul B Schroeder /* force low_latency on so that our tty_push actually forces * 1005*3f542974SPaul B Schroeder * the data through,otherwise it is scheduled, and with * 1006*3f542974SPaul B Schroeder * high data rates (like with OHCI) data can get lost. */ 1007*3f542974SPaul B Schroeder 1008*3f542974SPaul B Schroeder if (port->tty) 1009*3f542974SPaul B Schroeder port->tty->low_latency = 1; 1010*3f542974SPaul B Schroeder /* Check to see if we've set up our endpoint info yet * 1011*3f542974SPaul B Schroeder * (can't set it up in mos7840_startup as the structures * 1012*3f542974SPaul B Schroeder * were not set up at that time.) */ 1013*3f542974SPaul B Schroeder if (mos7840_num_open_ports == 1) { 1014*3f542974SPaul B Schroeder if (serial->port[0]->interrupt_in_buffer == NULL) { 1015*3f542974SPaul B Schroeder 1016*3f542974SPaul B Schroeder /* set up interrupt urb */ 1017*3f542974SPaul B Schroeder 1018*3f542974SPaul B Schroeder usb_fill_int_urb(serial->port[0]->interrupt_in_urb, 1019*3f542974SPaul B Schroeder serial->dev, 1020*3f542974SPaul B Schroeder usb_rcvintpipe(serial->dev, 1021*3f542974SPaul B Schroeder serial->port[0]-> 1022*3f542974SPaul B Schroeder interrupt_in_endpointAddress), 1023*3f542974SPaul B Schroeder serial->port[0]->interrupt_in_buffer, 1024*3f542974SPaul B Schroeder serial->port[0]->interrupt_in_urb-> 1025*3f542974SPaul B Schroeder transfer_buffer_length, 1026*3f542974SPaul B Schroeder mos7840_interrupt_callback, 1027*3f542974SPaul B Schroeder serial, 1028*3f542974SPaul B Schroeder serial->port[0]->interrupt_in_urb-> 1029*3f542974SPaul B Schroeder interval); 1030*3f542974SPaul B Schroeder 1031*3f542974SPaul B Schroeder /* start interrupt read for mos7840 * 1032*3f542974SPaul B Schroeder * will continue as long as mos7840 is connected */ 1033*3f542974SPaul B Schroeder 1034*3f542974SPaul B Schroeder response = 1035*3f542974SPaul B Schroeder usb_submit_urb(serial->port[0]->interrupt_in_urb, 1036*3f542974SPaul B Schroeder GFP_KERNEL); 1037*3f542974SPaul B Schroeder if (response) { 1038*3f542974SPaul B Schroeder err("%s - Error %d submitting interrupt urb", 1039*3f542974SPaul B Schroeder __FUNCTION__, response); 1040*3f542974SPaul B Schroeder } 1041*3f542974SPaul B Schroeder 1042*3f542974SPaul B Schroeder } 1043*3f542974SPaul B Schroeder 1044*3f542974SPaul B Schroeder } 1045*3f542974SPaul B Schroeder 1046*3f542974SPaul B Schroeder /* see if we've set up our endpoint info yet * 1047*3f542974SPaul B Schroeder * (can't set it up in mos7840_startup as the * 1048*3f542974SPaul B Schroeder * structures were not set up at that time.) */ 1049*3f542974SPaul B Schroeder 1050*3f542974SPaul B Schroeder dbg("port number is %d \n", port->number); 1051*3f542974SPaul B Schroeder dbg("serial number is %d \n", port->serial->minor); 1052*3f542974SPaul B Schroeder dbg("Bulkin endpoint is %d \n", port->bulk_in_endpointAddress); 1053*3f542974SPaul B Schroeder dbg("BulkOut endpoint is %d \n", port->bulk_out_endpointAddress); 1054*3f542974SPaul B Schroeder dbg("Interrupt endpoint is %d \n", port->interrupt_in_endpointAddress); 1055*3f542974SPaul B Schroeder dbg("port's number in the device is %d\n", mos7840_port->port_num); 1056*3f542974SPaul B Schroeder mos7840_port->read_urb = port->read_urb; 1057*3f542974SPaul B Schroeder 1058*3f542974SPaul B Schroeder /* set up our bulk in urb */ 1059*3f542974SPaul B Schroeder 1060*3f542974SPaul B Schroeder usb_fill_bulk_urb(mos7840_port->read_urb, 1061*3f542974SPaul B Schroeder serial->dev, 1062*3f542974SPaul B Schroeder usb_rcvbulkpipe(serial->dev, 1063*3f542974SPaul B Schroeder port->bulk_in_endpointAddress), 1064*3f542974SPaul B Schroeder port->bulk_in_buffer, 1065*3f542974SPaul B Schroeder mos7840_port->read_urb->transfer_buffer_length, 1066*3f542974SPaul B Schroeder mos7840_bulk_in_callback, mos7840_port); 1067*3f542974SPaul B Schroeder 1068*3f542974SPaul B Schroeder dbg("mos7840_open: bulkin endpoint is %d\n", 1069*3f542974SPaul B Schroeder port->bulk_in_endpointAddress); 1070*3f542974SPaul B Schroeder response = usb_submit_urb(mos7840_port->read_urb, GFP_KERNEL); 1071*3f542974SPaul B Schroeder if (response) { 1072*3f542974SPaul B Schroeder err("%s - Error %d submitting control urb", __FUNCTION__, 1073*3f542974SPaul B Schroeder response); 1074*3f542974SPaul B Schroeder } 1075*3f542974SPaul B Schroeder 1076*3f542974SPaul B Schroeder /* initialize our wait queues */ 1077*3f542974SPaul B Schroeder init_waitqueue_head(&mos7840_port->wait_chase); 1078*3f542974SPaul B Schroeder init_waitqueue_head(&mos7840_port->delta_msr_wait); 1079*3f542974SPaul B Schroeder 1080*3f542974SPaul B Schroeder /* initialize our icount structure */ 1081*3f542974SPaul B Schroeder memset(&(mos7840_port->icount), 0x00, sizeof(mos7840_port->icount)); 1082*3f542974SPaul B Schroeder 1083*3f542974SPaul B Schroeder /* initialize our port settings */ 1084*3f542974SPaul B Schroeder mos7840_port->shadowMCR = MCR_MASTER_IE; /* Must set to enable ints! */ 1085*3f542974SPaul B Schroeder /* send a open port command */ 1086*3f542974SPaul B Schroeder mos7840_port->open = 1; 1087*3f542974SPaul B Schroeder //mos7840_change_port_settings(mos7840_port,old_termios); 1088*3f542974SPaul B Schroeder mos7840_port->icount.tx = 0; 1089*3f542974SPaul B Schroeder mos7840_port->icount.rx = 0; 1090*3f542974SPaul B Schroeder 1091*3f542974SPaul B Schroeder dbg("\n\nusb_serial serial:%x mos7840_port:%x\n usb_serial_port port:%x\n\n", (unsigned int)serial, (unsigned int)mos7840_port, (unsigned int)port); 1092*3f542974SPaul B Schroeder 1093*3f542974SPaul B Schroeder return 0; 1094*3f542974SPaul B Schroeder 1095*3f542974SPaul B Schroeder } 1096*3f542974SPaul B Schroeder 1097*3f542974SPaul B Schroeder /***************************************************************************** 1098*3f542974SPaul B Schroeder * mos7840_chars_in_buffer 1099*3f542974SPaul B Schroeder * this function is called by the tty driver when it wants to know how many 1100*3f542974SPaul B Schroeder * bytes of data we currently have outstanding in the port (data that has 1101*3f542974SPaul B Schroeder * been written, but hasn't made it out the port yet) 1102*3f542974SPaul B Schroeder * If successful, we return the number of bytes left to be written in the 1103*3f542974SPaul B Schroeder * system, 1104*3f542974SPaul B Schroeder * Otherwise we return a negative error number. 1105*3f542974SPaul B Schroeder *****************************************************************************/ 1106*3f542974SPaul B Schroeder 1107*3f542974SPaul B Schroeder static int mos7840_chars_in_buffer(struct usb_serial_port *port) 1108*3f542974SPaul B Schroeder { 1109*3f542974SPaul B Schroeder int i; 1110*3f542974SPaul B Schroeder int chars = 0; 1111*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 1112*3f542974SPaul B Schroeder 1113*3f542974SPaul B Schroeder dbg("%s \n", " mos7840_chars_in_buffer:entering ..........."); 1114*3f542974SPaul B Schroeder 1115*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 1116*3f542974SPaul B Schroeder dbg("%s", "Invalid port \n"); 1117*3f542974SPaul B Schroeder return -1; 1118*3f542974SPaul B Schroeder } 1119*3f542974SPaul B Schroeder 1120*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 1121*3f542974SPaul B Schroeder if (mos7840_port == NULL) { 1122*3f542974SPaul B Schroeder dbg("%s \n", "mos7840_break:leaving ..........."); 1123*3f542974SPaul B Schroeder return -1; 1124*3f542974SPaul B Schroeder } 1125*3f542974SPaul B Schroeder 1126*3f542974SPaul B Schroeder for (i = 0; i < NUM_URBS; ++i) { 1127*3f542974SPaul B Schroeder if (mos7840_port->write_urb_pool[i]->status == -EINPROGRESS) { 1128*3f542974SPaul B Schroeder chars += URB_TRANSFER_BUFFER_SIZE; 1129*3f542974SPaul B Schroeder } 1130*3f542974SPaul B Schroeder } 1131*3f542974SPaul B Schroeder dbg("%s - returns %d", __FUNCTION__, chars); 1132*3f542974SPaul B Schroeder return (chars); 1133*3f542974SPaul B Schroeder 1134*3f542974SPaul B Schroeder } 1135*3f542974SPaul B Schroeder 1136*3f542974SPaul B Schroeder /************************************************************************ 1137*3f542974SPaul B Schroeder * 1138*3f542974SPaul B Schroeder * mos7840_block_until_tx_empty 1139*3f542974SPaul B Schroeder * 1140*3f542974SPaul B Schroeder * This function will block the close until one of the following: 1141*3f542974SPaul B Schroeder * 1. TX count are 0 1142*3f542974SPaul B Schroeder * 2. The mos7840 has stopped 1143*3f542974SPaul B Schroeder * 3. A timout of 3 seconds without activity has expired 1144*3f542974SPaul B Schroeder * 1145*3f542974SPaul B Schroeder ************************************************************************/ 1146*3f542974SPaul B Schroeder static void mos7840_block_until_tx_empty(struct moschip_port *mos7840_port) 1147*3f542974SPaul B Schroeder { 1148*3f542974SPaul B Schroeder int timeout = HZ / 10; 1149*3f542974SPaul B Schroeder int wait = 30; 1150*3f542974SPaul B Schroeder int count; 1151*3f542974SPaul B Schroeder 1152*3f542974SPaul B Schroeder while (1) { 1153*3f542974SPaul B Schroeder 1154*3f542974SPaul B Schroeder count = mos7840_chars_in_buffer(mos7840_port->port); 1155*3f542974SPaul B Schroeder 1156*3f542974SPaul B Schroeder /* Check for Buffer status */ 1157*3f542974SPaul B Schroeder if (count <= 0) { 1158*3f542974SPaul B Schroeder return; 1159*3f542974SPaul B Schroeder } 1160*3f542974SPaul B Schroeder 1161*3f542974SPaul B Schroeder /* Block the thread for a while */ 1162*3f542974SPaul B Schroeder interruptible_sleep_on_timeout(&mos7840_port->wait_chase, 1163*3f542974SPaul B Schroeder timeout); 1164*3f542974SPaul B Schroeder 1165*3f542974SPaul B Schroeder /* No activity.. count down section */ 1166*3f542974SPaul B Schroeder wait--; 1167*3f542974SPaul B Schroeder if (wait == 0) { 1168*3f542974SPaul B Schroeder dbg("%s - TIMEOUT", __FUNCTION__); 1169*3f542974SPaul B Schroeder return; 1170*3f542974SPaul B Schroeder } else { 1171*3f542974SPaul B Schroeder /* Reset timout value back to seconds */ 1172*3f542974SPaul B Schroeder wait = 30; 1173*3f542974SPaul B Schroeder } 1174*3f542974SPaul B Schroeder } 1175*3f542974SPaul B Schroeder } 1176*3f542974SPaul B Schroeder 1177*3f542974SPaul B Schroeder /***************************************************************************** 1178*3f542974SPaul B Schroeder * mos7840_close 1179*3f542974SPaul B Schroeder * this function is called by the tty driver when a port is closed 1180*3f542974SPaul B Schroeder *****************************************************************************/ 1181*3f542974SPaul B Schroeder 1182*3f542974SPaul B Schroeder static void mos7840_close(struct usb_serial_port *port, struct file *filp) 1183*3f542974SPaul B Schroeder { 1184*3f542974SPaul B Schroeder struct usb_serial *serial; 1185*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 1186*3f542974SPaul B Schroeder int j; 1187*3f542974SPaul B Schroeder __u16 Data; 1188*3f542974SPaul B Schroeder 1189*3f542974SPaul B Schroeder dbg("%s\n", "mos7840_close:entering..."); 1190*3f542974SPaul B Schroeder 1191*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 1192*3f542974SPaul B Schroeder dbg("%s", "Port Paranoia failed \n"); 1193*3f542974SPaul B Schroeder return; 1194*3f542974SPaul B Schroeder } 1195*3f542974SPaul B Schroeder 1196*3f542974SPaul B Schroeder serial = mos7840_get_usb_serial(port, __FUNCTION__); 1197*3f542974SPaul B Schroeder if (!serial) { 1198*3f542974SPaul B Schroeder dbg("%s", "Serial Paranoia failed \n"); 1199*3f542974SPaul B Schroeder return; 1200*3f542974SPaul B Schroeder } 1201*3f542974SPaul B Schroeder 1202*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 1203*3f542974SPaul B Schroeder 1204*3f542974SPaul B Schroeder if (mos7840_port == NULL) { 1205*3f542974SPaul B Schroeder return; 1206*3f542974SPaul B Schroeder } 1207*3f542974SPaul B Schroeder 1208*3f542974SPaul B Schroeder for (j = 0; j < NUM_URBS; ++j) 1209*3f542974SPaul B Schroeder usb_kill_urb(mos7840_port->write_urb_pool[j]); 1210*3f542974SPaul B Schroeder 1211*3f542974SPaul B Schroeder /* Freeing Write URBs */ 1212*3f542974SPaul B Schroeder for (j = 0; j < NUM_URBS; ++j) { 1213*3f542974SPaul B Schroeder if (mos7840_port->write_urb_pool[j]) { 1214*3f542974SPaul B Schroeder if (mos7840_port->write_urb_pool[j]->transfer_buffer) 1215*3f542974SPaul B Schroeder kfree(mos7840_port->write_urb_pool[j]-> 1216*3f542974SPaul B Schroeder transfer_buffer); 1217*3f542974SPaul B Schroeder 1218*3f542974SPaul B Schroeder usb_free_urb(mos7840_port->write_urb_pool[j]); 1219*3f542974SPaul B Schroeder } 1220*3f542974SPaul B Schroeder } 1221*3f542974SPaul B Schroeder 1222*3f542974SPaul B Schroeder if (serial->dev) { 1223*3f542974SPaul B Schroeder /* flush and block until tx is empty */ 1224*3f542974SPaul B Schroeder mos7840_block_until_tx_empty(mos7840_port); 1225*3f542974SPaul B Schroeder } 1226*3f542974SPaul B Schroeder 1227*3f542974SPaul B Schroeder /* While closing port, shutdown all bulk read, write * 1228*3f542974SPaul B Schroeder * and interrupt read if they exists */ 1229*3f542974SPaul B Schroeder if (serial->dev) { 1230*3f542974SPaul B Schroeder 1231*3f542974SPaul B Schroeder if (mos7840_port->write_urb) { 1232*3f542974SPaul B Schroeder dbg("%s", "Shutdown bulk write\n"); 1233*3f542974SPaul B Schroeder usb_kill_urb(mos7840_port->write_urb); 1234*3f542974SPaul B Schroeder } 1235*3f542974SPaul B Schroeder 1236*3f542974SPaul B Schroeder if (mos7840_port->read_urb) { 1237*3f542974SPaul B Schroeder dbg("%s", "Shutdown bulk read\n"); 1238*3f542974SPaul B Schroeder usb_kill_urb(mos7840_port->read_urb); 1239*3f542974SPaul B Schroeder } 1240*3f542974SPaul B Schroeder if ((&mos7840_port->control_urb)) { 1241*3f542974SPaul B Schroeder dbg("%s", "Shutdown control read\n"); 1242*3f542974SPaul B Schroeder // usb_kill_urb (mos7840_port->control_urb); 1243*3f542974SPaul B Schroeder 1244*3f542974SPaul B Schroeder } 1245*3f542974SPaul B Schroeder } 1246*3f542974SPaul B Schroeder // if(mos7840_port->ctrl_buf != NULL) 1247*3f542974SPaul B Schroeder // kfree(mos7840_port->ctrl_buf); 1248*3f542974SPaul B Schroeder mos7840_num_open_ports--; 1249*3f542974SPaul B Schroeder dbg("mos7840_num_open_ports in close%d:in port%d\n", 1250*3f542974SPaul B Schroeder mos7840_num_open_ports, port->number); 1251*3f542974SPaul B Schroeder if (mos7840_num_open_ports == 0) { 1252*3f542974SPaul B Schroeder if (serial->port[0]->interrupt_in_urb) { 1253*3f542974SPaul B Schroeder dbg("%s", "Shutdown interrupt_in_urb\n"); 1254*3f542974SPaul B Schroeder } 1255*3f542974SPaul B Schroeder } 1256*3f542974SPaul B Schroeder 1257*3f542974SPaul B Schroeder if (mos7840_port->write_urb) { 1258*3f542974SPaul B Schroeder /* if this urb had a transfer buffer already (old tx) free it */ 1259*3f542974SPaul B Schroeder 1260*3f542974SPaul B Schroeder if (mos7840_port->write_urb->transfer_buffer != NULL) { 1261*3f542974SPaul B Schroeder kfree(mos7840_port->write_urb->transfer_buffer); 1262*3f542974SPaul B Schroeder } 1263*3f542974SPaul B Schroeder usb_free_urb(mos7840_port->write_urb); 1264*3f542974SPaul B Schroeder } 1265*3f542974SPaul B Schroeder 1266*3f542974SPaul B Schroeder Data = 0x0; 1267*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 1268*3f542974SPaul B Schroeder 1269*3f542974SPaul B Schroeder Data = 0x00; 1270*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 1271*3f542974SPaul B Schroeder 1272*3f542974SPaul B Schroeder mos7840_port->open = 0; 1273*3f542974SPaul B Schroeder 1274*3f542974SPaul B Schroeder dbg("%s \n", "Leaving ............"); 1275*3f542974SPaul B Schroeder } 1276*3f542974SPaul B Schroeder 1277*3f542974SPaul B Schroeder /************************************************************************ 1278*3f542974SPaul B Schroeder * 1279*3f542974SPaul B Schroeder * mos7840_block_until_chase_response 1280*3f542974SPaul B Schroeder * 1281*3f542974SPaul B Schroeder * This function will block the close until one of the following: 1282*3f542974SPaul B Schroeder * 1. Response to our Chase comes from mos7840 1283*3f542974SPaul B Schroeder * 2. A timout of 10 seconds without activity has expired 1284*3f542974SPaul B Schroeder * (1K of mos7840 data @ 2400 baud ==> 4 sec to empty) 1285*3f542974SPaul B Schroeder * 1286*3f542974SPaul B Schroeder ************************************************************************/ 1287*3f542974SPaul B Schroeder 1288*3f542974SPaul B Schroeder static void mos7840_block_until_chase_response(struct moschip_port 1289*3f542974SPaul B Schroeder *mos7840_port) 1290*3f542974SPaul B Schroeder { 1291*3f542974SPaul B Schroeder int timeout = 1 * HZ; 1292*3f542974SPaul B Schroeder int wait = 10; 1293*3f542974SPaul B Schroeder int count; 1294*3f542974SPaul B Schroeder 1295*3f542974SPaul B Schroeder while (1) { 1296*3f542974SPaul B Schroeder count = mos7840_chars_in_buffer(mos7840_port->port); 1297*3f542974SPaul B Schroeder 1298*3f542974SPaul B Schroeder /* Check for Buffer status */ 1299*3f542974SPaul B Schroeder if (count <= 0) { 1300*3f542974SPaul B Schroeder return; 1301*3f542974SPaul B Schroeder } 1302*3f542974SPaul B Schroeder 1303*3f542974SPaul B Schroeder /* Block the thread for a while */ 1304*3f542974SPaul B Schroeder interruptible_sleep_on_timeout(&mos7840_port->wait_chase, 1305*3f542974SPaul B Schroeder timeout); 1306*3f542974SPaul B Schroeder /* No activity.. count down section */ 1307*3f542974SPaul B Schroeder wait--; 1308*3f542974SPaul B Schroeder if (wait == 0) { 1309*3f542974SPaul B Schroeder dbg("%s - TIMEOUT", __FUNCTION__); 1310*3f542974SPaul B Schroeder return; 1311*3f542974SPaul B Schroeder } else { 1312*3f542974SPaul B Schroeder /* Reset timout value back to seconds */ 1313*3f542974SPaul B Schroeder wait = 10; 1314*3f542974SPaul B Schroeder } 1315*3f542974SPaul B Schroeder } 1316*3f542974SPaul B Schroeder 1317*3f542974SPaul B Schroeder } 1318*3f542974SPaul B Schroeder 1319*3f542974SPaul B Schroeder /***************************************************************************** 1320*3f542974SPaul B Schroeder * mos7840_break 1321*3f542974SPaul B Schroeder * this function sends a break to the port 1322*3f542974SPaul B Schroeder *****************************************************************************/ 1323*3f542974SPaul B Schroeder static void mos7840_break(struct usb_serial_port *port, int break_state) 1324*3f542974SPaul B Schroeder { 1325*3f542974SPaul B Schroeder unsigned char data; 1326*3f542974SPaul B Schroeder struct usb_serial *serial; 1327*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 1328*3f542974SPaul B Schroeder 1329*3f542974SPaul B Schroeder dbg("%s \n", "Entering ..........."); 1330*3f542974SPaul B Schroeder dbg("mos7840_break: Start\n"); 1331*3f542974SPaul B Schroeder 1332*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 1333*3f542974SPaul B Schroeder dbg("%s", "Port Paranoia failed \n"); 1334*3f542974SPaul B Schroeder return; 1335*3f542974SPaul B Schroeder } 1336*3f542974SPaul B Schroeder 1337*3f542974SPaul B Schroeder serial = mos7840_get_usb_serial(port, __FUNCTION__); 1338*3f542974SPaul B Schroeder if (!serial) { 1339*3f542974SPaul B Schroeder dbg("%s", "Serial Paranoia failed \n"); 1340*3f542974SPaul B Schroeder return; 1341*3f542974SPaul B Schroeder } 1342*3f542974SPaul B Schroeder 1343*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 1344*3f542974SPaul B Schroeder 1345*3f542974SPaul B Schroeder if (mos7840_port == NULL) { 1346*3f542974SPaul B Schroeder return; 1347*3f542974SPaul B Schroeder } 1348*3f542974SPaul B Schroeder 1349*3f542974SPaul B Schroeder if (serial->dev) { 1350*3f542974SPaul B Schroeder 1351*3f542974SPaul B Schroeder /* flush and block until tx is empty */ 1352*3f542974SPaul B Schroeder mos7840_block_until_chase_response(mos7840_port); 1353*3f542974SPaul B Schroeder } 1354*3f542974SPaul B Schroeder 1355*3f542974SPaul B Schroeder if (break_state == -1) { 1356*3f542974SPaul B Schroeder data = mos7840_port->shadowLCR | LCR_SET_BREAK; 1357*3f542974SPaul B Schroeder } else { 1358*3f542974SPaul B Schroeder data = mos7840_port->shadowLCR & ~LCR_SET_BREAK; 1359*3f542974SPaul B Schroeder } 1360*3f542974SPaul B Schroeder 1361*3f542974SPaul B Schroeder mos7840_port->shadowLCR = data; 1362*3f542974SPaul B Schroeder dbg("mcs7840_break mos7840_port->shadowLCR is %x\n", 1363*3f542974SPaul B Schroeder mos7840_port->shadowLCR); 1364*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, 1365*3f542974SPaul B Schroeder mos7840_port->shadowLCR); 1366*3f542974SPaul B Schroeder 1367*3f542974SPaul B Schroeder return; 1368*3f542974SPaul B Schroeder } 1369*3f542974SPaul B Schroeder 1370*3f542974SPaul B Schroeder /***************************************************************************** 1371*3f542974SPaul B Schroeder * mos7840_write_room 1372*3f542974SPaul B Schroeder * this function is called by the tty driver when it wants to know how many 1373*3f542974SPaul B Schroeder * bytes of data we can accept for a specific port. 1374*3f542974SPaul B Schroeder * If successful, we return the amount of room that we have for this port 1375*3f542974SPaul B Schroeder * Otherwise we return a negative error number. 1376*3f542974SPaul B Schroeder *****************************************************************************/ 1377*3f542974SPaul B Schroeder 1378*3f542974SPaul B Schroeder static int mos7840_write_room(struct usb_serial_port *port) 1379*3f542974SPaul B Schroeder { 1380*3f542974SPaul B Schroeder int i; 1381*3f542974SPaul B Schroeder int room = 0; 1382*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 1383*3f542974SPaul B Schroeder 1384*3f542974SPaul B Schroeder dbg("%s \n", " mos7840_write_room:entering ..........."); 1385*3f542974SPaul B Schroeder 1386*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 1387*3f542974SPaul B Schroeder dbg("%s", "Invalid port \n"); 1388*3f542974SPaul B Schroeder dbg("%s \n", " mos7840_write_room:leaving ..........."); 1389*3f542974SPaul B Schroeder return -1; 1390*3f542974SPaul B Schroeder } 1391*3f542974SPaul B Schroeder 1392*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 1393*3f542974SPaul B Schroeder if (mos7840_port == NULL) { 1394*3f542974SPaul B Schroeder dbg("%s \n", "mos7840_break:leaving ..........."); 1395*3f542974SPaul B Schroeder return -1; 1396*3f542974SPaul B Schroeder } 1397*3f542974SPaul B Schroeder 1398*3f542974SPaul B Schroeder for (i = 0; i < NUM_URBS; ++i) { 1399*3f542974SPaul B Schroeder if (mos7840_port->write_urb_pool[i]->status != -EINPROGRESS) { 1400*3f542974SPaul B Schroeder room += URB_TRANSFER_BUFFER_SIZE; 1401*3f542974SPaul B Schroeder } 1402*3f542974SPaul B Schroeder } 1403*3f542974SPaul B Schroeder 1404*3f542974SPaul B Schroeder dbg("%s - returns %d", __FUNCTION__, room); 1405*3f542974SPaul B Schroeder return (room); 1406*3f542974SPaul B Schroeder 1407*3f542974SPaul B Schroeder } 1408*3f542974SPaul B Schroeder 1409*3f542974SPaul B Schroeder /***************************************************************************** 1410*3f542974SPaul B Schroeder * mos7840_write 1411*3f542974SPaul B Schroeder * this function is called by the tty driver when data should be written to 1412*3f542974SPaul B Schroeder * the port. 1413*3f542974SPaul B Schroeder * If successful, we return the number of bytes written, otherwise we 1414*3f542974SPaul B Schroeder * return a negative error number. 1415*3f542974SPaul B Schroeder *****************************************************************************/ 1416*3f542974SPaul B Schroeder 1417*3f542974SPaul B Schroeder static int mos7840_write(struct usb_serial_port *port, 1418*3f542974SPaul B Schroeder const unsigned char *data, int count) 1419*3f542974SPaul B Schroeder { 1420*3f542974SPaul B Schroeder int status; 1421*3f542974SPaul B Schroeder int i; 1422*3f542974SPaul B Schroeder int bytes_sent = 0; 1423*3f542974SPaul B Schroeder int transfer_size; 1424*3f542974SPaul B Schroeder int from_user = 0; 1425*3f542974SPaul B Schroeder 1426*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 1427*3f542974SPaul B Schroeder struct usb_serial *serial; 1428*3f542974SPaul B Schroeder struct urb *urb; 1429*3f542974SPaul B Schroeder //__u16 Data; 1430*3f542974SPaul B Schroeder const unsigned char *current_position = data; 1431*3f542974SPaul B Schroeder unsigned char *data1; 1432*3f542974SPaul B Schroeder dbg("%s \n", "entering ..........."); 1433*3f542974SPaul B Schroeder //dbg("mos7840_write: mos7840_port->shadowLCR is %x\n",mos7840_port->shadowLCR); 1434*3f542974SPaul B Schroeder 1435*3f542974SPaul B Schroeder #ifdef NOTMOS7840 1436*3f542974SPaul B Schroeder Data = 0x00; 1437*3f542974SPaul B Schroeder status = 0; 1438*3f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data); 1439*3f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 1440*3f542974SPaul B Schroeder dbg("mos7840_write: LINE_CONTROL_REGISTER is %x\n", Data); 1441*3f542974SPaul B Schroeder dbg("mos7840_write: mos7840_port->shadowLCR is %x\n", 1442*3f542974SPaul B Schroeder mos7840_port->shadowLCR); 1443*3f542974SPaul B Schroeder 1444*3f542974SPaul B Schroeder //Data = 0x03; 1445*3f542974SPaul B Schroeder //status = mos7840_set_uart_reg(port,LINE_CONTROL_REGISTER,Data); 1446*3f542974SPaul B Schroeder //mos7840_port->shadowLCR=Data;//Need to add later 1447*3f542974SPaul B Schroeder 1448*3f542974SPaul B Schroeder Data |= SERIAL_LCR_DLAB; //data latch enable in LCR 0x80 1449*3f542974SPaul B Schroeder status = 0; 1450*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 1451*3f542974SPaul B Schroeder 1452*3f542974SPaul B Schroeder //Data = 0x0c; 1453*3f542974SPaul B Schroeder //status = mos7840_set_uart_reg(port,DIVISOR_LATCH_LSB,Data); 1454*3f542974SPaul B Schroeder Data = 0x00; 1455*3f542974SPaul B Schroeder status = 0; 1456*3f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, DIVISOR_LATCH_LSB, &Data); 1457*3f542974SPaul B Schroeder dbg("mos7840_write:DLL value is %x\n", Data); 1458*3f542974SPaul B Schroeder 1459*3f542974SPaul B Schroeder Data = 0x0; 1460*3f542974SPaul B Schroeder status = 0; 1461*3f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, DIVISOR_LATCH_MSB, &Data); 1462*3f542974SPaul B Schroeder dbg("mos7840_write:DLM value is %x\n", Data); 1463*3f542974SPaul B Schroeder 1464*3f542974SPaul B Schroeder Data = Data & ~SERIAL_LCR_DLAB; 1465*3f542974SPaul B Schroeder dbg("mos7840_write: mos7840_port->shadowLCR is %x\n", 1466*3f542974SPaul B Schroeder mos7840_port->shadowLCR); 1467*3f542974SPaul B Schroeder status = 0; 1468*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 1469*3f542974SPaul B Schroeder #endif 1470*3f542974SPaul B Schroeder 1471*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 1472*3f542974SPaul B Schroeder dbg("%s", "Port Paranoia failed \n"); 1473*3f542974SPaul B Schroeder return -1; 1474*3f542974SPaul B Schroeder } 1475*3f542974SPaul B Schroeder 1476*3f542974SPaul B Schroeder serial = port->serial; 1477*3f542974SPaul B Schroeder if (mos7840_serial_paranoia_check(serial, __FUNCTION__)) { 1478*3f542974SPaul B Schroeder dbg("%s", "Serial Paranoia failed \n"); 1479*3f542974SPaul B Schroeder return -1; 1480*3f542974SPaul B Schroeder } 1481*3f542974SPaul B Schroeder 1482*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 1483*3f542974SPaul B Schroeder if (mos7840_port == NULL) { 1484*3f542974SPaul B Schroeder dbg("%s", "mos7840_port is NULL\n"); 1485*3f542974SPaul B Schroeder return -1; 1486*3f542974SPaul B Schroeder } 1487*3f542974SPaul B Schroeder 1488*3f542974SPaul B Schroeder /* try to find a free urb in the list */ 1489*3f542974SPaul B Schroeder urb = NULL; 1490*3f542974SPaul B Schroeder 1491*3f542974SPaul B Schroeder for (i = 0; i < NUM_URBS; ++i) { 1492*3f542974SPaul B Schroeder if (mos7840_port->write_urb_pool[i]->status != -EINPROGRESS) { 1493*3f542974SPaul B Schroeder urb = mos7840_port->write_urb_pool[i]; 1494*3f542974SPaul B Schroeder dbg("\nURB:%d", i); 1495*3f542974SPaul B Schroeder break; 1496*3f542974SPaul B Schroeder } 1497*3f542974SPaul B Schroeder } 1498*3f542974SPaul B Schroeder 1499*3f542974SPaul B Schroeder if (urb == NULL) { 1500*3f542974SPaul B Schroeder dbg("%s - no more free urbs", __FUNCTION__); 1501*3f542974SPaul B Schroeder goto exit; 1502*3f542974SPaul B Schroeder } 1503*3f542974SPaul B Schroeder 1504*3f542974SPaul B Schroeder if (urb->transfer_buffer == NULL) { 1505*3f542974SPaul B Schroeder urb->transfer_buffer = 1506*3f542974SPaul B Schroeder kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL); 1507*3f542974SPaul B Schroeder 1508*3f542974SPaul B Schroeder if (urb->transfer_buffer == NULL) { 1509*3f542974SPaul B Schroeder err("%s no more kernel memory...", __FUNCTION__); 1510*3f542974SPaul B Schroeder goto exit; 1511*3f542974SPaul B Schroeder } 1512*3f542974SPaul B Schroeder } 1513*3f542974SPaul B Schroeder transfer_size = min(count, URB_TRANSFER_BUFFER_SIZE); 1514*3f542974SPaul B Schroeder 1515*3f542974SPaul B Schroeder if (from_user) { 1516*3f542974SPaul B Schroeder if (copy_from_user 1517*3f542974SPaul B Schroeder (urb->transfer_buffer, current_position, transfer_size)) { 1518*3f542974SPaul B Schroeder bytes_sent = -EFAULT; 1519*3f542974SPaul B Schroeder goto exit; 1520*3f542974SPaul B Schroeder } 1521*3f542974SPaul B Schroeder } else { 1522*3f542974SPaul B Schroeder memcpy(urb->transfer_buffer, current_position, transfer_size); 1523*3f542974SPaul B Schroeder } 1524*3f542974SPaul B Schroeder 1525*3f542974SPaul B Schroeder /* fill urb with data and submit */ 1526*3f542974SPaul B Schroeder usb_fill_bulk_urb(urb, 1527*3f542974SPaul B Schroeder serial->dev, 1528*3f542974SPaul B Schroeder usb_sndbulkpipe(serial->dev, 1529*3f542974SPaul B Schroeder port->bulk_out_endpointAddress), 1530*3f542974SPaul B Schroeder urb->transfer_buffer, 1531*3f542974SPaul B Schroeder transfer_size, 1532*3f542974SPaul B Schroeder mos7840_bulk_out_data_callback, mos7840_port); 1533*3f542974SPaul B Schroeder 1534*3f542974SPaul B Schroeder data1 = urb->transfer_buffer; 1535*3f542974SPaul B Schroeder dbg("\nbulkout endpoint is %d", port->bulk_out_endpointAddress); 1536*3f542974SPaul B Schroeder 1537*3f542974SPaul B Schroeder /* send it down the pipe */ 1538*3f542974SPaul B Schroeder status = usb_submit_urb(urb, GFP_ATOMIC); 1539*3f542974SPaul B Schroeder 1540*3f542974SPaul B Schroeder if (status) { 1541*3f542974SPaul B Schroeder err("%s - usb_submit_urb(write bulk) failed with status = %d", 1542*3f542974SPaul B Schroeder __FUNCTION__, status); 1543*3f542974SPaul B Schroeder bytes_sent = status; 1544*3f542974SPaul B Schroeder goto exit; 1545*3f542974SPaul B Schroeder } 1546*3f542974SPaul B Schroeder bytes_sent = transfer_size; 1547*3f542974SPaul B Schroeder mos7840_port->icount.tx += transfer_size; 1548*3f542974SPaul B Schroeder dbg("mos7840_port->icount.tx is %d:\n", mos7840_port->icount.tx); 1549*3f542974SPaul B Schroeder exit: 1550*3f542974SPaul B Schroeder 1551*3f542974SPaul B Schroeder return bytes_sent; 1552*3f542974SPaul B Schroeder 1553*3f542974SPaul B Schroeder } 1554*3f542974SPaul B Schroeder 1555*3f542974SPaul B Schroeder /***************************************************************************** 1556*3f542974SPaul B Schroeder * mos7840_throttle 1557*3f542974SPaul B Schroeder * this function is called by the tty driver when it wants to stop the data 1558*3f542974SPaul B Schroeder * being read from the port. 1559*3f542974SPaul B Schroeder *****************************************************************************/ 1560*3f542974SPaul B Schroeder 1561*3f542974SPaul B Schroeder static void mos7840_throttle(struct usb_serial_port *port) 1562*3f542974SPaul B Schroeder { 1563*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 1564*3f542974SPaul B Schroeder struct tty_struct *tty; 1565*3f542974SPaul B Schroeder int status; 1566*3f542974SPaul B Schroeder 1567*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 1568*3f542974SPaul B Schroeder dbg("%s", "Invalid port \n"); 1569*3f542974SPaul B Schroeder return; 1570*3f542974SPaul B Schroeder } 1571*3f542974SPaul B Schroeder 1572*3f542974SPaul B Schroeder dbg("- port %d\n", port->number); 1573*3f542974SPaul B Schroeder 1574*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 1575*3f542974SPaul B Schroeder 1576*3f542974SPaul B Schroeder if (mos7840_port == NULL) 1577*3f542974SPaul B Schroeder return; 1578*3f542974SPaul B Schroeder 1579*3f542974SPaul B Schroeder if (!mos7840_port->open) { 1580*3f542974SPaul B Schroeder dbg("%s\n", "port not opened"); 1581*3f542974SPaul B Schroeder return; 1582*3f542974SPaul B Schroeder } 1583*3f542974SPaul B Schroeder 1584*3f542974SPaul B Schroeder dbg("%s", "Entering .......... \n"); 1585*3f542974SPaul B Schroeder 1586*3f542974SPaul B Schroeder tty = port->tty; 1587*3f542974SPaul B Schroeder if (!tty) { 1588*3f542974SPaul B Schroeder dbg("%s - no tty available", __FUNCTION__); 1589*3f542974SPaul B Schroeder return; 1590*3f542974SPaul B Schroeder } 1591*3f542974SPaul B Schroeder 1592*3f542974SPaul B Schroeder /* if we are implementing XON/XOFF, send the stop character */ 1593*3f542974SPaul B Schroeder if (I_IXOFF(tty)) { 1594*3f542974SPaul B Schroeder unsigned char stop_char = STOP_CHAR(tty); 1595*3f542974SPaul B Schroeder status = mos7840_write(port, &stop_char, 1); 1596*3f542974SPaul B Schroeder if (status <= 0) { 1597*3f542974SPaul B Schroeder return; 1598*3f542974SPaul B Schroeder } 1599*3f542974SPaul B Schroeder } 1600*3f542974SPaul B Schroeder 1601*3f542974SPaul B Schroeder /* if we are implementing RTS/CTS, toggle that line */ 1602*3f542974SPaul B Schroeder if (tty->termios->c_cflag & CRTSCTS) { 1603*3f542974SPaul B Schroeder mos7840_port->shadowMCR &= ~MCR_RTS; 1604*3f542974SPaul B Schroeder status = 0; 1605*3f542974SPaul B Schroeder status = 1606*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, 1607*3f542974SPaul B Schroeder mos7840_port->shadowMCR); 1608*3f542974SPaul B Schroeder 1609*3f542974SPaul B Schroeder if (status < 0) { 1610*3f542974SPaul B Schroeder return; 1611*3f542974SPaul B Schroeder } 1612*3f542974SPaul B Schroeder } 1613*3f542974SPaul B Schroeder 1614*3f542974SPaul B Schroeder return; 1615*3f542974SPaul B Schroeder } 1616*3f542974SPaul B Schroeder 1617*3f542974SPaul B Schroeder /***************************************************************************** 1618*3f542974SPaul B Schroeder * mos7840_unthrottle 1619*3f542974SPaul B Schroeder * this function is called by the tty driver when it wants to resume the data 1620*3f542974SPaul B Schroeder * being read from the port (called after SerialThrottle is called) 1621*3f542974SPaul B Schroeder *****************************************************************************/ 1622*3f542974SPaul B Schroeder static void mos7840_unthrottle(struct usb_serial_port *port) 1623*3f542974SPaul B Schroeder { 1624*3f542974SPaul B Schroeder struct tty_struct *tty; 1625*3f542974SPaul B Schroeder int status; 1626*3f542974SPaul B Schroeder struct moschip_port *mos7840_port = mos7840_get_port_private(port); 1627*3f542974SPaul B Schroeder 1628*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 1629*3f542974SPaul B Schroeder dbg("%s", "Invalid port \n"); 1630*3f542974SPaul B Schroeder return; 1631*3f542974SPaul B Schroeder } 1632*3f542974SPaul B Schroeder 1633*3f542974SPaul B Schroeder if (mos7840_port == NULL) 1634*3f542974SPaul B Schroeder return; 1635*3f542974SPaul B Schroeder 1636*3f542974SPaul B Schroeder if (!mos7840_port->open) { 1637*3f542974SPaul B Schroeder dbg("%s - port not opened", __FUNCTION__); 1638*3f542974SPaul B Schroeder return; 1639*3f542974SPaul B Schroeder } 1640*3f542974SPaul B Schroeder 1641*3f542974SPaul B Schroeder dbg("%s", "Entering .......... \n"); 1642*3f542974SPaul B Schroeder 1643*3f542974SPaul B Schroeder tty = port->tty; 1644*3f542974SPaul B Schroeder if (!tty) { 1645*3f542974SPaul B Schroeder dbg("%s - no tty available", __FUNCTION__); 1646*3f542974SPaul B Schroeder return; 1647*3f542974SPaul B Schroeder } 1648*3f542974SPaul B Schroeder 1649*3f542974SPaul B Schroeder /* if we are implementing XON/XOFF, send the start character */ 1650*3f542974SPaul B Schroeder if (I_IXOFF(tty)) { 1651*3f542974SPaul B Schroeder unsigned char start_char = START_CHAR(tty); 1652*3f542974SPaul B Schroeder status = mos7840_write(port, &start_char, 1); 1653*3f542974SPaul B Schroeder if (status <= 0) { 1654*3f542974SPaul B Schroeder return; 1655*3f542974SPaul B Schroeder } 1656*3f542974SPaul B Schroeder } 1657*3f542974SPaul B Schroeder 1658*3f542974SPaul B Schroeder /* if we are implementing RTS/CTS, toggle that line */ 1659*3f542974SPaul B Schroeder if (tty->termios->c_cflag & CRTSCTS) { 1660*3f542974SPaul B Schroeder mos7840_port->shadowMCR |= MCR_RTS; 1661*3f542974SPaul B Schroeder status = 0; 1662*3f542974SPaul B Schroeder status = 1663*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, 1664*3f542974SPaul B Schroeder mos7840_port->shadowMCR); 1665*3f542974SPaul B Schroeder if (status < 0) { 1666*3f542974SPaul B Schroeder return; 1667*3f542974SPaul B Schroeder } 1668*3f542974SPaul B Schroeder } 1669*3f542974SPaul B Schroeder 1670*3f542974SPaul B Schroeder return; 1671*3f542974SPaul B Schroeder } 1672*3f542974SPaul B Schroeder 1673*3f542974SPaul B Schroeder static int mos7840_tiocmget(struct usb_serial_port *port, struct file *file) 1674*3f542974SPaul B Schroeder { 1675*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 1676*3f542974SPaul B Schroeder unsigned int result; 1677*3f542974SPaul B Schroeder __u16 msr; 1678*3f542974SPaul B Schroeder __u16 mcr; 1679*3f542974SPaul B Schroeder int status = 0; 1680*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 1681*3f542974SPaul B Schroeder 1682*3f542974SPaul B Schroeder dbg("%s - port %d", __FUNCTION__, port->number); 1683*3f542974SPaul B Schroeder 1684*3f542974SPaul B Schroeder if (mos7840_port == NULL) 1685*3f542974SPaul B Schroeder return -ENODEV; 1686*3f542974SPaul B Schroeder 1687*3f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, MODEM_STATUS_REGISTER, &msr); 1688*3f542974SPaul B Schroeder status = mos7840_get_uart_reg(port, MODEM_CONTROL_REGISTER, &mcr); 1689*3f542974SPaul B Schroeder result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0) 1690*3f542974SPaul B Schroeder | ((mcr & MCR_RTS) ? TIOCM_RTS : 0) 1691*3f542974SPaul B Schroeder | ((mcr & MCR_LOOPBACK) ? TIOCM_LOOP : 0) 1692*3f542974SPaul B Schroeder | ((msr & MOS7840_MSR_CTS) ? TIOCM_CTS : 0) 1693*3f542974SPaul B Schroeder | ((msr & MOS7840_MSR_CD) ? TIOCM_CAR : 0) 1694*3f542974SPaul B Schroeder | ((msr & MOS7840_MSR_RI) ? TIOCM_RI : 0) 1695*3f542974SPaul B Schroeder | ((msr & MOS7840_MSR_DSR) ? TIOCM_DSR : 0); 1696*3f542974SPaul B Schroeder 1697*3f542974SPaul B Schroeder dbg("%s - 0x%04X", __FUNCTION__, result); 1698*3f542974SPaul B Schroeder 1699*3f542974SPaul B Schroeder return result; 1700*3f542974SPaul B Schroeder } 1701*3f542974SPaul B Schroeder 1702*3f542974SPaul B Schroeder static int mos7840_tiocmset(struct usb_serial_port *port, struct file *file, 1703*3f542974SPaul B Schroeder unsigned int set, unsigned int clear) 1704*3f542974SPaul B Schroeder { 1705*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 1706*3f542974SPaul B Schroeder unsigned int mcr; 1707*3f542974SPaul B Schroeder unsigned int status; 1708*3f542974SPaul B Schroeder 1709*3f542974SPaul B Schroeder dbg("%s - port %d", __FUNCTION__, port->number); 1710*3f542974SPaul B Schroeder 1711*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 1712*3f542974SPaul B Schroeder 1713*3f542974SPaul B Schroeder if (mos7840_port == NULL) 1714*3f542974SPaul B Schroeder return -ENODEV; 1715*3f542974SPaul B Schroeder 1716*3f542974SPaul B Schroeder mcr = mos7840_port->shadowMCR; 1717*3f542974SPaul B Schroeder if (clear & TIOCM_RTS) 1718*3f542974SPaul B Schroeder mcr &= ~MCR_RTS; 1719*3f542974SPaul B Schroeder if (clear & TIOCM_DTR) 1720*3f542974SPaul B Schroeder mcr &= ~MCR_DTR; 1721*3f542974SPaul B Schroeder if (clear & TIOCM_LOOP) 1722*3f542974SPaul B Schroeder mcr &= ~MCR_LOOPBACK; 1723*3f542974SPaul B Schroeder 1724*3f542974SPaul B Schroeder if (set & TIOCM_RTS) 1725*3f542974SPaul B Schroeder mcr |= MCR_RTS; 1726*3f542974SPaul B Schroeder if (set & TIOCM_DTR) 1727*3f542974SPaul B Schroeder mcr |= MCR_DTR; 1728*3f542974SPaul B Schroeder if (set & TIOCM_LOOP) 1729*3f542974SPaul B Schroeder mcr |= MCR_LOOPBACK; 1730*3f542974SPaul B Schroeder 1731*3f542974SPaul B Schroeder mos7840_port->shadowMCR = mcr; 1732*3f542974SPaul B Schroeder 1733*3f542974SPaul B Schroeder status = 0; 1734*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, mcr); 1735*3f542974SPaul B Schroeder if (status < 0) { 1736*3f542974SPaul B Schroeder dbg("setting MODEM_CONTROL_REGISTER Failed\n"); 1737*3f542974SPaul B Schroeder return -1; 1738*3f542974SPaul B Schroeder } 1739*3f542974SPaul B Schroeder 1740*3f542974SPaul B Schroeder return 0; 1741*3f542974SPaul B Schroeder } 1742*3f542974SPaul B Schroeder 1743*3f542974SPaul B Schroeder /***************************************************************************** 1744*3f542974SPaul B Schroeder * mos7840_calc_baud_rate_divisor 1745*3f542974SPaul B Schroeder * this function calculates the proper baud rate divisor for the specified 1746*3f542974SPaul B Schroeder * baud rate. 1747*3f542974SPaul B Schroeder *****************************************************************************/ 1748*3f542974SPaul B Schroeder static int mos7840_calc_baud_rate_divisor(int baudRate, int *divisor, 1749*3f542974SPaul B Schroeder __u16 * clk_sel_val) 1750*3f542974SPaul B Schroeder { 1751*3f542974SPaul B Schroeder 1752*3f542974SPaul B Schroeder dbg("%s - %d", __FUNCTION__, baudRate); 1753*3f542974SPaul B Schroeder 1754*3f542974SPaul B Schroeder if (baudRate <= 115200) { 1755*3f542974SPaul B Schroeder *divisor = 115200 / baudRate; 1756*3f542974SPaul B Schroeder *clk_sel_val = 0x0; 1757*3f542974SPaul B Schroeder } 1758*3f542974SPaul B Schroeder if ((baudRate > 115200) && (baudRate <= 230400)) { 1759*3f542974SPaul B Schroeder *divisor = 230400 / baudRate; 1760*3f542974SPaul B Schroeder *clk_sel_val = 0x10; 1761*3f542974SPaul B Schroeder } else if ((baudRate > 230400) && (baudRate <= 403200)) { 1762*3f542974SPaul B Schroeder *divisor = 403200 / baudRate; 1763*3f542974SPaul B Schroeder *clk_sel_val = 0x20; 1764*3f542974SPaul B Schroeder } else if ((baudRate > 403200) && (baudRate <= 460800)) { 1765*3f542974SPaul B Schroeder *divisor = 460800 / baudRate; 1766*3f542974SPaul B Schroeder *clk_sel_val = 0x30; 1767*3f542974SPaul B Schroeder } else if ((baudRate > 460800) && (baudRate <= 806400)) { 1768*3f542974SPaul B Schroeder *divisor = 806400 / baudRate; 1769*3f542974SPaul B Schroeder *clk_sel_val = 0x40; 1770*3f542974SPaul B Schroeder } else if ((baudRate > 806400) && (baudRate <= 921600)) { 1771*3f542974SPaul B Schroeder *divisor = 921600 / baudRate; 1772*3f542974SPaul B Schroeder *clk_sel_val = 0x50; 1773*3f542974SPaul B Schroeder } else if ((baudRate > 921600) && (baudRate <= 1572864)) { 1774*3f542974SPaul B Schroeder *divisor = 1572864 / baudRate; 1775*3f542974SPaul B Schroeder *clk_sel_val = 0x60; 1776*3f542974SPaul B Schroeder } else if ((baudRate > 1572864) && (baudRate <= 3145728)) { 1777*3f542974SPaul B Schroeder *divisor = 3145728 / baudRate; 1778*3f542974SPaul B Schroeder *clk_sel_val = 0x70; 1779*3f542974SPaul B Schroeder } 1780*3f542974SPaul B Schroeder return 0; 1781*3f542974SPaul B Schroeder 1782*3f542974SPaul B Schroeder #ifdef NOTMCS7840 1783*3f542974SPaul B Schroeder 1784*3f542974SPaul B Schroeder for (i = 0; i < ARRAY_SIZE(mos7840_divisor_table); i++) { 1785*3f542974SPaul B Schroeder if (mos7840_divisor_table[i].BaudRate == baudrate) { 1786*3f542974SPaul B Schroeder *divisor = mos7840_divisor_table[i].Divisor; 1787*3f542974SPaul B Schroeder return 0; 1788*3f542974SPaul B Schroeder } 1789*3f542974SPaul B Schroeder } 1790*3f542974SPaul B Schroeder 1791*3f542974SPaul B Schroeder /* After trying for all the standard baud rates * 1792*3f542974SPaul B Schroeder * Try calculating the divisor for this baud rate */ 1793*3f542974SPaul B Schroeder 1794*3f542974SPaul B Schroeder if (baudrate > 75 && baudrate < 230400) { 1795*3f542974SPaul B Schroeder /* get the divisor */ 1796*3f542974SPaul B Schroeder custom = (__u16) (230400L / baudrate); 1797*3f542974SPaul B Schroeder 1798*3f542974SPaul B Schroeder /* Check for round off */ 1799*3f542974SPaul B Schroeder round1 = (__u16) (2304000L / baudrate); 1800*3f542974SPaul B Schroeder round = (__u16) (round1 - (custom * 10)); 1801*3f542974SPaul B Schroeder if (round > 4) { 1802*3f542974SPaul B Schroeder custom++; 1803*3f542974SPaul B Schroeder } 1804*3f542974SPaul B Schroeder *divisor = custom; 1805*3f542974SPaul B Schroeder 1806*3f542974SPaul B Schroeder dbg(" Baud %d = %d\n", baudrate, custom); 1807*3f542974SPaul B Schroeder return 0; 1808*3f542974SPaul B Schroeder } 1809*3f542974SPaul B Schroeder 1810*3f542974SPaul B Schroeder dbg("%s\n", " Baud calculation Failed..."); 1811*3f542974SPaul B Schroeder return -1; 1812*3f542974SPaul B Schroeder #endif 1813*3f542974SPaul B Schroeder } 1814*3f542974SPaul B Schroeder 1815*3f542974SPaul B Schroeder /***************************************************************************** 1816*3f542974SPaul B Schroeder * mos7840_send_cmd_write_baud_rate 1817*3f542974SPaul B Schroeder * this function sends the proper command to change the baud rate of the 1818*3f542974SPaul B Schroeder * specified port. 1819*3f542974SPaul B Schroeder *****************************************************************************/ 1820*3f542974SPaul B Schroeder 1821*3f542974SPaul B Schroeder static int mos7840_send_cmd_write_baud_rate(struct moschip_port *mos7840_port, 1822*3f542974SPaul B Schroeder int baudRate) 1823*3f542974SPaul B Schroeder { 1824*3f542974SPaul B Schroeder int divisor = 0; 1825*3f542974SPaul B Schroeder int status; 1826*3f542974SPaul B Schroeder __u16 Data; 1827*3f542974SPaul B Schroeder unsigned char number; 1828*3f542974SPaul B Schroeder __u16 clk_sel_val; 1829*3f542974SPaul B Schroeder struct usb_serial_port *port; 1830*3f542974SPaul B Schroeder 1831*3f542974SPaul B Schroeder if (mos7840_port == NULL) 1832*3f542974SPaul B Schroeder return -1; 1833*3f542974SPaul B Schroeder 1834*3f542974SPaul B Schroeder port = (struct usb_serial_port *)mos7840_port->port; 1835*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 1836*3f542974SPaul B Schroeder dbg("%s", "Invalid port \n"); 1837*3f542974SPaul B Schroeder return -1; 1838*3f542974SPaul B Schroeder } 1839*3f542974SPaul B Schroeder 1840*3f542974SPaul B Schroeder if (mos7840_serial_paranoia_check(port->serial, __FUNCTION__)) { 1841*3f542974SPaul B Schroeder dbg("%s", "Invalid Serial \n"); 1842*3f542974SPaul B Schroeder return -1; 1843*3f542974SPaul B Schroeder } 1844*3f542974SPaul B Schroeder 1845*3f542974SPaul B Schroeder dbg("%s", "Entering .......... \n"); 1846*3f542974SPaul B Schroeder 1847*3f542974SPaul B Schroeder number = mos7840_port->port->number - mos7840_port->port->serial->minor; 1848*3f542974SPaul B Schroeder 1849*3f542974SPaul B Schroeder dbg("%s - port = %d, baud = %d", __FUNCTION__, 1850*3f542974SPaul B Schroeder mos7840_port->port->number, baudRate); 1851*3f542974SPaul B Schroeder //reset clk_uart_sel in spregOffset 1852*3f542974SPaul B Schroeder if (baudRate > 115200) { 1853*3f542974SPaul B Schroeder #ifdef HW_flow_control 1854*3f542974SPaul B Schroeder //NOTE: need to see the pther register to modify 1855*3f542974SPaul B Schroeder //setting h/w flow control bit to 1; 1856*3f542974SPaul B Schroeder status = 0; 1857*3f542974SPaul B Schroeder Data = 0x2b; 1858*3f542974SPaul B Schroeder mos7840_port->shadowMCR = Data; 1859*3f542974SPaul B Schroeder status = 1860*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 1861*3f542974SPaul B Schroeder if (status < 0) { 1862*3f542974SPaul B Schroeder dbg("Writing spreg failed in set_serial_baud\n"); 1863*3f542974SPaul B Schroeder return -1; 1864*3f542974SPaul B Schroeder } 1865*3f542974SPaul B Schroeder #endif 1866*3f542974SPaul B Schroeder 1867*3f542974SPaul B Schroeder } else { 1868*3f542974SPaul B Schroeder #ifdef HW_flow_control 1869*3f542974SPaul B Schroeder //setting h/w flow control bit to 0; 1870*3f542974SPaul B Schroeder status = 0; 1871*3f542974SPaul B Schroeder Data = 0xb; 1872*3f542974SPaul B Schroeder mos7840_port->shadowMCR = Data; 1873*3f542974SPaul B Schroeder status = 1874*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 1875*3f542974SPaul B Schroeder if (status < 0) { 1876*3f542974SPaul B Schroeder dbg("Writing spreg failed in set_serial_baud\n"); 1877*3f542974SPaul B Schroeder return -1; 1878*3f542974SPaul B Schroeder } 1879*3f542974SPaul B Schroeder #endif 1880*3f542974SPaul B Schroeder 1881*3f542974SPaul B Schroeder } 1882*3f542974SPaul B Schroeder 1883*3f542974SPaul B Schroeder if (1) //baudRate <= 115200) 1884*3f542974SPaul B Schroeder { 1885*3f542974SPaul B Schroeder clk_sel_val = 0x0; 1886*3f542974SPaul B Schroeder Data = 0x0; 1887*3f542974SPaul B Schroeder status = 0; 1888*3f542974SPaul B Schroeder status = 1889*3f542974SPaul B Schroeder mos7840_calc_baud_rate_divisor(baudRate, &divisor, 1890*3f542974SPaul B Schroeder &clk_sel_val); 1891*3f542974SPaul B Schroeder status = 1892*3f542974SPaul B Schroeder mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, 1893*3f542974SPaul B Schroeder &Data); 1894*3f542974SPaul B Schroeder if (status < 0) { 1895*3f542974SPaul B Schroeder dbg("reading spreg failed in set_serial_baud\n"); 1896*3f542974SPaul B Schroeder return -1; 1897*3f542974SPaul B Schroeder } 1898*3f542974SPaul B Schroeder Data = (Data & 0x8f) | clk_sel_val; 1899*3f542974SPaul B Schroeder status = 0; 1900*3f542974SPaul B Schroeder status = 1901*3f542974SPaul B Schroeder mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data); 1902*3f542974SPaul B Schroeder if (status < 0) { 1903*3f542974SPaul B Schroeder dbg("Writing spreg failed in set_serial_baud\n"); 1904*3f542974SPaul B Schroeder return -1; 1905*3f542974SPaul B Schroeder } 1906*3f542974SPaul B Schroeder /* Calculate the Divisor */ 1907*3f542974SPaul B Schroeder 1908*3f542974SPaul B Schroeder if (status) { 1909*3f542974SPaul B Schroeder err("%s - bad baud rate", __FUNCTION__); 1910*3f542974SPaul B Schroeder dbg("%s\n", "bad baud rate"); 1911*3f542974SPaul B Schroeder return status; 1912*3f542974SPaul B Schroeder } 1913*3f542974SPaul B Schroeder /* Enable access to divisor latch */ 1914*3f542974SPaul B Schroeder Data = mos7840_port->shadowLCR | SERIAL_LCR_DLAB; 1915*3f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 1916*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 1917*3f542974SPaul B Schroeder 1918*3f542974SPaul B Schroeder /* Write the divisor */ 1919*3f542974SPaul B Schroeder Data = (unsigned char)(divisor & 0xff); 1920*3f542974SPaul B Schroeder dbg("set_serial_baud Value to write DLL is %x\n", Data); 1921*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data); 1922*3f542974SPaul B Schroeder 1923*3f542974SPaul B Schroeder Data = (unsigned char)((divisor & 0xff00) >> 8); 1924*3f542974SPaul B Schroeder dbg("set_serial_baud Value to write DLM is %x\n", Data); 1925*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data); 1926*3f542974SPaul B Schroeder 1927*3f542974SPaul B Schroeder /* Disable access to divisor latch */ 1928*3f542974SPaul B Schroeder Data = mos7840_port->shadowLCR & ~SERIAL_LCR_DLAB; 1929*3f542974SPaul B Schroeder mos7840_port->shadowLCR = Data; 1930*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 1931*3f542974SPaul B Schroeder 1932*3f542974SPaul B Schroeder } 1933*3f542974SPaul B Schroeder 1934*3f542974SPaul B Schroeder return status; 1935*3f542974SPaul B Schroeder } 1936*3f542974SPaul B Schroeder 1937*3f542974SPaul B Schroeder /***************************************************************************** 1938*3f542974SPaul B Schroeder * mos7840_change_port_settings 1939*3f542974SPaul B Schroeder * This routine is called to set the UART on the device to match 1940*3f542974SPaul B Schroeder * the specified new settings. 1941*3f542974SPaul B Schroeder *****************************************************************************/ 1942*3f542974SPaul B Schroeder 1943*3f542974SPaul B Schroeder static void mos7840_change_port_settings(struct moschip_port *mos7840_port, 1944*3f542974SPaul B Schroeder struct termios *old_termios) 1945*3f542974SPaul B Schroeder { 1946*3f542974SPaul B Schroeder struct tty_struct *tty; 1947*3f542974SPaul B Schroeder int baud; 1948*3f542974SPaul B Schroeder unsigned cflag; 1949*3f542974SPaul B Schroeder unsigned iflag; 1950*3f542974SPaul B Schroeder __u8 lData; 1951*3f542974SPaul B Schroeder __u8 lParity; 1952*3f542974SPaul B Schroeder __u8 lStop; 1953*3f542974SPaul B Schroeder int status; 1954*3f542974SPaul B Schroeder __u16 Data; 1955*3f542974SPaul B Schroeder struct usb_serial_port *port; 1956*3f542974SPaul B Schroeder struct usb_serial *serial; 1957*3f542974SPaul B Schroeder 1958*3f542974SPaul B Schroeder if (mos7840_port == NULL) 1959*3f542974SPaul B Schroeder return; 1960*3f542974SPaul B Schroeder 1961*3f542974SPaul B Schroeder port = (struct usb_serial_port *)mos7840_port->port; 1962*3f542974SPaul B Schroeder 1963*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 1964*3f542974SPaul B Schroeder dbg("%s", "Invalid port \n"); 1965*3f542974SPaul B Schroeder return; 1966*3f542974SPaul B Schroeder } 1967*3f542974SPaul B Schroeder 1968*3f542974SPaul B Schroeder if (mos7840_serial_paranoia_check(port->serial, __FUNCTION__)) { 1969*3f542974SPaul B Schroeder dbg("%s", "Invalid Serial \n"); 1970*3f542974SPaul B Schroeder return; 1971*3f542974SPaul B Schroeder } 1972*3f542974SPaul B Schroeder 1973*3f542974SPaul B Schroeder serial = port->serial; 1974*3f542974SPaul B Schroeder 1975*3f542974SPaul B Schroeder dbg("%s - port %d", __FUNCTION__, mos7840_port->port->number); 1976*3f542974SPaul B Schroeder 1977*3f542974SPaul B Schroeder if (!mos7840_port->open) { 1978*3f542974SPaul B Schroeder dbg("%s - port not opened", __FUNCTION__); 1979*3f542974SPaul B Schroeder return; 1980*3f542974SPaul B Schroeder } 1981*3f542974SPaul B Schroeder 1982*3f542974SPaul B Schroeder tty = mos7840_port->port->tty; 1983*3f542974SPaul B Schroeder 1984*3f542974SPaul B Schroeder if ((!tty) || (!tty->termios)) { 1985*3f542974SPaul B Schroeder dbg("%s - no tty structures", __FUNCTION__); 1986*3f542974SPaul B Schroeder return; 1987*3f542974SPaul B Schroeder } 1988*3f542974SPaul B Schroeder 1989*3f542974SPaul B Schroeder dbg("%s", "Entering .......... \n"); 1990*3f542974SPaul B Schroeder 1991*3f542974SPaul B Schroeder lData = LCR_BITS_8; 1992*3f542974SPaul B Schroeder lStop = LCR_STOP_1; 1993*3f542974SPaul B Schroeder lParity = LCR_PAR_NONE; 1994*3f542974SPaul B Schroeder 1995*3f542974SPaul B Schroeder cflag = tty->termios->c_cflag; 1996*3f542974SPaul B Schroeder iflag = tty->termios->c_iflag; 1997*3f542974SPaul B Schroeder 1998*3f542974SPaul B Schroeder /* Change the number of bits */ 1999*3f542974SPaul B Schroeder if (cflag & CSIZE) { 2000*3f542974SPaul B Schroeder switch (cflag & CSIZE) { 2001*3f542974SPaul B Schroeder case CS5: 2002*3f542974SPaul B Schroeder lData = LCR_BITS_5; 2003*3f542974SPaul B Schroeder break; 2004*3f542974SPaul B Schroeder 2005*3f542974SPaul B Schroeder case CS6: 2006*3f542974SPaul B Schroeder lData = LCR_BITS_6; 2007*3f542974SPaul B Schroeder break; 2008*3f542974SPaul B Schroeder 2009*3f542974SPaul B Schroeder case CS7: 2010*3f542974SPaul B Schroeder lData = LCR_BITS_7; 2011*3f542974SPaul B Schroeder break; 2012*3f542974SPaul B Schroeder default: 2013*3f542974SPaul B Schroeder case CS8: 2014*3f542974SPaul B Schroeder lData = LCR_BITS_8; 2015*3f542974SPaul B Schroeder break; 2016*3f542974SPaul B Schroeder } 2017*3f542974SPaul B Schroeder } 2018*3f542974SPaul B Schroeder /* Change the Parity bit */ 2019*3f542974SPaul B Schroeder if (cflag & PARENB) { 2020*3f542974SPaul B Schroeder if (cflag & PARODD) { 2021*3f542974SPaul B Schroeder lParity = LCR_PAR_ODD; 2022*3f542974SPaul B Schroeder dbg("%s - parity = odd", __FUNCTION__); 2023*3f542974SPaul B Schroeder } else { 2024*3f542974SPaul B Schroeder lParity = LCR_PAR_EVEN; 2025*3f542974SPaul B Schroeder dbg("%s - parity = even", __FUNCTION__); 2026*3f542974SPaul B Schroeder } 2027*3f542974SPaul B Schroeder 2028*3f542974SPaul B Schroeder } else { 2029*3f542974SPaul B Schroeder dbg("%s - parity = none", __FUNCTION__); 2030*3f542974SPaul B Schroeder } 2031*3f542974SPaul B Schroeder 2032*3f542974SPaul B Schroeder if (cflag & CMSPAR) { 2033*3f542974SPaul B Schroeder lParity = lParity | 0x20; 2034*3f542974SPaul B Schroeder } 2035*3f542974SPaul B Schroeder 2036*3f542974SPaul B Schroeder /* Change the Stop bit */ 2037*3f542974SPaul B Schroeder if (cflag & CSTOPB) { 2038*3f542974SPaul B Schroeder lStop = LCR_STOP_2; 2039*3f542974SPaul B Schroeder dbg("%s - stop bits = 2", __FUNCTION__); 2040*3f542974SPaul B Schroeder } else { 2041*3f542974SPaul B Schroeder lStop = LCR_STOP_1; 2042*3f542974SPaul B Schroeder dbg("%s - stop bits = 1", __FUNCTION__); 2043*3f542974SPaul B Schroeder } 2044*3f542974SPaul B Schroeder 2045*3f542974SPaul B Schroeder /* Update the LCR with the correct value */ 2046*3f542974SPaul B Schroeder mos7840_port->shadowLCR &= 2047*3f542974SPaul B Schroeder ~(LCR_BITS_MASK | LCR_STOP_MASK | LCR_PAR_MASK); 2048*3f542974SPaul B Schroeder mos7840_port->shadowLCR |= (lData | lParity | lStop); 2049*3f542974SPaul B Schroeder 2050*3f542974SPaul B Schroeder dbg("mos7840_change_port_settings mos7840_port->shadowLCR is %x\n", 2051*3f542974SPaul B Schroeder mos7840_port->shadowLCR); 2052*3f542974SPaul B Schroeder /* Disable Interrupts */ 2053*3f542974SPaul B Schroeder Data = 0x00; 2054*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 2055*3f542974SPaul B Schroeder 2056*3f542974SPaul B Schroeder Data = 0x00; 2057*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); 2058*3f542974SPaul B Schroeder 2059*3f542974SPaul B Schroeder Data = 0xcf; 2060*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data); 2061*3f542974SPaul B Schroeder 2062*3f542974SPaul B Schroeder /* Send the updated LCR value to the mos7840 */ 2063*3f542974SPaul B Schroeder Data = mos7840_port->shadowLCR; 2064*3f542974SPaul B Schroeder 2065*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data); 2066*3f542974SPaul B Schroeder 2067*3f542974SPaul B Schroeder Data = 0x00b; 2068*3f542974SPaul B Schroeder mos7840_port->shadowMCR = Data; 2069*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 2070*3f542974SPaul B Schroeder Data = 0x00b; 2071*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 2072*3f542974SPaul B Schroeder 2073*3f542974SPaul B Schroeder /* set up the MCR register and send it to the mos7840 */ 2074*3f542974SPaul B Schroeder 2075*3f542974SPaul B Schroeder mos7840_port->shadowMCR = MCR_MASTER_IE; 2076*3f542974SPaul B Schroeder if (cflag & CBAUD) { 2077*3f542974SPaul B Schroeder mos7840_port->shadowMCR |= (MCR_DTR | MCR_RTS); 2078*3f542974SPaul B Schroeder } 2079*3f542974SPaul B Schroeder 2080*3f542974SPaul B Schroeder if (cflag & CRTSCTS) { 2081*3f542974SPaul B Schroeder mos7840_port->shadowMCR |= (MCR_XON_ANY); 2082*3f542974SPaul B Schroeder 2083*3f542974SPaul B Schroeder } else { 2084*3f542974SPaul B Schroeder mos7840_port->shadowMCR &= ~(MCR_XON_ANY); 2085*3f542974SPaul B Schroeder } 2086*3f542974SPaul B Schroeder 2087*3f542974SPaul B Schroeder Data = mos7840_port->shadowMCR; 2088*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 2089*3f542974SPaul B Schroeder 2090*3f542974SPaul B Schroeder /* Determine divisor based on baud rate */ 2091*3f542974SPaul B Schroeder baud = tty_get_baud_rate(tty); 2092*3f542974SPaul B Schroeder 2093*3f542974SPaul B Schroeder if (!baud) { 2094*3f542974SPaul B Schroeder /* pick a default, any default... */ 2095*3f542974SPaul B Schroeder dbg("%s\n", "Picked default baud..."); 2096*3f542974SPaul B Schroeder baud = 9600; 2097*3f542974SPaul B Schroeder } 2098*3f542974SPaul B Schroeder 2099*3f542974SPaul B Schroeder dbg("%s - baud rate = %d", __FUNCTION__, baud); 2100*3f542974SPaul B Schroeder status = mos7840_send_cmd_write_baud_rate(mos7840_port, baud); 2101*3f542974SPaul B Schroeder 2102*3f542974SPaul B Schroeder /* Enable Interrupts */ 2103*3f542974SPaul B Schroeder Data = 0x0c; 2104*3f542974SPaul B Schroeder mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data); 2105*3f542974SPaul B Schroeder 2106*3f542974SPaul B Schroeder if (mos7840_port->read_urb->status != -EINPROGRESS) { 2107*3f542974SPaul B Schroeder mos7840_port->read_urb->dev = serial->dev; 2108*3f542974SPaul B Schroeder 2109*3f542974SPaul B Schroeder status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC); 2110*3f542974SPaul B Schroeder 2111*3f542974SPaul B Schroeder if (status) { 2112*3f542974SPaul B Schroeder dbg(" usb_submit_urb(read bulk) failed, status = %d", 2113*3f542974SPaul B Schroeder status); 2114*3f542974SPaul B Schroeder } 2115*3f542974SPaul B Schroeder } 2116*3f542974SPaul B Schroeder wake_up(&mos7840_port->delta_msr_wait); 2117*3f542974SPaul B Schroeder mos7840_port->delta_msr_cond = 1; 2118*3f542974SPaul B Schroeder dbg("mos7840_change_port_settings mos7840_port->shadowLCR is End %x\n", 2119*3f542974SPaul B Schroeder mos7840_port->shadowLCR); 2120*3f542974SPaul B Schroeder 2121*3f542974SPaul B Schroeder return; 2122*3f542974SPaul B Schroeder } 2123*3f542974SPaul B Schroeder 2124*3f542974SPaul B Schroeder /***************************************************************************** 2125*3f542974SPaul B Schroeder * mos7840_set_termios 2126*3f542974SPaul B Schroeder * this function is called by the tty driver when it wants to change 2127*3f542974SPaul B Schroeder * the termios structure 2128*3f542974SPaul B Schroeder *****************************************************************************/ 2129*3f542974SPaul B Schroeder 2130*3f542974SPaul B Schroeder static void mos7840_set_termios(struct usb_serial_port *port, 2131*3f542974SPaul B Schroeder struct termios *old_termios) 2132*3f542974SPaul B Schroeder { 2133*3f542974SPaul B Schroeder int status; 2134*3f542974SPaul B Schroeder unsigned int cflag; 2135*3f542974SPaul B Schroeder struct usb_serial *serial; 2136*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 2137*3f542974SPaul B Schroeder struct tty_struct *tty; 2138*3f542974SPaul B Schroeder dbg("mos7840_set_termios: START\n"); 2139*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 2140*3f542974SPaul B Schroeder dbg("%s", "Invalid port \n"); 2141*3f542974SPaul B Schroeder return; 2142*3f542974SPaul B Schroeder } 2143*3f542974SPaul B Schroeder 2144*3f542974SPaul B Schroeder serial = port->serial; 2145*3f542974SPaul B Schroeder 2146*3f542974SPaul B Schroeder if (mos7840_serial_paranoia_check(serial, __FUNCTION__)) { 2147*3f542974SPaul B Schroeder dbg("%s", "Invalid Serial \n"); 2148*3f542974SPaul B Schroeder return; 2149*3f542974SPaul B Schroeder } 2150*3f542974SPaul B Schroeder 2151*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 2152*3f542974SPaul B Schroeder 2153*3f542974SPaul B Schroeder if (mos7840_port == NULL) 2154*3f542974SPaul B Schroeder return; 2155*3f542974SPaul B Schroeder 2156*3f542974SPaul B Schroeder tty = port->tty; 2157*3f542974SPaul B Schroeder 2158*3f542974SPaul B Schroeder if (!port->tty || !port->tty->termios) { 2159*3f542974SPaul B Schroeder dbg("%s - no tty or termios", __FUNCTION__); 2160*3f542974SPaul B Schroeder return; 2161*3f542974SPaul B Schroeder } 2162*3f542974SPaul B Schroeder 2163*3f542974SPaul B Schroeder if (!mos7840_port->open) { 2164*3f542974SPaul B Schroeder dbg("%s - port not opened", __FUNCTION__); 2165*3f542974SPaul B Schroeder return; 2166*3f542974SPaul B Schroeder } 2167*3f542974SPaul B Schroeder 2168*3f542974SPaul B Schroeder dbg("%s\n", "setting termios - "); 2169*3f542974SPaul B Schroeder 2170*3f542974SPaul B Schroeder cflag = tty->termios->c_cflag; 2171*3f542974SPaul B Schroeder 2172*3f542974SPaul B Schroeder if (!cflag) { 2173*3f542974SPaul B Schroeder dbg("%s %s\n", __FUNCTION__, "cflag is NULL"); 2174*3f542974SPaul B Schroeder return; 2175*3f542974SPaul B Schroeder } 2176*3f542974SPaul B Schroeder 2177*3f542974SPaul B Schroeder /* check that they really want us to change something */ 2178*3f542974SPaul B Schroeder if (old_termios) { 2179*3f542974SPaul B Schroeder if ((cflag == old_termios->c_cflag) && 2180*3f542974SPaul B Schroeder (RELEVANT_IFLAG(tty->termios->c_iflag) == 2181*3f542974SPaul B Schroeder RELEVANT_IFLAG(old_termios->c_iflag))) { 2182*3f542974SPaul B Schroeder dbg("%s\n", "Nothing to change"); 2183*3f542974SPaul B Schroeder return; 2184*3f542974SPaul B Schroeder } 2185*3f542974SPaul B Schroeder } 2186*3f542974SPaul B Schroeder 2187*3f542974SPaul B Schroeder dbg("%s - clfag %08x iflag %08x", __FUNCTION__, 2188*3f542974SPaul B Schroeder tty->termios->c_cflag, RELEVANT_IFLAG(tty->termios->c_iflag)); 2189*3f542974SPaul B Schroeder 2190*3f542974SPaul B Schroeder if (old_termios) { 2191*3f542974SPaul B Schroeder dbg("%s - old clfag %08x old iflag %08x", __FUNCTION__, 2192*3f542974SPaul B Schroeder old_termios->c_cflag, RELEVANT_IFLAG(old_termios->c_iflag)); 2193*3f542974SPaul B Schroeder } 2194*3f542974SPaul B Schroeder 2195*3f542974SPaul B Schroeder dbg("%s - port %d", __FUNCTION__, port->number); 2196*3f542974SPaul B Schroeder 2197*3f542974SPaul B Schroeder /* change the port settings to the new ones specified */ 2198*3f542974SPaul B Schroeder 2199*3f542974SPaul B Schroeder mos7840_change_port_settings(mos7840_port, old_termios); 2200*3f542974SPaul B Schroeder 2201*3f542974SPaul B Schroeder if (!mos7840_port->read_urb) { 2202*3f542974SPaul B Schroeder dbg("%s", "URB KILLED !!!!!\n"); 2203*3f542974SPaul B Schroeder return; 2204*3f542974SPaul B Schroeder } 2205*3f542974SPaul B Schroeder 2206*3f542974SPaul B Schroeder if (mos7840_port->read_urb->status != -EINPROGRESS) { 2207*3f542974SPaul B Schroeder mos7840_port->read_urb->dev = serial->dev; 2208*3f542974SPaul B Schroeder status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC); 2209*3f542974SPaul B Schroeder if (status) { 2210*3f542974SPaul B Schroeder dbg(" usb_submit_urb(read bulk) failed, status = %d", 2211*3f542974SPaul B Schroeder status); 2212*3f542974SPaul B Schroeder } 2213*3f542974SPaul B Schroeder } 2214*3f542974SPaul B Schroeder return; 2215*3f542974SPaul B Schroeder } 2216*3f542974SPaul B Schroeder 2217*3f542974SPaul B Schroeder /***************************************************************************** 2218*3f542974SPaul B Schroeder * mos7840_get_lsr_info - get line status register info 2219*3f542974SPaul B Schroeder * 2220*3f542974SPaul B Schroeder * Purpose: Let user call ioctl() to get info when the UART physically 2221*3f542974SPaul B Schroeder * is emptied. On bus types like RS485, the transmitter must 2222*3f542974SPaul B Schroeder * release the bus after transmitting. This must be done when 2223*3f542974SPaul B Schroeder * the transmit shift register is empty, not be done when the 2224*3f542974SPaul B Schroeder * transmit holding register is empty. This functionality 2225*3f542974SPaul B Schroeder * allows an RS485 driver to be written in user space. 2226*3f542974SPaul B Schroeder *****************************************************************************/ 2227*3f542974SPaul B Schroeder 2228*3f542974SPaul B Schroeder static int mos7840_get_lsr_info(struct moschip_port *mos7840_port, 2229*3f542974SPaul B Schroeder unsigned int *value) 2230*3f542974SPaul B Schroeder { 2231*3f542974SPaul B Schroeder int count; 2232*3f542974SPaul B Schroeder unsigned int result = 0; 2233*3f542974SPaul B Schroeder 2234*3f542974SPaul B Schroeder count = mos7840_chars_in_buffer(mos7840_port->port); 2235*3f542974SPaul B Schroeder if (count == 0) { 2236*3f542974SPaul B Schroeder dbg("%s -- Empty", __FUNCTION__); 2237*3f542974SPaul B Schroeder result = TIOCSER_TEMT; 2238*3f542974SPaul B Schroeder } 2239*3f542974SPaul B Schroeder 2240*3f542974SPaul B Schroeder if (copy_to_user(value, &result, sizeof(int))) 2241*3f542974SPaul B Schroeder return -EFAULT; 2242*3f542974SPaul B Schroeder return 0; 2243*3f542974SPaul B Schroeder } 2244*3f542974SPaul B Schroeder 2245*3f542974SPaul B Schroeder /***************************************************************************** 2246*3f542974SPaul B Schroeder * mos7840_get_bytes_avail - get number of bytes available 2247*3f542974SPaul B Schroeder * 2248*3f542974SPaul B Schroeder * Purpose: Let user call ioctl to get the count of number of bytes available. 2249*3f542974SPaul B Schroeder *****************************************************************************/ 2250*3f542974SPaul B Schroeder 2251*3f542974SPaul B Schroeder static int mos7840_get_bytes_avail(struct moschip_port *mos7840_port, 2252*3f542974SPaul B Schroeder unsigned int *value) 2253*3f542974SPaul B Schroeder { 2254*3f542974SPaul B Schroeder unsigned int result = 0; 2255*3f542974SPaul B Schroeder struct tty_struct *tty = mos7840_port->port->tty; 2256*3f542974SPaul B Schroeder 2257*3f542974SPaul B Schroeder if (!tty) 2258*3f542974SPaul B Schroeder return -ENOIOCTLCMD; 2259*3f542974SPaul B Schroeder 2260*3f542974SPaul B Schroeder result = tty->read_cnt; 2261*3f542974SPaul B Schroeder 2262*3f542974SPaul B Schroeder dbg("%s(%d) = %d", __FUNCTION__, mos7840_port->port->number, result); 2263*3f542974SPaul B Schroeder if (copy_to_user(value, &result, sizeof(int))) 2264*3f542974SPaul B Schroeder return -EFAULT; 2265*3f542974SPaul B Schroeder 2266*3f542974SPaul B Schroeder return -ENOIOCTLCMD; 2267*3f542974SPaul B Schroeder } 2268*3f542974SPaul B Schroeder 2269*3f542974SPaul B Schroeder /***************************************************************************** 2270*3f542974SPaul B Schroeder * mos7840_set_modem_info 2271*3f542974SPaul B Schroeder * function to set modem info 2272*3f542974SPaul B Schroeder *****************************************************************************/ 2273*3f542974SPaul B Schroeder 2274*3f542974SPaul B Schroeder static int mos7840_set_modem_info(struct moschip_port *mos7840_port, 2275*3f542974SPaul B Schroeder unsigned int cmd, unsigned int *value) 2276*3f542974SPaul B Schroeder { 2277*3f542974SPaul B Schroeder unsigned int mcr; 2278*3f542974SPaul B Schroeder unsigned int arg; 2279*3f542974SPaul B Schroeder __u16 Data; 2280*3f542974SPaul B Schroeder int status; 2281*3f542974SPaul B Schroeder struct usb_serial_port *port; 2282*3f542974SPaul B Schroeder 2283*3f542974SPaul B Schroeder if (mos7840_port == NULL) 2284*3f542974SPaul B Schroeder return -1; 2285*3f542974SPaul B Schroeder 2286*3f542974SPaul B Schroeder port = (struct usb_serial_port *)mos7840_port->port; 2287*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 2288*3f542974SPaul B Schroeder dbg("%s", "Invalid port \n"); 2289*3f542974SPaul B Schroeder return -1; 2290*3f542974SPaul B Schroeder } 2291*3f542974SPaul B Schroeder 2292*3f542974SPaul B Schroeder mcr = mos7840_port->shadowMCR; 2293*3f542974SPaul B Schroeder 2294*3f542974SPaul B Schroeder if (copy_from_user(&arg, value, sizeof(int))) 2295*3f542974SPaul B Schroeder return -EFAULT; 2296*3f542974SPaul B Schroeder 2297*3f542974SPaul B Schroeder switch (cmd) { 2298*3f542974SPaul B Schroeder case TIOCMBIS: 2299*3f542974SPaul B Schroeder if (arg & TIOCM_RTS) 2300*3f542974SPaul B Schroeder mcr |= MCR_RTS; 2301*3f542974SPaul B Schroeder if (arg & TIOCM_DTR) 2302*3f542974SPaul B Schroeder mcr |= MCR_RTS; 2303*3f542974SPaul B Schroeder if (arg & TIOCM_LOOP) 2304*3f542974SPaul B Schroeder mcr |= MCR_LOOPBACK; 2305*3f542974SPaul B Schroeder break; 2306*3f542974SPaul B Schroeder 2307*3f542974SPaul B Schroeder case TIOCMBIC: 2308*3f542974SPaul B Schroeder if (arg & TIOCM_RTS) 2309*3f542974SPaul B Schroeder mcr &= ~MCR_RTS; 2310*3f542974SPaul B Schroeder if (arg & TIOCM_DTR) 2311*3f542974SPaul B Schroeder mcr &= ~MCR_RTS; 2312*3f542974SPaul B Schroeder if (arg & TIOCM_LOOP) 2313*3f542974SPaul B Schroeder mcr &= ~MCR_LOOPBACK; 2314*3f542974SPaul B Schroeder break; 2315*3f542974SPaul B Schroeder 2316*3f542974SPaul B Schroeder case TIOCMSET: 2317*3f542974SPaul B Schroeder /* turn off the RTS and DTR and LOOPBACK 2318*3f542974SPaul B Schroeder * and then only turn on what was asked to */ 2319*3f542974SPaul B Schroeder mcr &= ~(MCR_RTS | MCR_DTR | MCR_LOOPBACK); 2320*3f542974SPaul B Schroeder mcr |= ((arg & TIOCM_RTS) ? MCR_RTS : 0); 2321*3f542974SPaul B Schroeder mcr |= ((arg & TIOCM_DTR) ? MCR_DTR : 0); 2322*3f542974SPaul B Schroeder mcr |= ((arg & TIOCM_LOOP) ? MCR_LOOPBACK : 0); 2323*3f542974SPaul B Schroeder break; 2324*3f542974SPaul B Schroeder } 2325*3f542974SPaul B Schroeder 2326*3f542974SPaul B Schroeder mos7840_port->shadowMCR = mcr; 2327*3f542974SPaul B Schroeder 2328*3f542974SPaul B Schroeder Data = mos7840_port->shadowMCR; 2329*3f542974SPaul B Schroeder status = 0; 2330*3f542974SPaul B Schroeder status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data); 2331*3f542974SPaul B Schroeder if (status < 0) { 2332*3f542974SPaul B Schroeder dbg("setting MODEM_CONTROL_REGISTER Failed\n"); 2333*3f542974SPaul B Schroeder return -1; 2334*3f542974SPaul B Schroeder } 2335*3f542974SPaul B Schroeder 2336*3f542974SPaul B Schroeder return 0; 2337*3f542974SPaul B Schroeder } 2338*3f542974SPaul B Schroeder 2339*3f542974SPaul B Schroeder /***************************************************************************** 2340*3f542974SPaul B Schroeder * mos7840_get_modem_info 2341*3f542974SPaul B Schroeder * function to get modem info 2342*3f542974SPaul B Schroeder *****************************************************************************/ 2343*3f542974SPaul B Schroeder 2344*3f542974SPaul B Schroeder static int mos7840_get_modem_info(struct moschip_port *mos7840_port, 2345*3f542974SPaul B Schroeder unsigned int *value) 2346*3f542974SPaul B Schroeder { 2347*3f542974SPaul B Schroeder unsigned int result = 0; 2348*3f542974SPaul B Schroeder __u16 msr; 2349*3f542974SPaul B Schroeder unsigned int mcr = mos7840_port->shadowMCR; 2350*3f542974SPaul B Schroeder int status = 0; 2351*3f542974SPaul B Schroeder status = 2352*3f542974SPaul B Schroeder mos7840_get_uart_reg(mos7840_port->port, MODEM_STATUS_REGISTER, 2353*3f542974SPaul B Schroeder &msr); 2354*3f542974SPaul B Schroeder result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0) /* 0x002 */ 2355*3f542974SPaul B Schroeder |((mcr & MCR_RTS) ? TIOCM_RTS : 0) /* 0x004 */ 2356*3f542974SPaul B Schroeder |((msr & MOS7840_MSR_CTS) ? TIOCM_CTS : 0) /* 0x020 */ 2357*3f542974SPaul B Schroeder |((msr & MOS7840_MSR_CD) ? TIOCM_CAR : 0) /* 0x040 */ 2358*3f542974SPaul B Schroeder |((msr & MOS7840_MSR_RI) ? TIOCM_RI : 0) /* 0x080 */ 2359*3f542974SPaul B Schroeder |((msr & MOS7840_MSR_DSR) ? TIOCM_DSR : 0); /* 0x100 */ 2360*3f542974SPaul B Schroeder 2361*3f542974SPaul B Schroeder dbg("%s -- %x", __FUNCTION__, result); 2362*3f542974SPaul B Schroeder 2363*3f542974SPaul B Schroeder if (copy_to_user(value, &result, sizeof(int))) 2364*3f542974SPaul B Schroeder return -EFAULT; 2365*3f542974SPaul B Schroeder return 0; 2366*3f542974SPaul B Schroeder } 2367*3f542974SPaul B Schroeder 2368*3f542974SPaul B Schroeder /***************************************************************************** 2369*3f542974SPaul B Schroeder * mos7840_get_serial_info 2370*3f542974SPaul B Schroeder * function to get information about serial port 2371*3f542974SPaul B Schroeder *****************************************************************************/ 2372*3f542974SPaul B Schroeder 2373*3f542974SPaul B Schroeder static int mos7840_get_serial_info(struct moschip_port *mos7840_port, 2374*3f542974SPaul B Schroeder struct serial_struct *retinfo) 2375*3f542974SPaul B Schroeder { 2376*3f542974SPaul B Schroeder struct serial_struct tmp; 2377*3f542974SPaul B Schroeder 2378*3f542974SPaul B Schroeder if (mos7840_port == NULL) 2379*3f542974SPaul B Schroeder return -1; 2380*3f542974SPaul B Schroeder 2381*3f542974SPaul B Schroeder if (!retinfo) 2382*3f542974SPaul B Schroeder return -EFAULT; 2383*3f542974SPaul B Schroeder 2384*3f542974SPaul B Schroeder memset(&tmp, 0, sizeof(tmp)); 2385*3f542974SPaul B Schroeder 2386*3f542974SPaul B Schroeder tmp.type = PORT_16550A; 2387*3f542974SPaul B Schroeder tmp.line = mos7840_port->port->serial->minor; 2388*3f542974SPaul B Schroeder tmp.port = mos7840_port->port->number; 2389*3f542974SPaul B Schroeder tmp.irq = 0; 2390*3f542974SPaul B Schroeder tmp.flags = ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ; 2391*3f542974SPaul B Schroeder tmp.xmit_fifo_size = NUM_URBS * URB_TRANSFER_BUFFER_SIZE; 2392*3f542974SPaul B Schroeder tmp.baud_base = 9600; 2393*3f542974SPaul B Schroeder tmp.close_delay = 5 * HZ; 2394*3f542974SPaul B Schroeder tmp.closing_wait = 30 * HZ; 2395*3f542974SPaul B Schroeder 2396*3f542974SPaul B Schroeder if (copy_to_user(retinfo, &tmp, sizeof(*retinfo))) 2397*3f542974SPaul B Schroeder return -EFAULT; 2398*3f542974SPaul B Schroeder return 0; 2399*3f542974SPaul B Schroeder } 2400*3f542974SPaul B Schroeder 2401*3f542974SPaul B Schroeder /***************************************************************************** 2402*3f542974SPaul B Schroeder * SerialIoctl 2403*3f542974SPaul B Schroeder * this function handles any ioctl calls to the driver 2404*3f542974SPaul B Schroeder *****************************************************************************/ 2405*3f542974SPaul B Schroeder 2406*3f542974SPaul B Schroeder static int mos7840_ioctl(struct usb_serial_port *port, struct file *file, 2407*3f542974SPaul B Schroeder unsigned int cmd, unsigned long arg) 2408*3f542974SPaul B Schroeder { 2409*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 2410*3f542974SPaul B Schroeder struct tty_struct *tty; 2411*3f542974SPaul B Schroeder 2412*3f542974SPaul B Schroeder struct async_icount cnow; 2413*3f542974SPaul B Schroeder struct async_icount cprev; 2414*3f542974SPaul B Schroeder struct serial_icounter_struct icount; 2415*3f542974SPaul B Schroeder int mosret = 0; 2416*3f542974SPaul B Schroeder int retval; 2417*3f542974SPaul B Schroeder struct tty_ldisc *ld; 2418*3f542974SPaul B Schroeder 2419*3f542974SPaul B Schroeder if (mos7840_port_paranoia_check(port, __FUNCTION__)) { 2420*3f542974SPaul B Schroeder dbg("%s", "Invalid port \n"); 2421*3f542974SPaul B Schroeder return -1; 2422*3f542974SPaul B Schroeder } 2423*3f542974SPaul B Schroeder 2424*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(port); 2425*3f542974SPaul B Schroeder tty = mos7840_port->port->tty; 2426*3f542974SPaul B Schroeder 2427*3f542974SPaul B Schroeder if (mos7840_port == NULL) 2428*3f542974SPaul B Schroeder return -1; 2429*3f542974SPaul B Schroeder 2430*3f542974SPaul B Schroeder dbg("%s - port %d, cmd = 0x%x", __FUNCTION__, port->number, cmd); 2431*3f542974SPaul B Schroeder 2432*3f542974SPaul B Schroeder switch (cmd) { 2433*3f542974SPaul B Schroeder /* return number of bytes available */ 2434*3f542974SPaul B Schroeder 2435*3f542974SPaul B Schroeder case TIOCINQ: 2436*3f542974SPaul B Schroeder dbg("%s (%d) TIOCINQ", __FUNCTION__, port->number); 2437*3f542974SPaul B Schroeder return mos7840_get_bytes_avail(mos7840_port, 2438*3f542974SPaul B Schroeder (unsigned int *)arg); 2439*3f542974SPaul B Schroeder break; 2440*3f542974SPaul B Schroeder 2441*3f542974SPaul B Schroeder case TIOCOUTQ: 2442*3f542974SPaul B Schroeder dbg("%s (%d) TIOCOUTQ", __FUNCTION__, port->number); 2443*3f542974SPaul B Schroeder return put_user(tty->driver->chars_in_buffer ? 2444*3f542974SPaul B Schroeder tty->driver->chars_in_buffer(tty) : 0, 2445*3f542974SPaul B Schroeder (int __user *)arg); 2446*3f542974SPaul B Schroeder break; 2447*3f542974SPaul B Schroeder 2448*3f542974SPaul B Schroeder case TCFLSH: 2449*3f542974SPaul B Schroeder retval = tty_check_change(tty); 2450*3f542974SPaul B Schroeder if (retval) 2451*3f542974SPaul B Schroeder return retval; 2452*3f542974SPaul B Schroeder 2453*3f542974SPaul B Schroeder ld = tty_ldisc_ref(tty); 2454*3f542974SPaul B Schroeder switch (arg) { 2455*3f542974SPaul B Schroeder case TCIFLUSH: 2456*3f542974SPaul B Schroeder if (ld && ld->flush_buffer) 2457*3f542974SPaul B Schroeder ld->flush_buffer(tty); 2458*3f542974SPaul B Schroeder break; 2459*3f542974SPaul B Schroeder case TCIOFLUSH: 2460*3f542974SPaul B Schroeder if (ld && ld->flush_buffer) 2461*3f542974SPaul B Schroeder ld->flush_buffer(tty); 2462*3f542974SPaul B Schroeder /* fall through */ 2463*3f542974SPaul B Schroeder case TCOFLUSH: 2464*3f542974SPaul B Schroeder if (tty->driver->flush_buffer) 2465*3f542974SPaul B Schroeder tty->driver->flush_buffer(tty); 2466*3f542974SPaul B Schroeder break; 2467*3f542974SPaul B Schroeder default: 2468*3f542974SPaul B Schroeder tty_ldisc_deref(ld); 2469*3f542974SPaul B Schroeder return -EINVAL; 2470*3f542974SPaul B Schroeder } 2471*3f542974SPaul B Schroeder tty_ldisc_deref(ld); 2472*3f542974SPaul B Schroeder return 0; 2473*3f542974SPaul B Schroeder 2474*3f542974SPaul B Schroeder case TCGETS: 2475*3f542974SPaul B Schroeder if (kernel_termios_to_user_termios 2476*3f542974SPaul B Schroeder ((struct termios __user *)arg, tty->termios)) 2477*3f542974SPaul B Schroeder return -EFAULT; 2478*3f542974SPaul B Schroeder return 0; 2479*3f542974SPaul B Schroeder 2480*3f542974SPaul B Schroeder case TIOCSERGETLSR: 2481*3f542974SPaul B Schroeder dbg("%s (%d) TIOCSERGETLSR", __FUNCTION__, port->number); 2482*3f542974SPaul B Schroeder return mos7840_get_lsr_info(mos7840_port, (unsigned int *)arg); 2483*3f542974SPaul B Schroeder return 0; 2484*3f542974SPaul B Schroeder 2485*3f542974SPaul B Schroeder case TIOCMBIS: 2486*3f542974SPaul B Schroeder case TIOCMBIC: 2487*3f542974SPaul B Schroeder case TIOCMSET: 2488*3f542974SPaul B Schroeder dbg("%s (%d) TIOCMSET/TIOCMBIC/TIOCMSET", __FUNCTION__, 2489*3f542974SPaul B Schroeder port->number); 2490*3f542974SPaul B Schroeder mosret = 2491*3f542974SPaul B Schroeder mos7840_set_modem_info(mos7840_port, cmd, 2492*3f542974SPaul B Schroeder (unsigned int *)arg); 2493*3f542974SPaul B Schroeder return mosret; 2494*3f542974SPaul B Schroeder 2495*3f542974SPaul B Schroeder case TIOCMGET: 2496*3f542974SPaul B Schroeder dbg("%s (%d) TIOCMGET", __FUNCTION__, port->number); 2497*3f542974SPaul B Schroeder return mos7840_get_modem_info(mos7840_port, 2498*3f542974SPaul B Schroeder (unsigned int *)arg); 2499*3f542974SPaul B Schroeder 2500*3f542974SPaul B Schroeder case TIOCGSERIAL: 2501*3f542974SPaul B Schroeder dbg("%s (%d) TIOCGSERIAL", __FUNCTION__, port->number); 2502*3f542974SPaul B Schroeder return mos7840_get_serial_info(mos7840_port, 2503*3f542974SPaul B Schroeder (struct serial_struct *)arg); 2504*3f542974SPaul B Schroeder 2505*3f542974SPaul B Schroeder case TIOCSSERIAL: 2506*3f542974SPaul B Schroeder dbg("%s (%d) TIOCSSERIAL", __FUNCTION__, port->number); 2507*3f542974SPaul B Schroeder break; 2508*3f542974SPaul B Schroeder 2509*3f542974SPaul B Schroeder case TIOCMIWAIT: 2510*3f542974SPaul B Schroeder dbg("%s (%d) TIOCMIWAIT", __FUNCTION__, port->number); 2511*3f542974SPaul B Schroeder cprev = mos7840_port->icount; 2512*3f542974SPaul B Schroeder while (1) { 2513*3f542974SPaul B Schroeder //interruptible_sleep_on(&mos7840_port->delta_msr_wait); 2514*3f542974SPaul B Schroeder mos7840_port->delta_msr_cond = 0; 2515*3f542974SPaul B Schroeder wait_event_interruptible(mos7840_port->delta_msr_wait, 2516*3f542974SPaul B Schroeder (mos7840_port-> 2517*3f542974SPaul B Schroeder delta_msr_cond == 1)); 2518*3f542974SPaul B Schroeder 2519*3f542974SPaul B Schroeder /* see if a signal did it */ 2520*3f542974SPaul B Schroeder if (signal_pending(current)) 2521*3f542974SPaul B Schroeder return -ERESTARTSYS; 2522*3f542974SPaul B Schroeder cnow = mos7840_port->icount; 2523*3f542974SPaul B Schroeder if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr && 2524*3f542974SPaul B Schroeder cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) 2525*3f542974SPaul B Schroeder return -EIO; /* no change => error */ 2526*3f542974SPaul B Schroeder if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) || 2527*3f542974SPaul B Schroeder ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) || 2528*3f542974SPaul B Schroeder ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) || 2529*3f542974SPaul B Schroeder ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) { 2530*3f542974SPaul B Schroeder return 0; 2531*3f542974SPaul B Schroeder } 2532*3f542974SPaul B Schroeder cprev = cnow; 2533*3f542974SPaul B Schroeder } 2534*3f542974SPaul B Schroeder /* NOTREACHED */ 2535*3f542974SPaul B Schroeder break; 2536*3f542974SPaul B Schroeder 2537*3f542974SPaul B Schroeder case TIOCGICOUNT: 2538*3f542974SPaul B Schroeder cnow = mos7840_port->icount; 2539*3f542974SPaul B Schroeder icount.cts = cnow.cts; 2540*3f542974SPaul B Schroeder icount.dsr = cnow.dsr; 2541*3f542974SPaul B Schroeder icount.rng = cnow.rng; 2542*3f542974SPaul B Schroeder icount.dcd = cnow.dcd; 2543*3f542974SPaul B Schroeder icount.rx = cnow.rx; 2544*3f542974SPaul B Schroeder icount.tx = cnow.tx; 2545*3f542974SPaul B Schroeder icount.frame = cnow.frame; 2546*3f542974SPaul B Schroeder icount.overrun = cnow.overrun; 2547*3f542974SPaul B Schroeder icount.parity = cnow.parity; 2548*3f542974SPaul B Schroeder icount.brk = cnow.brk; 2549*3f542974SPaul B Schroeder icount.buf_overrun = cnow.buf_overrun; 2550*3f542974SPaul B Schroeder 2551*3f542974SPaul B Schroeder dbg("%s (%d) TIOCGICOUNT RX=%d, TX=%d", __FUNCTION__, 2552*3f542974SPaul B Schroeder port->number, icount.rx, icount.tx); 2553*3f542974SPaul B Schroeder if (copy_to_user((void *)arg, &icount, sizeof(icount))) 2554*3f542974SPaul B Schroeder return -EFAULT; 2555*3f542974SPaul B Schroeder return 0; 2556*3f542974SPaul B Schroeder 2557*3f542974SPaul B Schroeder case TIOCEXBAUD: 2558*3f542974SPaul B Schroeder return 0; 2559*3f542974SPaul B Schroeder default: 2560*3f542974SPaul B Schroeder break; 2561*3f542974SPaul B Schroeder } 2562*3f542974SPaul B Schroeder 2563*3f542974SPaul B Schroeder return -ENOIOCTLCMD; 2564*3f542974SPaul B Schroeder } 2565*3f542974SPaul B Schroeder 2566*3f542974SPaul B Schroeder static int mos7840_calc_num_ports(struct usb_serial *serial) 2567*3f542974SPaul B Schroeder { 2568*3f542974SPaul B Schroeder 2569*3f542974SPaul B Schroeder dbg("numberofendpoints: %d \n", 2570*3f542974SPaul B Schroeder (int)serial->interface->cur_altsetting->desc.bNumEndpoints); 2571*3f542974SPaul B Schroeder dbg("numberofendpoints: %d \n", 2572*3f542974SPaul B Schroeder (int)serial->interface->altsetting->desc.bNumEndpoints); 2573*3f542974SPaul B Schroeder if (serial->interface->cur_altsetting->desc.bNumEndpoints == 5) { 2574*3f542974SPaul B Schroeder mos7840_num_ports = 2; 2575*3f542974SPaul B Schroeder serial->type->num_ports = 2; 2576*3f542974SPaul B Schroeder } else if (serial->interface->cur_altsetting->desc.bNumEndpoints == 9) { 2577*3f542974SPaul B Schroeder mos7840_num_ports = 4; 2578*3f542974SPaul B Schroeder serial->type->num_bulk_in = 4; 2579*3f542974SPaul B Schroeder serial->type->num_bulk_out = 4; 2580*3f542974SPaul B Schroeder serial->type->num_ports = 4; 2581*3f542974SPaul B Schroeder } 2582*3f542974SPaul B Schroeder 2583*3f542974SPaul B Schroeder return mos7840_num_ports; 2584*3f542974SPaul B Schroeder } 2585*3f542974SPaul B Schroeder 2586*3f542974SPaul B Schroeder /**************************************************************************** 2587*3f542974SPaul B Schroeder * mos7840_startup 2588*3f542974SPaul B Schroeder ****************************************************************************/ 2589*3f542974SPaul B Schroeder 2590*3f542974SPaul B Schroeder static int mos7840_startup(struct usb_serial *serial) 2591*3f542974SPaul B Schroeder { 2592*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 2593*3f542974SPaul B Schroeder struct usb_device *dev; 2594*3f542974SPaul B Schroeder int i, status; 2595*3f542974SPaul B Schroeder 2596*3f542974SPaul B Schroeder __u16 Data; 2597*3f542974SPaul B Schroeder dbg("%s \n", " mos7840_startup :entering.........."); 2598*3f542974SPaul B Schroeder 2599*3f542974SPaul B Schroeder if (!serial) { 2600*3f542974SPaul B Schroeder dbg("%s\n", "Invalid Handler"); 2601*3f542974SPaul B Schroeder return -1; 2602*3f542974SPaul B Schroeder } 2603*3f542974SPaul B Schroeder 2604*3f542974SPaul B Schroeder dev = serial->dev; 2605*3f542974SPaul B Schroeder 2606*3f542974SPaul B Schroeder dbg("%s\n", "Entering..."); 2607*3f542974SPaul B Schroeder 2608*3f542974SPaul B Schroeder /* we set up the pointers to the endpoints in the mos7840_open * 2609*3f542974SPaul B Schroeder * function, as the structures aren't created yet. */ 2610*3f542974SPaul B Schroeder 2611*3f542974SPaul B Schroeder /* set up port private structures */ 2612*3f542974SPaul B Schroeder for (i = 0; i < serial->num_ports; ++i) { 2613*3f542974SPaul B Schroeder mos7840_port = kmalloc(sizeof(struct moschip_port), GFP_KERNEL); 2614*3f542974SPaul B Schroeder if (mos7840_port == NULL) { 2615*3f542974SPaul B Schroeder err("%s - Out of memory", __FUNCTION__); 2616*3f542974SPaul B Schroeder return -ENOMEM; 2617*3f542974SPaul B Schroeder } 2618*3f542974SPaul B Schroeder memset(mos7840_port, 0, sizeof(struct moschip_port)); 2619*3f542974SPaul B Schroeder 2620*3f542974SPaul B Schroeder /* Initialize all port interrupt end point to port 0 int endpoint * 2621*3f542974SPaul B Schroeder * Our device has only one interrupt end point comman to all port */ 2622*3f542974SPaul B Schroeder 2623*3f542974SPaul B Schroeder mos7840_port->port = serial->port[i]; 2624*3f542974SPaul B Schroeder mos7840_set_port_private(serial->port[i], mos7840_port); 2625*3f542974SPaul B Schroeder 2626*3f542974SPaul B Schroeder mos7840_port->port_num = ((serial->port[i]->number - 2627*3f542974SPaul B Schroeder (serial->port[i]->serial->minor)) + 2628*3f542974SPaul B Schroeder 1); 2629*3f542974SPaul B Schroeder 2630*3f542974SPaul B Schroeder if (mos7840_port->port_num == 1) { 2631*3f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0x0; 2632*3f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0x1; 2633*3f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x4; 2634*3f542974SPaul B Schroeder } else if ((mos7840_port->port_num == 2) 2635*3f542974SPaul B Schroeder && (mos7840_num_ports == 4)) { 2636*3f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0x8; 2637*3f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0x9; 2638*3f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x16; 2639*3f542974SPaul B Schroeder } else if ((mos7840_port->port_num == 2) 2640*3f542974SPaul B Schroeder && (mos7840_num_ports == 2)) { 2641*3f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0xa; 2642*3f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0xb; 2643*3f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x19; 2644*3f542974SPaul B Schroeder } else if ((mos7840_port->port_num == 3) 2645*3f542974SPaul B Schroeder && (mos7840_num_ports == 4)) { 2646*3f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0xa; 2647*3f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0xb; 2648*3f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x19; 2649*3f542974SPaul B Schroeder } else if ((mos7840_port->port_num == 4) 2650*3f542974SPaul B Schroeder && (mos7840_num_ports == 4)) { 2651*3f542974SPaul B Schroeder mos7840_port->SpRegOffset = 0xc; 2652*3f542974SPaul B Schroeder mos7840_port->ControlRegOffset = 0xd; 2653*3f542974SPaul B Schroeder mos7840_port->DcrRegOffset = 0x1c; 2654*3f542974SPaul B Schroeder } 2655*3f542974SPaul B Schroeder mos7840_dump_serial_port(mos7840_port); 2656*3f542974SPaul B Schroeder 2657*3f542974SPaul B Schroeder mos7840_set_port_private(serial->port[i], mos7840_port); 2658*3f542974SPaul B Schroeder 2659*3f542974SPaul B Schroeder //enable rx_disable bit in control register 2660*3f542974SPaul B Schroeder 2661*3f542974SPaul B Schroeder status = 2662*3f542974SPaul B Schroeder mos7840_get_reg_sync(serial->port[i], 2663*3f542974SPaul B Schroeder mos7840_port->ControlRegOffset, &Data); 2664*3f542974SPaul B Schroeder if (status < 0) { 2665*3f542974SPaul B Schroeder dbg("Reading ControlReg failed status-0x%x\n", status); 2666*3f542974SPaul B Schroeder break; 2667*3f542974SPaul B Schroeder } else 2668*3f542974SPaul B Schroeder dbg("ControlReg Reading success val is %x, status%d\n", 2669*3f542974SPaul B Schroeder Data, status); 2670*3f542974SPaul B Schroeder Data |= 0x08; //setting driver done bit 2671*3f542974SPaul B Schroeder Data |= 0x04; //sp1_bit to have cts change reflect in modem status reg 2672*3f542974SPaul B Schroeder 2673*3f542974SPaul B Schroeder //Data |= 0x20; //rx_disable bit 2674*3f542974SPaul B Schroeder status = 0; 2675*3f542974SPaul B Schroeder status = 2676*3f542974SPaul B Schroeder mos7840_set_reg_sync(serial->port[i], 2677*3f542974SPaul B Schroeder mos7840_port->ControlRegOffset, Data); 2678*3f542974SPaul B Schroeder if (status < 0) { 2679*3f542974SPaul B Schroeder dbg("Writing ControlReg failed(rx_disable) status-0x%x\n", status); 2680*3f542974SPaul B Schroeder break; 2681*3f542974SPaul B Schroeder } else 2682*3f542974SPaul B Schroeder dbg("ControlReg Writing success(rx_disable) status%d\n", 2683*3f542974SPaul B Schroeder status); 2684*3f542974SPaul B Schroeder 2685*3f542974SPaul B Schroeder //Write default values in DCR (i.e 0x01 in DCR0, 0x05 in DCR2 and 0x24 in DCR3 2686*3f542974SPaul B Schroeder Data = 0x01; 2687*3f542974SPaul B Schroeder status = 0; 2688*3f542974SPaul B Schroeder status = 2689*3f542974SPaul B Schroeder mos7840_set_reg_sync(serial->port[i], 2690*3f542974SPaul B Schroeder (__u16) (mos7840_port->DcrRegOffset + 2691*3f542974SPaul B Schroeder 0), Data); 2692*3f542974SPaul B Schroeder if (status < 0) { 2693*3f542974SPaul B Schroeder dbg("Writing DCR0 failed status-0x%x\n", status); 2694*3f542974SPaul B Schroeder break; 2695*3f542974SPaul B Schroeder } else 2696*3f542974SPaul B Schroeder dbg("DCR0 Writing success status%d\n", status); 2697*3f542974SPaul B Schroeder 2698*3f542974SPaul B Schroeder Data = 0x05; 2699*3f542974SPaul B Schroeder status = 0; 2700*3f542974SPaul B Schroeder status = 2701*3f542974SPaul B Schroeder mos7840_set_reg_sync(serial->port[i], 2702*3f542974SPaul B Schroeder (__u16) (mos7840_port->DcrRegOffset + 2703*3f542974SPaul B Schroeder 1), Data); 2704*3f542974SPaul B Schroeder if (status < 0) { 2705*3f542974SPaul B Schroeder dbg("Writing DCR1 failed status-0x%x\n", status); 2706*3f542974SPaul B Schroeder break; 2707*3f542974SPaul B Schroeder } else 2708*3f542974SPaul B Schroeder dbg("DCR1 Writing success status%d\n", status); 2709*3f542974SPaul B Schroeder 2710*3f542974SPaul B Schroeder Data = 0x24; 2711*3f542974SPaul B Schroeder status = 0; 2712*3f542974SPaul B Schroeder status = 2713*3f542974SPaul B Schroeder mos7840_set_reg_sync(serial->port[i], 2714*3f542974SPaul B Schroeder (__u16) (mos7840_port->DcrRegOffset + 2715*3f542974SPaul B Schroeder 2), Data); 2716*3f542974SPaul B Schroeder if (status < 0) { 2717*3f542974SPaul B Schroeder dbg("Writing DCR2 failed status-0x%x\n", status); 2718*3f542974SPaul B Schroeder break; 2719*3f542974SPaul B Schroeder } else 2720*3f542974SPaul B Schroeder dbg("DCR2 Writing success status%d\n", status); 2721*3f542974SPaul B Schroeder 2722*3f542974SPaul B Schroeder // write values in clkstart0x0 and clkmulti 0x20 2723*3f542974SPaul B Schroeder Data = 0x0; 2724*3f542974SPaul B Schroeder status = 0; 2725*3f542974SPaul B Schroeder status = 2726*3f542974SPaul B Schroeder mos7840_set_reg_sync(serial->port[i], 2727*3f542974SPaul B Schroeder CLK_START_VALUE_REGISTER, Data); 2728*3f542974SPaul B Schroeder if (status < 0) { 2729*3f542974SPaul B Schroeder dbg("Writing CLK_START_VALUE_REGISTER failed status-0x%x\n", status); 2730*3f542974SPaul B Schroeder break; 2731*3f542974SPaul B Schroeder } else 2732*3f542974SPaul B Schroeder dbg("CLK_START_VALUE_REGISTER Writing success status%d\n", status); 2733*3f542974SPaul B Schroeder 2734*3f542974SPaul B Schroeder Data = 0x20; 2735*3f542974SPaul B Schroeder status = 0; 2736*3f542974SPaul B Schroeder status = 2737*3f542974SPaul B Schroeder mos7840_set_reg_sync(serial->port[i], CLK_MULTI_REGISTER, 2738*3f542974SPaul B Schroeder Data); 2739*3f542974SPaul B Schroeder if (status < 0) { 2740*3f542974SPaul B Schroeder dbg("Writing CLK_MULTI_REGISTER failed status-0x%x\n", 2741*3f542974SPaul B Schroeder status); 2742*3f542974SPaul B Schroeder break; 2743*3f542974SPaul B Schroeder } else 2744*3f542974SPaul B Schroeder dbg("CLK_MULTI_REGISTER Writing success status%d\n", 2745*3f542974SPaul B Schroeder status); 2746*3f542974SPaul B Schroeder 2747*3f542974SPaul B Schroeder //write value 0x0 to scratchpad register 2748*3f542974SPaul B Schroeder Data = 0x00; 2749*3f542974SPaul B Schroeder status = 0; 2750*3f542974SPaul B Schroeder status = 2751*3f542974SPaul B Schroeder mos7840_set_uart_reg(serial->port[i], SCRATCH_PAD_REGISTER, 2752*3f542974SPaul B Schroeder Data); 2753*3f542974SPaul B Schroeder if (status < 0) { 2754*3f542974SPaul B Schroeder dbg("Writing SCRATCH_PAD_REGISTER failed status-0x%x\n", 2755*3f542974SPaul B Schroeder status); 2756*3f542974SPaul B Schroeder break; 2757*3f542974SPaul B Schroeder } else 2758*3f542974SPaul B Schroeder dbg("SCRATCH_PAD_REGISTER Writing success status%d\n", 2759*3f542974SPaul B Schroeder status); 2760*3f542974SPaul B Schroeder 2761*3f542974SPaul B Schroeder //Zero Length flag register 2762*3f542974SPaul B Schroeder if ((mos7840_port->port_num != 1) 2763*3f542974SPaul B Schroeder && (mos7840_num_ports == 2)) { 2764*3f542974SPaul B Schroeder 2765*3f542974SPaul B Schroeder Data = 0xff; 2766*3f542974SPaul B Schroeder status = 0; 2767*3f542974SPaul B Schroeder status = mos7840_set_reg_sync(serial->port[i], 2768*3f542974SPaul B Schroeder (__u16) (ZLP_REG1 + 2769*3f542974SPaul B Schroeder ((__u16) 2770*3f542974SPaul B Schroeder mos7840_port-> 2771*3f542974SPaul B Schroeder port_num)), 2772*3f542974SPaul B Schroeder Data); 2773*3f542974SPaul B Schroeder dbg("ZLIP offset%x\n", 2774*3f542974SPaul B Schroeder (__u16) (ZLP_REG1 + 2775*3f542974SPaul B Schroeder ((__u16) mos7840_port->port_num))); 2776*3f542974SPaul B Schroeder if (status < 0) { 2777*3f542974SPaul B Schroeder dbg("Writing ZLP_REG%d failed status-0x%x\n", 2778*3f542974SPaul B Schroeder i + 2, status); 2779*3f542974SPaul B Schroeder break; 2780*3f542974SPaul B Schroeder } else 2781*3f542974SPaul B Schroeder dbg("ZLP_REG%d Writing success status%d\n", 2782*3f542974SPaul B Schroeder i + 2, status); 2783*3f542974SPaul B Schroeder } else { 2784*3f542974SPaul B Schroeder Data = 0xff; 2785*3f542974SPaul B Schroeder status = 0; 2786*3f542974SPaul B Schroeder status = mos7840_set_reg_sync(serial->port[i], 2787*3f542974SPaul B Schroeder (__u16) (ZLP_REG1 + 2788*3f542974SPaul B Schroeder ((__u16) 2789*3f542974SPaul B Schroeder mos7840_port-> 2790*3f542974SPaul B Schroeder port_num) - 2791*3f542974SPaul B Schroeder 0x1), Data); 2792*3f542974SPaul B Schroeder dbg("ZLIP offset%x\n", 2793*3f542974SPaul B Schroeder (__u16) (ZLP_REG1 + 2794*3f542974SPaul B Schroeder ((__u16) mos7840_port->port_num) - 0x1)); 2795*3f542974SPaul B Schroeder if (status < 0) { 2796*3f542974SPaul B Schroeder dbg("Writing ZLP_REG%d failed status-0x%x\n", 2797*3f542974SPaul B Schroeder i + 1, status); 2798*3f542974SPaul B Schroeder break; 2799*3f542974SPaul B Schroeder } else 2800*3f542974SPaul B Schroeder dbg("ZLP_REG%d Writing success status%d\n", 2801*3f542974SPaul B Schroeder i + 1, status); 2802*3f542974SPaul B Schroeder 2803*3f542974SPaul B Schroeder } 2804*3f542974SPaul B Schroeder mos7840_port->control_urb = usb_alloc_urb(0, SLAB_ATOMIC); 2805*3f542974SPaul B Schroeder mos7840_port->ctrl_buf = kmalloc(16, GFP_KERNEL); 2806*3f542974SPaul B Schroeder 2807*3f542974SPaul B Schroeder } 2808*3f542974SPaul B Schroeder 2809*3f542974SPaul B Schroeder //Zero Length flag enable 2810*3f542974SPaul B Schroeder Data = 0x0f; 2811*3f542974SPaul B Schroeder status = 0; 2812*3f542974SPaul B Schroeder status = mos7840_set_reg_sync(serial->port[0], ZLP_REG5, Data); 2813*3f542974SPaul B Schroeder if (status < 0) { 2814*3f542974SPaul B Schroeder dbg("Writing ZLP_REG5 failed status-0x%x\n", status); 2815*3f542974SPaul B Schroeder return -1; 2816*3f542974SPaul B Schroeder } else 2817*3f542974SPaul B Schroeder dbg("ZLP_REG5 Writing success status%d\n", status); 2818*3f542974SPaul B Schroeder 2819*3f542974SPaul B Schroeder /* setting configuration feature to one */ 2820*3f542974SPaul B Schroeder usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), 2821*3f542974SPaul B Schroeder (__u8) 0x03, 0x00, 0x01, 0x00, 0x00, 0x00, 5 * HZ); 2822*3f542974SPaul B Schroeder return 0; 2823*3f542974SPaul B Schroeder } 2824*3f542974SPaul B Schroeder 2825*3f542974SPaul B Schroeder /**************************************************************************** 2826*3f542974SPaul B Schroeder * mos7840_shutdown 2827*3f542974SPaul B Schroeder * This function is called whenever the device is removed from the usb bus. 2828*3f542974SPaul B Schroeder ****************************************************************************/ 2829*3f542974SPaul B Schroeder 2830*3f542974SPaul B Schroeder static void mos7840_shutdown(struct usb_serial *serial) 2831*3f542974SPaul B Schroeder { 2832*3f542974SPaul B Schroeder int i; 2833*3f542974SPaul B Schroeder struct moschip_port *mos7840_port; 2834*3f542974SPaul B Schroeder dbg("%s \n", " shutdown :entering.........."); 2835*3f542974SPaul B Schroeder 2836*3f542974SPaul B Schroeder if (!serial) { 2837*3f542974SPaul B Schroeder dbg("%s", "Invalid Handler \n"); 2838*3f542974SPaul B Schroeder return; 2839*3f542974SPaul B Schroeder } 2840*3f542974SPaul B Schroeder 2841*3f542974SPaul B Schroeder /* check for the ports to be closed,close the ports and disconnect */ 2842*3f542974SPaul B Schroeder 2843*3f542974SPaul B Schroeder /* free private structure allocated for serial port * 2844*3f542974SPaul B Schroeder * stop reads and writes on all ports */ 2845*3f542974SPaul B Schroeder 2846*3f542974SPaul B Schroeder for (i = 0; i < serial->num_ports; ++i) { 2847*3f542974SPaul B Schroeder mos7840_port = mos7840_get_port_private(serial->port[i]); 2848*3f542974SPaul B Schroeder kfree(mos7840_port->ctrl_buf); 2849*3f542974SPaul B Schroeder usb_kill_urb(mos7840_port->control_urb); 2850*3f542974SPaul B Schroeder kfree(mos7840_port); 2851*3f542974SPaul B Schroeder mos7840_set_port_private(serial->port[i], NULL); 2852*3f542974SPaul B Schroeder } 2853*3f542974SPaul B Schroeder 2854*3f542974SPaul B Schroeder dbg("%s\n", "Thank u :: "); 2855*3f542974SPaul B Schroeder 2856*3f542974SPaul B Schroeder } 2857*3f542974SPaul B Schroeder 2858*3f542974SPaul B Schroeder static struct usb_serial_driver moschip7840_4port_device = { 2859*3f542974SPaul B Schroeder .driver = { 2860*3f542974SPaul B Schroeder .owner = THIS_MODULE, 2861*3f542974SPaul B Schroeder .name = "mos7840", 2862*3f542974SPaul B Schroeder }, 2863*3f542974SPaul B Schroeder .description = DRIVER_DESC, 2864*3f542974SPaul B Schroeder .id_table = moschip_port_id_table, 2865*3f542974SPaul B Schroeder .num_interrupt_in = 1, //NUM_DONT_CARE,//1, 2866*3f542974SPaul B Schroeder #ifdef check 2867*3f542974SPaul B Schroeder .num_bulk_in = 4, 2868*3f542974SPaul B Schroeder .num_bulk_out = 4, 2869*3f542974SPaul B Schroeder .num_ports = 4, 2870*3f542974SPaul B Schroeder #endif 2871*3f542974SPaul B Schroeder .open = mos7840_open, 2872*3f542974SPaul B Schroeder .close = mos7840_close, 2873*3f542974SPaul B Schroeder .write = mos7840_write, 2874*3f542974SPaul B Schroeder .write_room = mos7840_write_room, 2875*3f542974SPaul B Schroeder .chars_in_buffer = mos7840_chars_in_buffer, 2876*3f542974SPaul B Schroeder .throttle = mos7840_throttle, 2877*3f542974SPaul B Schroeder .unthrottle = mos7840_unthrottle, 2878*3f542974SPaul B Schroeder .calc_num_ports = mos7840_calc_num_ports, 2879*3f542974SPaul B Schroeder #ifdef MCSSerialProbe 2880*3f542974SPaul B Schroeder .probe = mos7840_serial_probe, 2881*3f542974SPaul B Schroeder #endif 2882*3f542974SPaul B Schroeder .ioctl = mos7840_ioctl, 2883*3f542974SPaul B Schroeder .set_termios = mos7840_set_termios, 2884*3f542974SPaul B Schroeder .break_ctl = mos7840_break, 2885*3f542974SPaul B Schroeder .tiocmget = mos7840_tiocmget, 2886*3f542974SPaul B Schroeder .tiocmset = mos7840_tiocmset, 2887*3f542974SPaul B Schroeder .attach = mos7840_startup, 2888*3f542974SPaul B Schroeder .shutdown = mos7840_shutdown, 2889*3f542974SPaul B Schroeder .read_bulk_callback = mos7840_bulk_in_callback, 2890*3f542974SPaul B Schroeder .read_int_callback = mos7840_interrupt_callback, 2891*3f542974SPaul B Schroeder }; 2892*3f542974SPaul B Schroeder 2893*3f542974SPaul B Schroeder static struct usb_driver io_driver = { 2894*3f542974SPaul B Schroeder .name = "mos7840", 2895*3f542974SPaul B Schroeder .probe = usb_serial_probe, 2896*3f542974SPaul B Schroeder .disconnect = usb_serial_disconnect, 2897*3f542974SPaul B Schroeder .id_table = moschip_id_table_combined, 2898*3f542974SPaul B Schroeder }; 2899*3f542974SPaul B Schroeder 2900*3f542974SPaul B Schroeder /**************************************************************************** 2901*3f542974SPaul B Schroeder * moschip7840_init 2902*3f542974SPaul B Schroeder * This is called by the module subsystem, or on startup to initialize us 2903*3f542974SPaul B Schroeder ****************************************************************************/ 2904*3f542974SPaul B Schroeder static int __init moschip7840_init(void) 2905*3f542974SPaul B Schroeder { 2906*3f542974SPaul B Schroeder int retval; 2907*3f542974SPaul B Schroeder 2908*3f542974SPaul B Schroeder dbg("%s \n", " mos7840_init :entering.........."); 2909*3f542974SPaul B Schroeder 2910*3f542974SPaul B Schroeder /* Register with the usb serial */ 2911*3f542974SPaul B Schroeder retval = usb_serial_register(&moschip7840_4port_device); 2912*3f542974SPaul B Schroeder 2913*3f542974SPaul B Schroeder if (retval) 2914*3f542974SPaul B Schroeder goto failed_port_device_register; 2915*3f542974SPaul B Schroeder 2916*3f542974SPaul B Schroeder dbg("%s\n", "Entring..."); 2917*3f542974SPaul B Schroeder info(DRIVER_DESC " " DRIVER_VERSION); 2918*3f542974SPaul B Schroeder 2919*3f542974SPaul B Schroeder /* Register with the usb */ 2920*3f542974SPaul B Schroeder retval = usb_register(&io_driver); 2921*3f542974SPaul B Schroeder 2922*3f542974SPaul B Schroeder if (retval) 2923*3f542974SPaul B Schroeder goto failed_usb_register; 2924*3f542974SPaul B Schroeder 2925*3f542974SPaul B Schroeder if (retval == 0) { 2926*3f542974SPaul B Schroeder dbg("%s\n", "Leaving..."); 2927*3f542974SPaul B Schroeder return 0; 2928*3f542974SPaul B Schroeder } 2929*3f542974SPaul B Schroeder 2930*3f542974SPaul B Schroeder failed_usb_register: 2931*3f542974SPaul B Schroeder usb_serial_deregister(&moschip7840_4port_device); 2932*3f542974SPaul B Schroeder 2933*3f542974SPaul B Schroeder failed_port_device_register: 2934*3f542974SPaul B Schroeder 2935*3f542974SPaul B Schroeder return retval; 2936*3f542974SPaul B Schroeder } 2937*3f542974SPaul B Schroeder 2938*3f542974SPaul B Schroeder /**************************************************************************** 2939*3f542974SPaul B Schroeder * moschip7840_exit 2940*3f542974SPaul B Schroeder * Called when the driver is about to be unloaded. 2941*3f542974SPaul B Schroeder ****************************************************************************/ 2942*3f542974SPaul B Schroeder static void __exit moschip7840_exit(void) 2943*3f542974SPaul B Schroeder { 2944*3f542974SPaul B Schroeder 2945*3f542974SPaul B Schroeder dbg("%s \n", " mos7840_exit :entering.........."); 2946*3f542974SPaul B Schroeder 2947*3f542974SPaul B Schroeder usb_deregister(&io_driver); 2948*3f542974SPaul B Schroeder 2949*3f542974SPaul B Schroeder usb_serial_deregister(&moschip7840_4port_device); 2950*3f542974SPaul B Schroeder 2951*3f542974SPaul B Schroeder dbg("%s\n", "Entring..."); 2952*3f542974SPaul B Schroeder } 2953*3f542974SPaul B Schroeder 2954*3f542974SPaul B Schroeder module_init(moschip7840_init); 2955*3f542974SPaul B Schroeder module_exit(moschip7840_exit); 2956*3f542974SPaul B Schroeder 2957*3f542974SPaul B Schroeder /* Module information */ 2958*3f542974SPaul B Schroeder MODULE_DESCRIPTION(DRIVER_DESC); 2959*3f542974SPaul B Schroeder MODULE_LICENSE("GPL"); 2960*3f542974SPaul B Schroeder 2961*3f542974SPaul B Schroeder module_param(debug, bool, S_IRUGO | S_IWUSR); 2962*3f542974SPaul B Schroeder MODULE_PARM_DESC(debug, "Debug enabled or not"); 2963