Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 1d749f9a authored by Uwe Bonnes's avatar Uwe Bonnes Committed by Greg Kroah-Hartman
Browse files

USB: ftdi_sio.c: Use ftdi async_icount structure for TIOCMIWAIT, as in other drivers

parent 005b3cde
Loading
Loading
Loading
Loading
+16 −25
Original line number Original line Diff line number Diff line
@@ -2328,6 +2328,8 @@ static int ftdi_ioctl(struct tty_struct *tty,
{
{
	struct usb_serial_port *port = tty->driver_data;
	struct usb_serial_port *port = tty->driver_data;
	struct ftdi_private *priv = usb_get_serial_port_data(port);
	struct ftdi_private *priv = usb_get_serial_port_data(port);
	struct async_icount cnow;
	struct async_icount cprev;


	dbg("%s cmd 0x%04x", __func__, cmd);
	dbg("%s cmd 0x%04x", __func__, cmd);


@@ -2347,41 +2349,30 @@ static int ftdi_ioctl(struct tty_struct *tty,
	 * - mask passed in arg for lines of interest
	 * - mask passed in arg for lines of interest
	 *   (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
	 *   (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
	 * Caller should use TIOCGICOUNT to see which one it was.
	 * Caller should use TIOCGICOUNT to see which one it was.
	 * (except that the driver doesn't support it !)
	 *
	 *
	 * This code is borrowed from linux/drivers/char/serial.c
	 * This code is borrowed from linux/drivers/char/serial.c
	 */
	 */
	case TIOCMIWAIT:
	case TIOCMIWAIT:
		while (priv != NULL) {
		cprev = priv->icount;
		while (1) {
			interruptible_sleep_on(&priv->delta_msr_wait);
			interruptible_sleep_on(&priv->delta_msr_wait);
			/* see if a signal did it */
			/* see if a signal did it */
			if (signal_pending(current))
			if (signal_pending(current))
				return -ERESTARTSYS;
				return -ERESTARTSYS;
			else {
			cnow = priv->icount;
				char diff = priv->diff_status;
			if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&

			    cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
				if (diff == 0)
				return -EIO; /* no change => error */
				return -EIO; /* no change => error */

			if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
				/* Consume all events */
			    ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
				priv->diff_status = 0;
			    ((arg & TIOCM_CD)  && (cnow.dcd != cprev.dcd)) ||

			    ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) {
				/* Return 0 if caller wanted to know about
				   these bits */
				if (((arg & TIOCM_RNG) && (diff & FTDI_RS0_RI)) ||
				    ((arg & TIOCM_DSR) && (diff & FTDI_RS0_DSR)) ||
				    ((arg & TIOCM_CD)  && (diff & FTDI_RS0_RLSD)) ||
				    ((arg & TIOCM_CTS) && (diff & FTDI_RS0_CTS))) {
				return 0;
				return 0;
			}
			}
				/*
			cprev = cnow;
				 * Otherwise caller can't care less about what
				 * happened,and so we continue to wait for more
				 * events.
				 */
			}
		}
		}
		return 0;
		/* not reached */
		break;
	case TIOCSERGETLSR:
	case TIOCSERGETLSR:
		return get_lsr_info(port, (struct serial_struct __user *)arg);
		return get_lsr_info(port, (struct serial_struct __user *)arg);
		break;
		break;