[PATCH v5] usbserial: cp210x - icount support for parity error checking

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



The current version of cp210x driver doesn't provide any way to detect
a parity error in received data from userspace. Some serial protocols like
STM32 bootloader protect data only by parity so application needs to
know whether parity error happened to repeat peripheral data reading.

Added support for icount (ioctl TIOCGICOUNT) which sends GET_COMM_STATUS
command to CP210X and according received flags increments fields for
parity error, frame error, break and overrun. An application can detect
an error condition after reading data from ttyUSB and reacts adequately.
There is no impact for applications which don't call ioctl TIOCGICOUNT.

The flag "hardware overrun" is sometimes set by CP2102 for the first
received data after port opening when some data arrived to closed port.
The same problem appears in MS Windows 10, so no reason to hide this fake
overrun.

Signed-off-by: Jaromir Skorpil <Jerry@xxxxxx>
---
v2: Simplified counting - only queue overrun checked
v3: Changed description + UTF8 name
v4: Corrected endian
v5: Port lock, hw+queue overrun, formatting (no flowed)

 cp210x.c |   48 +++++++++++++++++++++++++++++++++++++++++++-----
 1 file changed, 43 insertions(+), 5 deletions(-)

diff -up linux-5.8-rc1/drivers/usb/serial/cp210x.c j/drivers/usb/serial/cp210x.c
--- linux-5.8-rc1/drivers/usb/serial/cp210x.c
+++ j/drivers/usb/serial/cp210x.c
@@ -43,6 +43,8 @@ static int cp210x_tiocmget(struct tty_st
 static int cp210x_tiocmset(struct tty_struct *, unsigned int, unsigned int);
 static int cp210x_tiocmset_port(struct usb_serial_port *port,
 		unsigned int, unsigned int);
+static int cp210x_get_icount(struct tty_struct *tty,
+		struct serial_icounter_struct *icount);
 static void cp210x_break_ctl(struct tty_struct *, int);
 static int cp210x_attach(struct usb_serial *);
 static void cp210x_disconnect(struct usb_serial *);
@@ -274,6 +276,7 @@ static struct usb_serial_driver cp210x_d
 	.tx_empty		= cp210x_tx_empty,
 	.tiocmget		= cp210x_tiocmget,
 	.tiocmset		= cp210x_tiocmset,
+	.get_icount		= cp210x_get_icount,
 	.attach			= cp210x_attach,
 	.disconnect		= cp210x_disconnect,
 	.release		= cp210x_release,
@@ -393,6 +396,13 @@ struct cp210x_comm_status {
 	u8       bReserved;
 } __packed;
 
+/* cp210x_comm_status::ulErrors */
+#define CP210X_ERR_BREAK	BIT(0)
+#define CP210X_ERR_FRAME	BIT(1)
+#define CP210X_ERR_HW_OVERRUN	BIT(2)
+#define CP210X_ERR_QUEUE_OVERRUN	BIT(3)
+#define CP210X_ERR_PARITY	BIT(4)
+
 /*
  * CP210X_PURGE - 16 bits passed in wValue of USB request.
  * SiLabs app note AN571 gives a strange description of the 4 bits:
@@ -836,10 +846,10 @@ static void cp210x_close(struct usb_seri
 }
 
 /*
- * Read how many bytes are waiting in the TX queue.
+ * Read how many bytes are waiting in the TX queue and update error counters.
  */
-static int cp210x_get_tx_queue_byte_count(struct usb_serial_port *port,
-		u32 *count)
+static int cp210x_get_comm_status(struct usb_serial_port *port,
+		u32 *tx_count)
 {
 	struct usb_serial *serial = port->serial;
 	struct cp210x_port_private *port_priv = usb_get_serial_port_data(port);
@@ -855,7 +865,22 @@ static int cp210x_get_tx_queue_byte_coun
 			0, port_priv->bInterfaceNumber, sts, sizeof(*sts),
 			USB_CTRL_GET_TIMEOUT);
 	if (result == sizeof(*sts)) {
-		*count = le32_to_cpu(sts->ulAmountInOutQueue);
+		unsigned long flags;
+		u32 err = le32_to_cpu(sts->ulErrors);
+
+		spin_lock_irqsave(&port->lock, flags);
+		if (err & CP210X_ERR_BREAK)
+			port->icount.brk++;
+		if (err & CP210X_ERR_FRAME)
+			port->icount.frame++;
+		if (err & (CP210X_ERR_HW_OVERRUN | CP210X_ERR_QUEUE_OVERRUN))
+			port->icount.overrun++;
+		if (err & CP210X_ERR_PARITY)
+			port->icount.parity++;
+		spin_unlock_irqrestore(&port->lock, flags);
+
+		if (tx_count)
+			*tx_count = le32_to_cpu(sts->ulAmountInOutQueue);
 		result = 0;
 	} else {
 		dev_err(&port->dev, "failed to get comm status: %d\n", result);
@@ -873,13 +898,26 @@ static bool cp210x_tx_empty(struct usb_s
 	int err;
 	u32 count;
 
-	err = cp210x_get_tx_queue_byte_count(port, &count);
+	err = cp210x_get_comm_status(port, &count);
 	if (err)
 		return true;
 
 	return !count;
 }
 
+static int cp210x_get_icount(struct tty_struct *tty,
+		struct serial_icounter_struct *icount)
+{
+	struct usb_serial_port *port = tty->driver_data;
+	int result;
+
+	result = cp210x_get_comm_status(port, NULL);
+	if (result)
+		return result;
+
+	return usb_serial_generic_get_icount(tty, icount);
+}
+
 /*
  * cp210x_get_termios
  * Reads the baud rate, data bits, parity, stop bits and flow control mode





[Index of Archives]     [Linux Media]     [Linux Input]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [Old Linux USB Devel Archive]

  Powered by Linux