From: Martin Ling <redacted>
Date: Sat, 16 Nov 2013 20:55:53 +0000 (+0000)
Subject: Add sp_get_config() function.
X-Git-Tag: libserialport-0.1.0~112
X-Git-Url: https://sigrok.org/gitweb/?p=libserialport.git;a=commitdiff_plain;h=067417af4fd8b619ed5ede2184cb450e35dc3ecd

Add sp_get_config() function.
---

diff --git a/libserialport.h.in b/libserialport.h.in
index 8306fbf..4d94a41 100644
--- a/libserialport.h.in
+++ b/libserialport.h.in
@@ -156,6 +156,7 @@ int sp_write(struct sp_port *port, const void *buf, size_t count);
 int sp_flush(struct sp_port *port);
 
 /* Basic port configuration */
+int sp_get_config(struct sp_port *port, struct sp_port_config *config);
 int sp_set_config(struct sp_port *port, struct sp_port_config *config);
 int sp_set_baudrate(struct sp_port *port, int baudrate);
 int sp_set_bits(struct sp_port *port, int bits);
diff --git a/serialport.c b/serialport.c
index 4cf7f93..269992e 100644
--- a/serialport.c
+++ b/serialport.c
@@ -892,6 +892,138 @@ int sp_set_config(struct sp_port *port, struct sp_port_config *config)
 	return SP_OK;
 }
 
+int sp_get_config(struct sp_port *port, struct sp_port_config *config)
+{
+	struct sp_port_data data;
+	unsigned int i;
+
+	TRY(start_config(port, &data));
+
+#ifdef _WIN32
+	for (i = 0; i < NUM_STD_BAUDRATES; i++) {
+		if (data.dcb.BaudRate == std_baudrates[i].index) {
+			config->baudrate = std_baudrates[i].value;
+			break;
+		}
+	}
+
+	if (i == NUM_STD_BAUDRATES)
+		/* BaudRate field can be either an index or a custom baud rate. */
+		config->baudrate = data.dcb.BaudRate;
+
+	config->bits = data.dcb.ByteSize;
+
+	if (data.dcb.fParity)
+		switch (data.dcb.Parity) {
+		case NOPARITY:
+			config->parity = SP_PARITY_NONE;
+			break;
+		case EVENPARITY:
+			config->parity = SP_PARITY_EVEN;
+			break;
+		case ODDPARITY:
+			config->parity = SP_PARITY_ODD;
+			break;
+		default:
+			config->parity = -1;
+		}
+	else
+		config->parity = SP_PARITY_NONE;
+
+	switch (data.dcb.StopBits) {
+	case ONESTOPBIT:
+		config->stopbits = 1;
+		break;
+	case TWOSTOPBITS:
+		config->stopbits = 2;
+		break;
+	default:
+		config->stopbits = -1;
+	}
+
+	switch (data.dcb.fRtsControl) {
+		case RTS_CONTROL_DISABLE:
+			config->rts = SP_RTS_OFF;
+			break;
+		case RTS_CONTROL_ENABLE:
+			config->rts = SP_RTS_ON;
+			break;
+		case RTS_CONTROL_HANDSHAKE:
+			config->rts = SP_RTS_FLOW_CONTROL;
+			break;
+		default:
+			config->rts = -1;
+	}
+
+	config->cts = data.dcb.fOutxCtsFlow ? SP_CTS_FLOW_CONTROL : SP_CTS_IGNORE;
+
+	switch (data.dcb.fDtrControl) {
+		case DTR_CONTROL_DISABLE:
+			config->dtr = SP_DTR_OFF;
+			break;
+		case DTR_CONTROL_ENABLE:
+			config->dtr = SP_DTR_ON;
+			break;
+		case DTR_CONTROL_HANDSHAKE:
+			config->dtr = SP_DTR_FLOW_CONTROL;
+			break;
+		default:
+			config->dtr = -1;
+	}
+
+	config->dsr = data.dcb.fOutxDsrFlow ? SP_DSR_FLOW_CONTROL : SP_DSR_IGNORE;
+#else
+	for (i = 0; i < NUM_STD_BAUDRATES; i++) {
+		if (cfgetispeed(&data.term) == std_baudrates[i].index) {
+			config->baudrate = std_baudrates[i].value;
+			break;
+		}
+	}
+
+	if (i == NUM_STD_BAUDRATES)
+		config->baudrate = -1;
+
+	switch (data.term.c_cflag & CSIZE) {
+	case CS8:
+		config->bits = 8;
+		break;
+	case CS7:
+		config->bits = 7;
+		break;
+	case CS6:
+		config->bits = 6;
+		break;
+	case CS5:
+		config->bits = 5;
+		break;
+	default:
+		config->bits = -1;
+	}
+
+	if (!(data.term.c_cflag & PARENB) && (data.term.c_iflag & IGNPAR))
+		config->parity = SP_PARITY_NONE;
+	else if (!(data.term.c_cflag & PARENB) || (data.term.c_iflag & IGNPAR))
+		config->parity = -1;
+	else
+		config->parity = (data.term.c_cflag & PARODD) ? SP_PARITY_ODD : SP_PARITY_EVEN;
+
+	config->stopbits = (data.term.c_cflag & CSTOPB) ? 2 : 1;
+
+	if (data.term.c_cflag & CRTSCTS) {
+		config->rts = SP_RTS_FLOW_CONTROL;
+		config->cts = SP_CTS_FLOW_CONTROL;
+	} else {
+		config->rts = (data.controlbits & TIOCM_RTS) ? SP_RTS_ON : SP_RTS_OFF;
+		config->cts = SP_CTS_IGNORE;
+	}
+
+	config->dtr = (data.controlbits & TIOCM_DTR) ? SP_DTR_ON : SP_DTR_OFF;
+	config->dsr = SP_DSR_IGNORE;
+#endif
+
+	return SP_OK;
+}
+
 int sp_set_flowcontrol(struct sp_port *port, int flowcontrol)
 {
 	struct sp_port_data data;