diff options
| author | Thomas Gleixner <tglx@linutronix.de> | 2018-06-22 21:20:35 +0200 | 
|---|---|---|
| committer | Thomas Gleixner <tglx@linutronix.de> | 2018-06-22 21:20:35 +0200 | 
| commit | 7731b8bc94e599c9a79e428f3359ff2c34b7576a (patch) | |
| tree | 879f18ccbe274122f2d4f095b43cbc7f953e0ada /drivers/usb/serial/ftdi_sio.c | |
| parent | 48e315618dc4dc8904182cd221e3d395d5d97005 (diff) | |
| parent | 9ffc59d57228d74809700be6f7ecb1db10292f05 (diff) | |
Merge branch 'linus' into x86/urgent
Required to queue a dependent fix.
Diffstat (limited to 'drivers/usb/serial/ftdi_sio.c')
| -rw-r--r-- | drivers/usb/serial/ftdi_sio.c | 194 | 
1 files changed, 77 insertions, 117 deletions
diff --git a/drivers/usb/serial/ftdi_sio.c b/drivers/usb/serial/ftdi_sio.c index 7ea221d42dba..b5cef322826f 100644 --- a/drivers/usb/serial/ftdi_sio.c +++ b/drivers/usb/serial/ftdi_sio.c @@ -54,15 +54,14 @@ struct ftdi_private {  	int custom_divisor;	/* custom_divisor kludge, this is for  				   baud_base (different from what goes to the  				   chip!) */ -	__u16 last_set_data_urb_value ; -				/* the last data state set - needed for doing -				 * a break -				 */ +	u16 last_set_data_value; /* the last data state set - needed for doing +				  * a break +				  */  	int flags;		/* some ASYNC_xxxx flags are supported */  	unsigned long last_dtr_rts;	/* saved modem control outputs */  	char prev_status;        /* Used for TIOCMIWAIT */  	char transmit_empty;	/* If transmitter is empty or not */ -	__u16 interface;	/* FT2232C, FT2232H or FT4232H port interface +	u16 interface;		/* FT2232C, FT2232H or FT4232H port interface  				   (0 for FT232/245) */  	speed_t force_baud;	/* if non-zero, force the baud rate to @@ -1063,10 +1062,10 @@ static int ftdi_get_modem_status(struct usb_serial_port *port,  static unsigned short int ftdi_232am_baud_base_to_divisor(int baud, int base);  static unsigned short int ftdi_232am_baud_to_divisor(int baud); -static __u32 ftdi_232bm_baud_base_to_divisor(int baud, int base); -static __u32 ftdi_232bm_baud_to_divisor(int baud); -static __u32 ftdi_2232h_baud_base_to_divisor(int baud, int base); -static __u32 ftdi_2232h_baud_to_divisor(int baud); +static u32 ftdi_232bm_baud_base_to_divisor(int baud, int base); +static u32 ftdi_232bm_baud_to_divisor(int baud); +static u32 ftdi_2232h_baud_base_to_divisor(int baud, int base); +static u32 ftdi_2232h_baud_to_divisor(int baud);  static struct usb_serial_driver ftdi_sio_device = {  	.driver = { @@ -1136,14 +1135,14 @@ static unsigned short int ftdi_232am_baud_to_divisor(int baud)  	 return ftdi_232am_baud_base_to_divisor(baud, 48000000);  } -static __u32 ftdi_232bm_baud_base_to_divisor(int baud, int base) +static u32 ftdi_232bm_baud_base_to_divisor(int baud, int base)  {  	static const unsigned char divfrac[8] = { 0, 3, 2, 4, 1, 5, 6, 7 }; -	__u32 divisor; +	u32 divisor;  	/* divisor shifted 3 bits to the left */  	int divisor3 = base / 2 / baud;  	divisor = divisor3 >> 3; -	divisor |= (__u32)divfrac[divisor3 & 0x7] << 14; +	divisor |= (u32)divfrac[divisor3 & 0x7] << 14;  	/* Deal with special cases for highest baud rates. */  	if (divisor == 1)  		divisor = 0; @@ -1152,22 +1151,22 @@ static __u32 ftdi_232bm_baud_base_to_divisor(int baud, int base)  	return divisor;  } -static __u32 ftdi_232bm_baud_to_divisor(int baud) +static u32 ftdi_232bm_baud_to_divisor(int baud)  {  	 return ftdi_232bm_baud_base_to_divisor(baud, 48000000);  } -static __u32 ftdi_2232h_baud_base_to_divisor(int baud, int base) +static u32 ftdi_2232h_baud_base_to_divisor(int baud, int base)  {  	static const unsigned char divfrac[8] = { 0, 3, 2, 4, 1, 5, 6, 7 }; -	__u32 divisor; +	u32 divisor;  	int divisor3;  	/* hi-speed baud rate is 10-bit sampling instead of 16-bit */  	divisor3 = base * 8 / (baud * 10);  	divisor = divisor3 >> 3; -	divisor |= (__u32)divfrac[divisor3 & 0x7] << 14; +	divisor |= (u32)divfrac[divisor3 & 0x7] << 14;  	/* Deal with special cases for highest baud rates. */  	if (divisor == 1)  		divisor = 0; @@ -1182,7 +1181,7 @@ static __u32 ftdi_2232h_baud_base_to_divisor(int baud, int base)  	return divisor;  } -static __u32 ftdi_2232h_baud_to_divisor(int baud) +static u32 ftdi_2232h_baud_to_divisor(int baud)  {  	 return ftdi_2232h_baud_base_to_divisor(baud, 120000000);  } @@ -1195,7 +1194,7 @@ static int update_mctrl(struct usb_serial_port *port, unsigned int set,  {  	struct ftdi_private *priv = usb_get_serial_port_data(port);  	struct device *dev = &port->dev; -	unsigned urb_value; +	unsigned value;  	int rv;  	if (((set | clear) & (TIOCM_DTR | TIOCM_RTS)) == 0) { @@ -1204,20 +1203,20 @@ static int update_mctrl(struct usb_serial_port *port, unsigned int set,  	}  	clear &= ~set;	/* 'set' takes precedence over 'clear' */ -	urb_value = 0; +	value = 0;  	if (clear & TIOCM_DTR) -		urb_value |= FTDI_SIO_SET_DTR_LOW; +		value |= FTDI_SIO_SET_DTR_LOW;  	if (clear & TIOCM_RTS) -		urb_value |= FTDI_SIO_SET_RTS_LOW; +		value |= FTDI_SIO_SET_RTS_LOW;  	if (set & TIOCM_DTR) -		urb_value |= FTDI_SIO_SET_DTR_HIGH; +		value |= FTDI_SIO_SET_DTR_HIGH;  	if (set & TIOCM_RTS) -		urb_value |= FTDI_SIO_SET_RTS_HIGH; +		value |= FTDI_SIO_SET_RTS_HIGH;  	rv = usb_control_msg(port->serial->dev,  			       usb_sndctrlpipe(port->serial->dev, 0),  			       FTDI_SIO_SET_MODEM_CTRL_REQUEST,  			       FTDI_SIO_SET_MODEM_CTRL_REQUEST_TYPE, -			       urb_value, priv->interface, +			       value, priv->interface,  			       NULL, 0, WDR_TIMEOUT);  	if (rv < 0) {  		dev_dbg(dev, "%s Error from MODEM_CTRL urb: DTR %s, RTS %s\n", @@ -1236,12 +1235,12 @@ static int update_mctrl(struct usb_serial_port *port, unsigned int set,  } -static __u32 get_ftdi_divisor(struct tty_struct *tty, +static u32 get_ftdi_divisor(struct tty_struct *tty,  						struct usb_serial_port *port)  {  	struct ftdi_private *priv = usb_get_serial_port_data(port);  	struct device *dev = &port->dev; -	__u32 div_value = 0; +	u32 div_value = 0;  	int div_okay = 1;  	int baud; @@ -1299,7 +1298,7 @@ static __u32 get_ftdi_divisor(struct tty_struct *tty,  	case FT232RL: /* FT232RL chip */  	case FTX:     /* FT-X series */  		if (baud <= 3000000) { -			__u16 product_id = le16_to_cpu( +			u16 product_id = le16_to_cpu(  				port->serial->dev->descriptor.idProduct);  			if (((product_id == FTDI_NDI_HUC_PID)		||  			     (product_id == FTDI_NDI_SPECTRA_SCU_PID)	|| @@ -1346,26 +1345,26 @@ static __u32 get_ftdi_divisor(struct tty_struct *tty,  static int change_speed(struct tty_struct *tty, struct usb_serial_port *port)  {  	struct ftdi_private *priv = usb_get_serial_port_data(port); -	__u16 urb_value; -	__u16 urb_index; -	__u32 urb_index_value; +	u16 value; +	u16 index; +	u32 index_value;  	int rv; -	urb_index_value = get_ftdi_divisor(tty, port); -	urb_value = (__u16)urb_index_value; -	urb_index = (__u16)(urb_index_value >> 16); +	index_value = get_ftdi_divisor(tty, port); +	value = (u16)index_value; +	index = (u16)(index_value >> 16);  	if ((priv->chip_type == FT2232C) || (priv->chip_type == FT2232H) ||  		(priv->chip_type == FT4232H) || (priv->chip_type == FT232H)) {  		/* Probably the BM type needs the MSB of the encoded fractional  		 * divider also moved like for the chips above. Any infos? */ -		urb_index = (__u16)((urb_index << 8) | priv->interface); +		index = (u16)((index << 8) | priv->interface);  	}  	rv = usb_control_msg(port->serial->dev,  			    usb_sndctrlpipe(port->serial->dev, 0),  			    FTDI_SIO_SET_BAUDRATE_REQUEST,  			    FTDI_SIO_SET_BAUDRATE_REQUEST_TYPE, -			    urb_value, urb_index, +			    value, index,  			    NULL, 0, WDR_SHORT_TIMEOUT);  	return rv;  } @@ -2140,29 +2139,29 @@ static void ftdi_break_ctl(struct tty_struct *tty, int break_state)  {  	struct usb_serial_port *port = tty->driver_data;  	struct ftdi_private *priv = usb_get_serial_port_data(port); -	__u16 urb_value; +	u16 value;  	/* break_state = -1 to turn on break, and 0 to turn off break */  	/* see drivers/char/tty_io.c to see it used */ -	/* last_set_data_urb_value NEVER has the break bit set in it */ +	/* last_set_data_value NEVER has the break bit set in it */  	if (break_state) -		urb_value = priv->last_set_data_urb_value | FTDI_SIO_SET_BREAK; +		value = priv->last_set_data_value | FTDI_SIO_SET_BREAK;  	else -		urb_value = priv->last_set_data_urb_value; +		value = priv->last_set_data_value;  	if (usb_control_msg(port->serial->dev,  			usb_sndctrlpipe(port->serial->dev, 0),  			FTDI_SIO_SET_DATA_REQUEST,  			FTDI_SIO_SET_DATA_REQUEST_TYPE, -			urb_value , priv->interface, +			value , priv->interface,  			NULL, 0, WDR_TIMEOUT) < 0) {  		dev_err(&port->dev, "%s FAILED to enable/disable break state (state was %d)\n",  			__func__, break_state);  	}  	dev_dbg(&port->dev, "%s break state is %d - urb is %d\n", __func__, -		break_state, urb_value); +		break_state, value);  } @@ -2192,12 +2191,8 @@ static void ftdi_set_termios(struct tty_struct *tty,  	struct ftdi_private *priv = usb_get_serial_port_data(port);  	struct ktermios *termios = &tty->termios;  	unsigned int cflag = termios->c_cflag; -	__u16 urb_value; /* will hold the new flags */ - -	/* Added for xon/xoff support */ -	unsigned int iflag = termios->c_iflag; -	unsigned char vstop; -	unsigned char vstart; +	u16 value, index; +	int ret;  	/* Force baud rate if this device requires it, unless it is set to  	   B0. */ @@ -2258,44 +2253,44 @@ static void ftdi_set_termios(struct tty_struct *tty,  no_skip:  	/* Set number of data bits, parity, stop bits */ -	urb_value = 0; -	urb_value |= (cflag & CSTOPB ? FTDI_SIO_SET_DATA_STOP_BITS_2 : -		      FTDI_SIO_SET_DATA_STOP_BITS_1); +	value = 0; +	value |= (cflag & CSTOPB ? FTDI_SIO_SET_DATA_STOP_BITS_2 : +			FTDI_SIO_SET_DATA_STOP_BITS_1);  	if (cflag & PARENB) {  		if (cflag & CMSPAR) -			urb_value |= cflag & PARODD ? -				     FTDI_SIO_SET_DATA_PARITY_MARK : -				     FTDI_SIO_SET_DATA_PARITY_SPACE; +			value |= cflag & PARODD ? +					FTDI_SIO_SET_DATA_PARITY_MARK : +					FTDI_SIO_SET_DATA_PARITY_SPACE;  		else -			urb_value |= cflag & PARODD ? -				     FTDI_SIO_SET_DATA_PARITY_ODD : -				     FTDI_SIO_SET_DATA_PARITY_EVEN; +			value |= cflag & PARODD ? +					FTDI_SIO_SET_DATA_PARITY_ODD : +					FTDI_SIO_SET_DATA_PARITY_EVEN;  	} else { -		urb_value |= FTDI_SIO_SET_DATA_PARITY_NONE; +		value |= FTDI_SIO_SET_DATA_PARITY_NONE;  	}  	switch (cflag & CSIZE) {  	case CS5:  		dev_dbg(ddev, "Setting CS5 quirk\n");  		break;  	case CS7: -		urb_value |= 7; +		value |= 7;  		dev_dbg(ddev, "Setting CS7\n");  		break;  	default:  	case CS8: -		urb_value |= 8; +		value |= 8;  		dev_dbg(ddev, "Setting CS8\n");  		break;  	}  	/* This is needed by the break command since it uses the same command  	   - but is or'ed with this value  */ -	priv->last_set_data_urb_value = urb_value; +	priv->last_set_data_value = value;  	if (usb_control_msg(dev, usb_sndctrlpipe(dev, 0),  			    FTDI_SIO_SET_DATA_REQUEST,  			    FTDI_SIO_SET_DATA_REQUEST_TYPE, -			    urb_value , priv->interface, +			    value , priv->interface,  			    NULL, 0, WDR_SHORT_TIMEOUT) < 0) {  		dev_err(ddev, "%s FAILED to set databits/stopbits/parity\n",  			__func__); @@ -2326,65 +2321,30 @@ no_data_parity_stop_changes:  			set_mctrl(port, TIOCM_DTR | TIOCM_RTS);  	} -	/* Set flow control */ -	/* Note device also supports DTR/CD (ugh) and Xon/Xoff in hardware */  no_c_cflag_changes: -	if (cflag & CRTSCTS) { -		dev_dbg(ddev, "%s Setting to CRTSCTS flow control\n", __func__); -		if (usb_control_msg(dev, -				    usb_sndctrlpipe(dev, 0), -				    FTDI_SIO_SET_FLOW_CTRL_REQUEST, -				    FTDI_SIO_SET_FLOW_CTRL_REQUEST_TYPE, -				    0 , (FTDI_SIO_RTS_CTS_HS | priv->interface), -				    NULL, 0, WDR_TIMEOUT) < 0) { -			dev_err(ddev, "urb failed to set to rts/cts flow control\n"); -		} +	/* Set hardware-assisted flow control */ +	value = 0; + +	if (C_CRTSCTS(tty)) { +		dev_dbg(&port->dev, "enabling rts/cts flow control\n"); +		index = FTDI_SIO_RTS_CTS_HS; +	} else if (I_IXON(tty)) { +		dev_dbg(&port->dev, "enabling xon/xoff flow control\n"); +		index = FTDI_SIO_XON_XOFF_HS; +		value = STOP_CHAR(tty) << 8 | START_CHAR(tty);  	} else { -		/* -		 * Xon/Xoff code -		 * -		 * Check the IXOFF status in the iflag component of the -		 * termios structure. If IXOFF is not set, the pre-xon/xoff -		 * code is executed. -		 */ -		if (iflag & IXOFF) { -			dev_dbg(ddev, "%s  request to enable xonxoff iflag=%04x\n", -				__func__, iflag); -			/* Try to enable the XON/XOFF on the ftdi_sio -			 * Set the vstart and vstop -- could have been done up -			 * above where a lot of other dereferencing is done but -			 * that would be very inefficient as vstart and vstop -			 * are not always needed. -			 */ -			vstart = termios->c_cc[VSTART]; -			vstop = termios->c_cc[VSTOP]; -			urb_value = (vstop << 8) | (vstart); - -			if (usb_control_msg(dev, -					    usb_sndctrlpipe(dev, 0), -					    FTDI_SIO_SET_FLOW_CTRL_REQUEST, -					    FTDI_SIO_SET_FLOW_CTRL_REQUEST_TYPE, -					    urb_value , (FTDI_SIO_XON_XOFF_HS -							 | priv->interface), -					    NULL, 0, WDR_TIMEOUT) < 0) { -				dev_err(&port->dev, "urb failed to set to " -					"xon/xoff flow control\n"); -			} -		} else { -			/* else clause to only run if cflag ! CRTSCTS and iflag -			 * ! XOFF. CHECKME Assuming XON/XOFF handled by tty -			 * stack - not by device */ -			dev_dbg(ddev, "%s Turning off hardware flow control\n", __func__); -			if (usb_control_msg(dev, -					    usb_sndctrlpipe(dev, 0), -					    FTDI_SIO_SET_FLOW_CTRL_REQUEST, -					    FTDI_SIO_SET_FLOW_CTRL_REQUEST_TYPE, -					    0, priv->interface, -					    NULL, 0, WDR_TIMEOUT) < 0) { -				dev_err(ddev, "urb failed to clear flow control\n"); -			} -		} +		dev_dbg(&port->dev, "disabling flow control\n"); +		index = FTDI_SIO_DISABLE_FLOW_CTRL;  	} + +	index |= priv->interface; + +	ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), +			FTDI_SIO_SET_FLOW_CTRL_REQUEST, +			FTDI_SIO_SET_FLOW_CTRL_REQUEST_TYPE, +			value, index, NULL, 0, WDR_TIMEOUT); +	if (ret < 0) +		dev_err(&port->dev, "failed to set flow control: %d\n", ret);  }  /*  | 
