X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=hardware%2Fcommon%2Fserial.c;h=cebca29e418dd833007c37572a747d2c84d85cbc;hb=1ff7712c93fb61e7710de6c2b4241652445f368e;hp=6bf0e40270fbb13f95235c787f4cd6d542de496f;hpb=06d64eb880876bd8a81c249e7b2f690eb03e12c1;p=libsigrok.git

diff --git a/hardware/common/serial.c b/hardware/common/serial.c
index 6bf0e402..cebca29e 100644
--- a/hardware/common/serial.c
+++ b/hardware/common/serial.c
@@ -98,8 +98,7 @@ int serial_close(int fd)
 int serial_flush(int fd)
 {
 
-	tcflush(fd, TCIOFLUSH);
-
+	return tcflush(fd, TCIOFLUSH);
 }
 
 void *serial_backup_params(int fd)
@@ -125,7 +124,10 @@ void serial_restore_params(int fd, void *backup)
 #endif
 }
 
-/* flowcontrol 1 = rts/cts  2 = xon/xoff */
+/*
+ * flowcontrol 1 = rts/cts  2 = xon/xoff
+ * parity 0 = none, 1 = even, 2 = odd
+ */
 int serial_set_params(int fd, int speed, int bits, int parity, int stopbits,
 		      int flowcontrol)
 {
@@ -166,21 +168,81 @@ int serial_set_params(int fd, int speed, int bits, int parity, int stopbits,
 	}
 #else
 	struct termios term;
+	speed_t baud;
 
-	/* Only supporting what we need really, currently the OLS driver. */
-	if (speed != 115200 || bits != 8 || parity != 0 || stopbits != 1
-	    || flowcontrol != 2)
+	switch (speed) {
+	case 9600:
+		baud = B9600;
+		break;
+	case 38400:
+		baud = B38400;
+		break;
+	case 57600:
+		baud = B57600;
+		break;
+	case 115200:
+		baud = B115200;
+		break;
+	case 460800:
+		baud = B460800;
+		break;
+	default:
 		return SIGROK_ERR;
+	}
 
 	if (tcgetattr(fd, &term) < 0)
 		return SIGROK_ERR;
-	if (cfsetispeed(&term, B115200) < 0)
+	if (cfsetispeed(&term, baud) < 0)
 		return SIGROK_ERR;
+
 	term.c_cflag &= ~CSIZE;
-	term.c_cflag |= CS8;
+	switch (bits) {
+	case 8:
+		term.c_cflag |= CS8;
+		break;
+	case 7:
+		term.c_cflag |= CS7;
+		break;
+	default:
+		return SIGROK_ERR;
+	}
+
 	term.c_cflag &= ~CSTOPB;
-	term.c_cflag |= IXON | IXOFF;
-	term.c_iflag |= IGNPAR;
+	switch (stopbits) {
+	case 1:
+		break;
+	case 2:
+		term.c_cflag |= CSTOPB;
+	default:
+		return SIGROK_ERR;
+	}
+
+	term.c_cflag &= ~(IXON | IXOFF | CRTSCTS);
+	switch (flowcontrol) {
+	case 2:
+		term.c_cflag |= IXON | IXOFF;
+		break;
+	case 1:
+		term.c_cflag |= CRTSCTS;
+	default:
+		return SIGROK_ERR;
+	}
+
+	term.c_iflag &= ~(IGNPAR | PARODD | PARENB);
+	switch (parity) {
+	case 0:
+		term.c_iflag |= IGNPAR;
+		break;
+	case 1:
+		term.c_iflag |= PARENB;
+		break;
+	case 2:
+		term.c_iflag |= PARENB | PARODD;
+		break;
+	default:
+		return SIGROK_ERR;
+	}
+
 	if (tcsetattr(fd, TCSADRAIN, &term) < 0)
 		return SIGROK_ERR;
 #endif