X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Fmotech-lps-30x%2Fprotocol.c;h=6daa5d9ffe6087fe2b8edd525bfd3bc2bf4abf79;hb=34577da641d836dcf27433fee3c6384565ca7847;hp=78d822f0ba21fd8724511d860efebb05d7ce1262;hpb=e050124095c3e0109ead1fc162504cc513a4e08c;p=libsigrok.git

diff --git a/src/hardware/motech-lps-30x/protocol.c b/src/hardware/motech-lps-30x/protocol.c
index 78d822f0..6daa5d9f 100644
--- a/src/hardware/motech-lps-30x/protocol.c
+++ b/src/hardware/motech-lps-30x/protocol.c
@@ -25,7 +25,6 @@
 
 #include <errno.h>
 #include <string.h>
-
 #include "protocol.h"
 
 /** Send data packets for current measurements. */
@@ -77,7 +76,10 @@ static void process_line(struct sr_dev_inst *sdi)
 	case 1: /* Waiting for data reply to request */
 		/* Convert numbers */
 		switch (devc->acq_req) {
-		case AQ_U1:  case AQ_U2:  case AQ_I1:  case AQ_I2:
+		case AQ_U1:
+		case AQ_U2:
+		case AQ_I1:
+		case AQ_I2:
 			if (sr_atod(devc->buf, &dbl) != SR_OK) {
 				sr_err("Failed to convert '%s' to double, errno=%d %s",
 					devc->buf, errno, strerror(errno));
@@ -131,7 +133,6 @@ static void process_line(struct sr_dev_inst *sdi)
 	devc->buflen = 0;
 }
 
-
 SR_PRIV int motech_lps_30x_receive_data(int fd, int revents, void *cb_data)
 {
 	struct sr_dev_inst *sdi;
@@ -187,51 +188,52 @@ SR_PRIV int motech_lps_30x_receive_data(int fd, int revents, void *cb_data)
 			sdi->driver->dev_acquisition_stop(sdi, cb_data);
 	}
 
-	/* Request next packet, if required. */
-	if ((sdi->status == SR_ST_ACTIVE) && (devc->acq_running)){
-		if (devc->acq_req_pending) {
-			gint64 elapsed_us = g_get_monotonic_time() - devc->req_sent_at;
-			if (elapsed_us > (REQ_TIMEOUT_MS * 1000)) {
-				sr_spew("Request timeout: req=%d t=%lldus", (int)devc->acq_req, elapsed_us);
-				devc->acq_req_pending = 0;
-			}
+	/* Only request the next packet if required. */
+	if (!((sdi->status == SR_ST_ACTIVE) && (devc->acq_running)))
+		return TRUE;
+
+	if (devc->acq_req_pending) {
+		gint64 elapsed_us = g_get_monotonic_time() - devc->req_sent_at;
+		if (elapsed_us > (REQ_TIMEOUT_MS * 1000)) {
+			sr_spew("Request timeout: req=%d t=%lldus", (int)devc->acq_req, elapsed_us);
+			devc->acq_req_pending = 0;
 		}
-		if (devc->acq_req_pending == 0) {
-			switch(devc->acq_req)
-			{
-			case AQ_NONE: /* Fall through */
-			case AQ_STATUS:
-				devc->acq_req = AQ_U1;
-				lps_send_req(serial, "VOUT1");
-				break;
-			case AQ_U1:
-				devc->acq_req = AQ_I1;
-				lps_send_req(serial, "IOUT1");
-				break;
-			case AQ_I1:
-				if (devc->model->num_channels == 1) {
-					devc->acq_req = AQ_STATUS;
-					lps_send_req(serial, "STATUS");
-				} else {
-					devc->acq_req = AQ_U2;
-					lps_send_req(serial, "VOUT2");
-				}
-				break;
-			case AQ_U2:
-				devc->acq_req = AQ_I2;
-				lps_send_req(serial, "IOUT2");
-				break;
-			case AQ_I2:
+	}
+
+	if (devc->acq_req_pending == 0) {
+		switch (devc->acq_req) {
+		case AQ_NONE: /* Fall through */
+		case AQ_STATUS:
+			devc->acq_req = AQ_U1;
+			lps_send_req(serial, "VOUT1");
+			break;
+		case AQ_U1:
+			devc->acq_req = AQ_I1;
+			lps_send_req(serial, "IOUT1");
+			break;
+		case AQ_I1:
+			if (devc->model->num_channels == 1) {
 				devc->acq_req = AQ_STATUS;
 				lps_send_req(serial, "STATUS");
-				break;
-			default:
-				sr_err("Illegal devc->acq_req=%d", devc->acq_req);
-				return SR_ERR;
+			} else {
+				devc->acq_req = AQ_U2;
+				lps_send_req(serial, "VOUT2");
 			}
-			devc->req_sent_at = g_get_real_time();
-			devc->acq_req_pending = 1;
+			break;
+		case AQ_U2:
+			devc->acq_req = AQ_I2;
+			lps_send_req(serial, "IOUT2");
+			break;
+		case AQ_I2:
+			devc->acq_req = AQ_STATUS;
+			lps_send_req(serial, "STATUS");
+			break;
+		default:
+			sr_err("Illegal devc->acq_req=%d", devc->acq_req);
+			return SR_ERR;
 		}
+		devc->req_sent_at = g_get_real_time();
+		devc->acq_req_pending = 1;
 	}
 
 	return TRUE;