X-Git-Url: https://sigrok.org/gitweb/?p=libsigrok.git;a=blobdiff_plain;f=hardware%2Frigol-ds%2Fprotocol.c;h=ac177f149a07a4832bc0fe7d4a9fe97965bd19f6;hp=b5379bb9bf0568523945cc7274625b52f92ac9f8;hb=ba7dd8bbb8168cba432a844259a3e239aa5f36d7;hpb=677f85d00bacfce05ad50ec2e9f6d7c47a761a43

diff --git a/hardware/rigol-ds/protocol.c b/hardware/rigol-ds/protocol.c
index b5379bb9..ac177f14 100644
--- a/hardware/rigol-ds/protocol.c
+++ b/hardware/rigol-ds/protocol.c
@@ -64,9 +64,6 @@
  * Each data block has a trailing linefeed too.
  */
 
-static int get_cfg(const struct sr_dev_inst *sdi, char *cmd, char *reply, size_t maxlen);
-static int get_cfg_int(const struct sr_dev_inst *sdi, char *cmd, int *i);
-
 static int parse_int(const char *str, int *ret)
 {
 	char *e;
@@ -107,7 +104,7 @@ static void rigol_ds_set_wait_event(struct dev_context *devc, enum wait_events e
  */
 static int rigol_ds_event_wait(const struct sr_dev_inst *sdi, char status1, char status2)
 {
-	char buf[20];
+	char *buf;
 	struct dev_context *devc;
 	time_t start;
 
@@ -132,7 +129,7 @@ static int rigol_ds_event_wait(const struct sr_dev_inst *sdi, char status1, char
 				return SR_ERR_TIMEOUT;
 			}
 
-			if (get_cfg(sdi, ":TRIG:STAT?", buf, sizeof(buf)) != SR_OK)
+			if (sr_scpi_get_string(sdi->conn, ":TRIG:STAT?", &buf) != SR_OK)
 				return SR_ERR;
 		} while (buf[0] == status1 || buf[0] == status2);
 
@@ -145,7 +142,7 @@ static int rigol_ds_event_wait(const struct sr_dev_inst *sdi, char status1, char
 				return SR_ERR_TIMEOUT;
 			}
 
-			if (get_cfg(sdi, ":TRIG:STAT?", buf, sizeof(buf)) != SR_OK)
+			if (sr_scpi_get_string(sdi->conn, ":TRIG:STAT?", &buf) != SR_OK)
 				return SR_ERR;
 		} while (buf[0] != status1 && buf[0] != status2);
 
@@ -182,14 +179,13 @@ static int rigol_ds_trigger_wait(const struct sr_dev_inst *sdi)
 	 * If timebase < 50 msecs/DIV just sleep about one sweep time except
 	 * for really fast sweeps.
 	 */
-	if (devc->timebase < 0.0499)
-	{
+	if (devc->timebase < 0.0499) {
 		if (devc->timebase > 0.99e-6) {
 			/*
 			 * Timebase * num hor. divs * 85(%) * 1e6(usecs) / 100
 			 * -> 85 percent of sweep time
 			 */
-			s = (devc->timebase * devc->model->num_horizontal_divs
+			s = (devc->timebase * devc->model->series->num_horizontal_divs
 			     * 85e6) / 100L;
 			sr_spew("Sleeping for %ld usecs instead of trigger-wait", s);
 			g_usleep(s);
@@ -211,18 +207,24 @@ static int rigol_ds_stop_wait(const struct sr_dev_inst *sdi)
 static int rigol_ds_check_stop(const struct sr_dev_inst *sdi)
 {
 	struct dev_context *devc;
+	struct sr_channel *ch;
 	int tmp;
 
 	if (!(devc = sdi->priv))
 		return SR_ERR;
 
-	if (sr_scpi_send(sdi->conn, ":WAV:SOUR CHAN%d",
-			  devc->channel->index + 1) != SR_OK)
+	ch = devc->channel_entry->data;
+
+	if (devc->model->series->protocol <= PROTOCOL_V2)
+		return SR_OK;
+
+	if (rigol_ds_config_set(sdi, ":WAV:SOUR CHAN%d",
+			  ch->index + 1) != SR_OK)
 		return SR_ERR;
 	/* Check that the number of samples will be accepted */
-	if (sr_scpi_send(sdi->conn, ":WAV:POIN %d;*OPC", devc->analog_frame_size) != SR_OK)
+	if (rigol_ds_config_set(sdi, ":WAV:POIN %d", devc->analog_frame_size) != SR_OK)
 		return SR_ERR;
-	if (get_cfg_int(sdi, "*ESR?", &tmp) != SR_OK)
+	if (sr_scpi_get_int(sdi->conn, "*ESR?", &tmp) != SR_OK)
 		return SR_ERR;
 	/*
 	 * If we get an "Execution error" the scope went from "Single" to
@@ -240,7 +242,7 @@ static int rigol_ds_check_stop(const struct sr_dev_inst *sdi)
 		sr_warn("Single shot acquisition failed, retrying...");
 		/* Sleep a bit, otherwise the single shot will often fail */
 		g_usleep(500000);
-		sr_scpi_send(sdi->conn, ":SING");
+		rigol_ds_config_set(sdi, ":SING");
 		rigol_ds_set_wait_event(devc, WAIT_STOP);
 		return SR_ERR;
 	}
@@ -251,7 +253,7 @@ static int rigol_ds_check_stop(const struct sr_dev_inst *sdi)
 /* Wait for enough data becoming available in scope output buffer */
 static int rigol_ds_block_wait(const struct sr_dev_inst *sdi)
 {
-	char buf[30];
+	char *buf;
 	struct dev_context *devc;
 	time_t start;
 	int len;
@@ -259,39 +261,67 @@ static int rigol_ds_block_wait(const struct sr_dev_inst *sdi)
 	if (!(devc = sdi->priv))
 		return SR_ERR;
 
-	start = time(NULL);
+	if (devc->model->series->protocol >= PROTOCOL_V3) {
 
-	do {
-		if (time(NULL) - start >= 3) {
-			sr_dbg("Timeout waiting for data block");
-			return SR_ERR_TIMEOUT;
-		}
+		start = time(NULL);
 
-		/*
-		 * The scope copies data really slowly from sample
-		 * memory to its output buffer, so try not to bother
-		 * it too much with SCPI requests but don't wait too
-		 * long for short sample frame sizes.
-		 */
-		g_usleep(devc->analog_frame_size < 15000 ? 100000 : 1000000);
+		do {
+			if (time(NULL) - start >= 3) {
+				sr_dbg("Timeout waiting for data block");
+				return SR_ERR_TIMEOUT;
+			}
 
-		/* "READ,nnnn" (still working) or "IDLE,nnnn" (finished) */
-		if (get_cfg(sdi, ":WAV:STAT?", buf, sizeof(buf)) != SR_OK)
-			return SR_ERR;
+			/*
+			 * The scope copies data really slowly from sample
+			 * memory to its output buffer, so try not to bother
+			 * it too much with SCPI requests but don't wait too
+			 * long for short sample frame sizes.
+			 */
+			g_usleep(devc->analog_frame_size < 15000 ? 100000 : 1000000);
 
-		if (parse_int(buf + 5, &len) != SR_OK)
-			return SR_ERR;
-	} while (buf[0] == 'R' && len < 1000000);
+			/* "READ,nnnn" (still working) or "IDLE,nnnn" (finished) */
+			if (sr_scpi_get_string(sdi->conn, ":WAV:STAT?", &buf) != SR_OK)
+				return SR_ERR;
+
+			if (parse_int(buf + 5, &len) != SR_OK)
+				return SR_ERR;
+		} while (buf[0] == 'R' && len < 1000000);
+	}
 
 	rigol_ds_set_wait_event(devc, WAIT_NONE);
 
 	return SR_OK;
 }
 
+/* Send a configuration setting. */
+SR_PRIV int rigol_ds_config_set(const struct sr_dev_inst *sdi, const char *format, ...)
+{
+	struct dev_context *devc = sdi->priv;
+	va_list args;
+	int ret;
+
+	va_start(args, format);
+	ret = sr_scpi_send_variadic(sdi->conn, format, args);
+	va_end(args);
+
+	if (ret != SR_OK)
+		return SR_ERR;
+
+	if (devc->model->series->protocol == PROTOCOL_V2) {
+		/* The DS1000 series needs this stupid delay, *OPC? doesn't work. */
+		sr_spew("delay %dms", 100);
+		g_usleep(100000);
+		return SR_OK;
+	} else {
+		return sr_scpi_get_opc(sdi->conn);
+	}
+}
+
 /* Start capturing a new frameset */
 SR_PRIV int rigol_ds_capture_start(const struct sr_dev_inst *sdi)
 {
 	struct dev_context *devc;
+	gchar *trig_mode;
 
 	if (!(devc = sdi->priv))
 		return SR_ERR;
@@ -299,18 +329,44 @@ SR_PRIV int rigol_ds_capture_start(const struct sr_dev_inst *sdi)
 	sr_dbg("Starting data capture for frameset %lu of %lu",
 	       devc->num_frames + 1, devc->limit_frames);
 
-	if (sr_scpi_send(sdi->conn, ":WAV:FORM BYTE") != SR_OK)
-		return SR_ERR;
-	if (devc->data_source == DATA_SOURCE_LIVE) {
-		if (sr_scpi_send(sdi->conn, ":WAV:MODE NORM") != SR_OK)
-			return SR_ERR;
+	switch (devc->model->series->protocol) {
+	case PROTOCOL_V1:
 		rigol_ds_set_wait_event(devc, WAIT_TRIGGER);
-	} else {
-		if (sr_scpi_send(sdi->conn, ":WAV:MODE RAW") != SR_OK)
+		break;
+	case PROTOCOL_V2:
+		if (devc->data_source == DATA_SOURCE_LIVE) {
+			if (rigol_ds_config_set(sdi, ":WAV:POIN:MODE NORMAL") != SR_OK)
+				return SR_ERR;
+			rigol_ds_set_wait_event(devc, WAIT_TRIGGER);
+		} else {
+			if (rigol_ds_config_set(sdi, ":STOP") != SR_OK)
+				return SR_ERR;
+			if (rigol_ds_config_set(sdi, ":WAV:POIN:MODE RAW") != SR_OK)
+				return SR_ERR;
+			if (sr_scpi_get_string(sdi->conn, ":TRIG:MODE?", &trig_mode) != SR_OK)
+				return SR_ERR;
+			if (rigol_ds_config_set(sdi, ":TRIG:%s:SWE SING", trig_mode) != SR_OK)
+				return SR_ERR;
+			if (rigol_ds_config_set(sdi, ":RUN") != SR_OK)
+				return SR_ERR;
+			rigol_ds_set_wait_event(devc, WAIT_STOP);
+		}
+		break;
+	case PROTOCOL_V3:
+		if (rigol_ds_config_set(sdi, ":WAV:FORM BYTE") != SR_OK)
 			return SR_ERR;
-		if (sr_scpi_send(sdi->conn, ":SING", devc->analog_frame_size) != SR_OK)
-			return SR_ERR;		
-		rigol_ds_set_wait_event(devc, WAIT_STOP);
+		if (devc->data_source == DATA_SOURCE_LIVE) {
+			if (rigol_ds_config_set(sdi, ":WAV:MODE NORM") != SR_OK)
+				return SR_ERR;
+			rigol_ds_set_wait_event(devc, WAIT_TRIGGER);
+		} else {
+			if (rigol_ds_config_set(sdi, ":WAV:MODE RAW") != SR_OK)
+				return SR_ERR;
+			if (rigol_ds_config_set(sdi, ":SING") != SR_OK)
+				return SR_ERR;
+			rigol_ds_set_wait_event(devc, WAIT_STOP);
+		}
+		break;
 	}
 
 	return SR_OK;
@@ -320,80 +376,101 @@ SR_PRIV int rigol_ds_capture_start(const struct sr_dev_inst *sdi)
 SR_PRIV int rigol_ds_channel_start(const struct sr_dev_inst *sdi)
 {
 	struct dev_context *devc;
+	struct sr_channel *ch;
 
 	if (!(devc = sdi->priv))
 		return SR_ERR;
 
-	sr_dbg("Starting reading data from channel %d",
-	       devc->channel->index + 1);
+	ch = devc->channel_entry->data;
+
+	sr_dbg("Starting reading data from channel %d", ch->index + 1);
 
-	if (devc->model->protocol == PROTOCOL_LEGACY) {
-		if (devc->channel->type == SR_DF_LOGIC) {
+	if (devc->model->series->protocol <= PROTOCOL_V2) {
+		if (ch->type == SR_PROBE_LOGIC) {
 			if (sr_scpi_send(sdi->conn, ":WAV:DATA? DIG") != SR_OK)
 				return SR_ERR;
 		} else {
-			if (sr_scpi_send(sdi->conn, ":WAV:DATA? CHAN%c",
-					devc->channel->name[2]) != SR_OK)
+			if (sr_scpi_send(sdi->conn, ":WAV:DATA? CHAN%d",
+					ch->index + 1) != SR_OK)
 				return SR_ERR;
 		}
+		rigol_ds_set_wait_event(devc, WAIT_NONE);
 	} else {
-		if (sr_scpi_send(sdi->conn, ":WAV:SOUR CHAN%d",
-				  devc->channel->index + 1) != SR_OK)
+		if (rigol_ds_config_set(sdi, ":WAV:SOUR CHAN%d",
+				  ch->index + 1) != SR_OK)
 			return SR_ERR;
 		if (devc->data_source != DATA_SOURCE_LIVE) {
-			if (sr_scpi_send(sdi->conn, ":WAV:RES") != SR_OK)
+			if (rigol_ds_config_set(sdi, ":WAV:RES") != SR_OK)
 				return SR_ERR;
-			if (sr_scpi_send(sdi->conn, ":WAV:BEG") != SR_OK)
+			if (rigol_ds_config_set(sdi, ":WAV:BEG") != SR_OK)
 				return SR_ERR;
-			rigol_ds_set_wait_event(devc, WAIT_BLOCK);
-		} else
-			rigol_ds_set_wait_event(devc, WAIT_NONE);
+		}
 	}
 
-	devc->num_frame_samples = 0;
+	rigol_ds_set_wait_event(devc, WAIT_BLOCK);
+
+	devc->num_channel_bytes = 0;
+	devc->num_header_bytes = 0;
 	devc->num_block_bytes = 0;
 
 	return SR_OK;
 }
 
 /* Read the header of a data block */
-static int rigol_ds_read_header(struct sr_scpi_dev_inst *scpi)
+static int rigol_ds_read_header(struct sr_dev_inst *sdi)
 {
-	char start[3], length[10];
-	int len, tmp;
-
-	/* Read the hashsign and length digit. */
-	tmp = sr_scpi_read(scpi, start, 2);
-	start[2] = '\0';
-	if (tmp != 2)
-	{
-		sr_err("Failed to read first two bytes of data block header.");
-		return -1;
+	struct sr_scpi_dev_inst *scpi = sdi->conn;
+	struct dev_context *devc = sdi->priv;
+	char *buf = (char *) devc->buffer;
+	size_t header_length;
+	int ret;
+
+	/* Try to read the hashsign and length digit. */
+	if (devc->num_header_bytes < 2) {
+		ret = sr_scpi_read_data(scpi, buf + devc->num_header_bytes,
+				2 - devc->num_header_bytes);
+		if (ret < 0) {
+			sr_err("Read error while reading data header.");
+			return SR_ERR;
+		}
+		devc->num_header_bytes += ret;
 	}
-	if (start[0] != '#' || !isdigit(start[1]) || start[1] == '0')
-	{
-		sr_err("Received invalid data block header start '%s'.", start);
-		return -1;
+
+	if (devc->num_header_bytes < 2)
+		return 0;
+
+	if (buf[0] != '#' || !isdigit(buf[1]) || buf[1] == '0') {
+		sr_err("Received invalid data block header '%c%c'.", buf[0], buf[1]);
+		return SR_ERR;
 	}
-	len = atoi(start + 1);
 
-	/* Read the data length. */
-	tmp = sr_scpi_read(scpi, length, len);
-	length[len] = '\0';
-	if (tmp != len)
-	{
-		sr_err("Failed to read %d bytes of data block length.", len);
-		return -1;
+	header_length = 2 + buf[1] - '0';
+
+	/* Try to read the length. */
+	if (devc->num_header_bytes < header_length) {
+		ret = sr_scpi_read_data(scpi, buf + devc->num_header_bytes,
+				header_length - devc->num_header_bytes);
+		if (ret < 0) {
+			sr_err("Read error while reading data header.");
+			return SR_ERR;
+		}
+		devc->num_header_bytes += ret;
 	}
-	if (parse_int(length, &len) != SR_OK)
-	{
-		sr_err("Received invalid data block length '%s'.", length);
+
+	if (devc->num_header_bytes < header_length)
+		return 0;
+
+	/* Read the data length. */
+	buf[header_length] = '\0';
+
+	if (parse_int(buf + 2, &ret) != SR_OK) {
+		sr_err("Received invalid data block length '%s'.", buf + 2);
 		return -1;
 	}
 
-	sr_dbg("Received data block header: %s%s -> block length %d", start, length, len);
+	sr_dbg("Received data block header: '%s' -> block length %d", buf, ret);
 
-	return len;
+	return ret;
 }
 
 SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
@@ -405,8 +482,9 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
 	struct sr_datafeed_analog analog;
 	struct sr_datafeed_logic logic;
 	double vdiv, offset;
-	int len, i, waveform_size, vref;
-	struct sr_probe *probe;
+	int len, i, vref;
+	struct sr_channel *ch;
+	gsize expected_data_bytes;
 
 	(void)fd;
 
@@ -418,44 +496,58 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
 
 	scpi = sdi->conn;
 
-	if (revents == G_IO_IN) {
-		if (devc->model->protocol == PROTOCOL_IEEE488_2) {
-			switch(devc->wait_event) {
-			case WAIT_NONE:
-				break;
+	if (revents == G_IO_IN || revents == 0) {
+		switch(devc->wait_event) {
+		case WAIT_NONE:
+			break;
+		case WAIT_TRIGGER:
+			if (rigol_ds_trigger_wait(sdi) != SR_OK)
+				return TRUE;
+			if (rigol_ds_channel_start(sdi) != SR_OK)
+				return TRUE;
+			return TRUE;
+		case WAIT_BLOCK:
+			if (rigol_ds_block_wait(sdi) != SR_OK)
+				return TRUE;
+			break;
+		case WAIT_STOP:
+			if (rigol_ds_stop_wait(sdi) != SR_OK)
+				return TRUE;
+			if (rigol_ds_check_stop(sdi) != SR_OK)
+				return TRUE;
+			if (rigol_ds_channel_start(sdi) != SR_OK)
+				return TRUE;
+			return TRUE;
+		default:
+			sr_err("BUG: Unknown event target encountered");
+		}
 
-			case WAIT_TRIGGER:
-				if (rigol_ds_trigger_wait(sdi) != SR_OK)
-					return TRUE;
-				if (rigol_ds_channel_start(sdi) != SR_OK)
-					return TRUE;
-				break;
+		ch = devc->channel_entry->data;
 
-			case WAIT_BLOCK:
-				if (rigol_ds_block_wait(sdi) != SR_OK)
-					return TRUE;
-				break;
+		expected_data_bytes = ch->type == SR_PROBE_ANALOG ?
+				devc->analog_frame_size : devc->digital_frame_size;
 
-			case WAIT_STOP:
-				if (rigol_ds_stop_wait(sdi) != SR_OK)
-					return TRUE;
-				if (rigol_ds_check_stop(sdi) != SR_OK)
-					return TRUE;
-				if (rigol_ds_channel_start(sdi) != SR_OK)
+		if (devc->num_block_bytes == 0) {
+			if (devc->model->series->protocol >= PROTOCOL_V3)
+				if (sr_scpi_send(sdi->conn, ":WAV:DATA?") != SR_OK)
 					return TRUE;
+
+			if (sr_scpi_read_begin(scpi) != SR_OK)
 				return TRUE;
 
-			default:
-				sr_err("BUG: Unknown event target encountered");
-			}
-		
-			if (devc->num_block_bytes == 0) {
+			if (devc->format == FORMAT_IEEE488_2) {
 				sr_dbg("New block header expected");
-				if (sr_scpi_send(sdi->conn, ":WAV:DATA?") != SR_OK)
+				len = rigol_ds_read_header(sdi);
+				if (len == 0)
+					/* Still reading the header. */
 					return TRUE;
-				len = rigol_ds_read_header(scpi);
-				if (len == -1)
+				if (len == -1) {
+					sr_err("Read error, aborting capture.");
+					packet.type = SR_DF_FRAME_END;
+					sr_session_send(cb_data, &packet);
+					sdi->driver->dev_acquisition_stop(sdi, cb_data);
 					return TRUE;
+				}
 				/* At slow timebases in live capture the DS2072
 				 * sometimes returns "short" data blocks, with
 				 * apparently no way to get the rest of the data.
@@ -463,53 +555,48 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
 				 * appear eventually.
 				 */
 				if (devc->data_source == DATA_SOURCE_LIVE
-				    && (unsigned)len < devc->num_frame_samples) {
+						&& (unsigned)len < expected_data_bytes) {
 					sr_dbg("Discarding short data block");
-					sr_scpi_read(scpi, (char *)devc->buffer, len + 1);
+					sr_scpi_read_data(scpi, (char *)devc->buffer, len + 1);
 					return TRUE;
 				}
 				devc->num_block_bytes = len;
-				devc->num_block_read = 0;
+			} else {
+				devc->num_block_bytes = expected_data_bytes;
 			}
+			devc->num_block_read = 0;
 		}
 
-		probe = devc->channel;
-		if (devc->model->protocol == PROTOCOL_IEEE488_2) {
-			len = devc->num_block_bytes - devc->num_block_read;
-			len = sr_scpi_read(scpi, (char *)devc->buffer,
-					len < ACQ_BUFFER_SIZE ? len : ACQ_BUFFER_SIZE);
-		} else {
-			waveform_size = probe->type == SR_PROBE_ANALOG ?
-					(devc->model->series == RIGOL_VS5000 ?
-						VS5000_ANALOG_LIVE_WAVEFORM_SIZE :
-						DS1000_ANALOG_LIVE_WAVEFORM_SIZE) :
-					DIGITAL_WAVEFORM_SIZE;
-			len = sr_scpi_read(scpi, (char *)devc->buffer,
-					waveform_size - devc->num_frame_samples);
+		len = devc->num_block_bytes - devc->num_block_read;
+		if (len > ACQ_BUFFER_SIZE)
+			len = ACQ_BUFFER_SIZE;
+		sr_dbg("Requesting read of %d bytes", len);
+
+		len = sr_scpi_read_data(scpi, (char *)devc->buffer, len);
+
+		if (len == -1) {
+			sr_err("Read error, aborting capture.");
+			packet.type = SR_DF_FRAME_END;
+			sr_session_send(cb_data, &packet);
+			sdi->driver->dev_acquisition_stop(sdi, cb_data);
+			return TRUE;
 		}
+
 		sr_dbg("Received %d bytes.", len);
-		if (len == -1)
-			return TRUE;
 
-		if (devc->num_frame_samples == 0) {
-			/* Start of a new frame. */
-			packet.type = SR_DF_FRAME_BEGIN;
-			sr_session_send(sdi, &packet);
-		}
+		devc->num_block_read += len;
 
-		if (probe->type == SR_PROBE_ANALOG) {
-			if (devc->model->protocol == PROTOCOL_IEEE488_2)
-				devc->num_block_read += len;
-			vref = devc->vert_reference[probe->index];
-			vdiv = devc->vdiv[probe->index] / 25.6;
-			offset = devc->vert_offset[probe->index];
-			if (devc->model->protocol == PROTOCOL_IEEE488_2)
+		if (ch->type == SR_PROBE_ANALOG) {
+			vref = devc->vert_reference[ch->index];
+			vdiv = devc->vdiv[ch->index] / 25.6;
+			offset = devc->vert_offset[ch->index];
+			if (devc->model->series->protocol >= PROTOCOL_V3)
 				for (i = 0; i < len; i++)
 					devc->data[i] = ((int)devc->buffer[i] - vref) * vdiv - offset;
 			else
 				for (i = 0; i < len; i++)
 					devc->data[i] = (128 - devc->buffer[i]) * vdiv - offset;
-			analog.probes = g_slist_append(NULL, probe);
+			analog.channels = g_slist_append(NULL, ch);
 			analog.num_samples = len;
 			analog.data = devc->data;
 			analog.mq = SR_MQ_VOLTAGE;
@@ -518,47 +605,49 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
 			packet.type = SR_DF_ANALOG;
 			packet.payload = &analog;
 			sr_session_send(cb_data, &packet);
-			g_slist_free(analog.probes);
-
-			if (devc->model->protocol == PROTOCOL_IEEE488_2) {
-				if (devc->num_block_read == devc->num_block_bytes) {
-					sr_dbg("Block has been completed");
-					/* Discard the terminating linefeed and prepare for
-					   possible next block */
-					sr_scpi_read(scpi, (char *)devc->buffer, 1);
-					devc->num_block_bytes = 0;
-					if (devc->data_source != DATA_SOURCE_LIVE)
-						rigol_ds_set_wait_event(devc, WAIT_BLOCK);
-				} else
-					sr_dbg("%d of %d block bytes read", devc->num_block_read, devc->num_block_bytes);
-			}
-
-			devc->num_frame_samples += len;
-
-			if (devc->num_frame_samples < devc->analog_frame_size)
-				/* Don't have the whole frame yet. */
-				return TRUE;
-
-			sr_dbg("Frame completed, %d samples", devc->num_frame_samples);
+			g_slist_free(analog.channels);
 		} else {
-			logic.length = len - 10;
+			logic.length = len;
 			logic.unitsize = 2;
-			logic.data = devc->buffer + 10;
+			logic.data = devc->buffer;
 			packet.type = SR_DF_LOGIC;
 			packet.payload = &logic;
 			sr_session_send(cb_data, &packet);
+		}
 
-			if (len != DIGITAL_WAVEFORM_SIZE)
-				/* Don't have the whole frame yet. */
+		if (devc->num_block_read == devc->num_block_bytes) {
+			sr_dbg("Block has been completed");
+			if (devc->model->series->protocol >= PROTOCOL_V3) {
+				/* Discard the terminating linefeed */
+				sr_scpi_read_data(scpi, (char *)devc->buffer, 1);
+			}
+			if (devc->format == FORMAT_IEEE488_2) {
+				/* Prepare for possible next block */
+				devc->num_header_bytes = 0;
+				devc->num_block_bytes = 0;
+				if (devc->data_source != DATA_SOURCE_LIVE)
+					rigol_ds_set_wait_event(devc, WAIT_BLOCK);
+			}
+			if (!sr_scpi_read_complete(scpi)) {
+				sr_err("Read should have been completed");
+				packet.type = SR_DF_FRAME_END;
+				sr_session_send(cb_data, &packet);
+				sdi->driver->dev_acquisition_stop(sdi, cb_data);
 				return TRUE;
+			}
+			devc->num_block_read = 0;
+		} else {
+			sr_dbg("%d of %d block bytes read", devc->num_block_read, devc->num_block_bytes);
 		}
 
-		/* End of the frame. */
-		packet.type = SR_DF_FRAME_END;
-		sr_session_send(sdi, &packet);
-		if (devc->model->protocol == PROTOCOL_LEGACY)
-			devc->num_frame_samples = 0;
-		else {
+		devc->num_channel_bytes += len;
+
+		if (devc->num_channel_bytes < expected_data_bytes)
+			/* Don't have the full data for this channel yet, re-run. */
+			return TRUE;
+
+		/* End of data for this channel. */
+		if (devc->model->series->protocol >= PROTOCOL_V3) {
 			/* Signal end of data download to scope */
 			if (devc->data_source != DATA_SOURCE_LIVE)
 				/*
@@ -566,39 +655,43 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
 				 * to the next channel causes an error. Fun with
 				 * firmware...
 				 */
-				sr_scpi_send(sdi->conn, ":WAV:END");
+				rigol_ds_config_set(sdi, ":WAV:END");
 		}
 
-		if (devc->enabled_analog_probes
-				&& devc->channel == devc->enabled_analog_probes->data
-				&& devc->enabled_analog_probes->next != NULL) {
-			/* We got the frame for the first analog channel, but
-			 * there's a second analog channel. */
-			devc->channel = devc->enabled_analog_probes->next->data;
+		if (ch->type == SR_PROBE_ANALOG
+				&& devc->channel_entry->next != NULL) {
+			/* We got the frame for this analog channel, but
+			 * there's another analog channel. */
+			devc->channel_entry = devc->channel_entry->next;
 			rigol_ds_channel_start(sdi);
 		} else {
-			/* Done with both analog channels in this frame. */
-			if (devc->enabled_digital_probes
-					&& devc->channel != devc->enabled_digital_probes->data) {
+			/* Done with all analog channels in this frame. */
+			if (devc->enabled_digital_channels
+					&& devc->channel_entry != devc->enabled_digital_channels) {
 				/* Now we need to get the digital data. */
-				devc->channel = devc->enabled_digital_probes->data;
+				devc->channel_entry = devc->enabled_digital_channels;
 				rigol_ds_channel_start(sdi);
-			} else if (++devc->num_frames == devc->limit_frames) {
-				/* End of last frame. */
-				packet.type = SR_DF_END;
-				sr_session_send(sdi, &packet);
-				sdi->driver->dev_acquisition_stop(sdi, cb_data);
 			} else {
-				/* Get the next frame, starting with the first analog channel. */
-				if (devc->enabled_analog_probes)
-					devc->channel = devc->enabled_analog_probes->data;
-				else
-					devc->channel = devc->enabled_digital_probes->data;
-
-				if (devc->model->protocol == PROTOCOL_LEGACY)
-					rigol_ds_channel_start(sdi);
-				else
+				/* Done with this frame. */
+				packet.type = SR_DF_FRAME_END;
+				sr_session_send(cb_data, &packet);
+
+				if (++devc->num_frames == devc->limit_frames) {
+					/* Last frame, stop capture. */
+					sdi->driver->dev_acquisition_stop(sdi, cb_data);
+				} else {
+					/* Get the next frame, starting with the first analog channel. */
+					if (devc->enabled_analog_channels)
+						devc->channel_entry = devc->enabled_analog_channels;
+					else
+						devc->channel_entry = devc->enabled_digital_channels;
+
 					rigol_ds_capture_start(sdi);
+
+					/* Start of next frame. */
+					packet.type = SR_DF_FRAME_BEGIN;
+					sr_session_send(cb_data, &packet);
+				}
 			}
 		}
 	}
@@ -606,100 +699,38 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
 	return TRUE;
 }
 
-static int get_cfg(const struct sr_dev_inst *sdi, char *cmd, char *reply, size_t maxlen)
-{
-	int len;
-	struct dev_context *devc = sdi->priv;
-	struct sr_scpi_dev_inst *scpi = sdi->conn;
-	char *response;
-
-	if (sr_scpi_send(scpi, cmd) != SR_OK)
-		return SR_ERR;
-
-	if (sr_scpi_receive(scpi, &response) != SR_OK)
-		return SR_ERR;
-
-	g_strlcpy(reply, response, maxlen);
-	g_free(response);
-	len = strlen(reply);
-
-	if (devc->model->protocol == PROTOCOL_IEEE488_2) {
-		/* get rid of trailing linefeed */
-		if (len >= 1 && reply[len-1] == '\n')
-			reply[len-1] = '\0';
-	}
-
-	sr_spew("Received '%s'.", reply);
-
-	return SR_OK;
-}
-
-static int get_cfg_int(const struct sr_dev_inst *sdi, char *cmd, int *i)
-{
-	char buf[32];
-
-	if (get_cfg(sdi, cmd, buf, sizeof(buf)) != SR_OK)
-		return SR_ERR;
-
-	if (parse_int(buf, i) != SR_OK)
-		return SR_ERR;
-
-	return SR_OK;
-}
-
-static int get_cfg_float(const struct sr_dev_inst *sdi, char *cmd, float *f)
-{
-	char buf[32], *e;
-
-	if (get_cfg(sdi, cmd, buf, sizeof(buf)) != SR_OK)
-		return SR_ERR;
-	*f = strtof(buf, &e);
-	if (e == buf || (fpclassify(*f) & (FP_ZERO | FP_NORMAL)) == 0) {
-		sr_dbg("failed to parse response to '%s': '%s'", cmd, buf);
-		return SR_ERR;
-	}
-
-	return SR_OK;
-}
-
-static int get_cfg_string(const struct sr_dev_inst *sdi, char *cmd, char **buf)
-{
-	if (!(*buf = g_try_malloc0(256)))
-		return SR_ERR_MALLOC;
-
-	if (get_cfg(sdi, cmd, *buf, 256) != SR_OK)
-		return SR_ERR;
-
-	return SR_OK;
-}
-
 SR_PRIV int rigol_ds_get_dev_cfg(const struct sr_dev_inst *sdi)
 {
 	struct dev_context *devc;
 	char *t_s, *cmd;
-	int i, res;
+	unsigned int i;
+	int res;
 
 	devc = sdi->priv;
 
 	/* Analog channel state. */
-	if (get_cfg_string(sdi, ":CHAN1:DISP?", &t_s) != SR_OK)
-		return SR_ERR;
-	devc->analog_channels[0] = !strcmp(t_s, "ON") || !strcmp(t_s, "1");
-	g_free(t_s);
-	if (get_cfg_string(sdi, ":CHAN2:DISP?", &t_s) != SR_OK)
-		return SR_ERR;
-	devc->analog_channels[1] = !strcmp(t_s, "ON") || !strcmp(t_s, "1");
-	g_free(t_s);
-	sr_dbg("Current analog channel state CH1 %s CH2 %s",
-			devc->analog_channels[0] ? "on" : "off",
-			devc->analog_channels[1] ? "on" : "off");
+	for (i = 0; i < devc->model->analog_channels; i++) {
+		cmd = g_strdup_printf(":CHAN%d:DISP?", i + 1);
+		res = sr_scpi_get_string(sdi->conn, cmd, &t_s);
+		g_free(cmd);
+		if (res != SR_OK)
+			return SR_ERR;
+		devc->analog_channels[i] = !strcmp(t_s, "ON") || !strcmp(t_s, "1");
+	}
+	sr_dbg("Current analog channel state:");
+	for (i = 0; i < devc->model->analog_channels; i++)
+		sr_dbg("CH%d %s", i + 1, devc->analog_channels[i] ? "on" : "off");
 
 	/* Digital channel state. */
 	if (devc->model->has_digital) {
-		sr_dbg("Current digital channel state:");
+		if (sr_scpi_get_string(sdi->conn, ":LA:DISP?", &t_s) != SR_OK)
+			return SR_ERR;
+		devc->la_enabled = !strcmp(t_s, "ON") ? TRUE : FALSE;
+		sr_dbg("Logic analyzer %s, current digital channel state:",
+				devc->la_enabled ? "enabled" : "disabled");
 		for (i = 0; i < 16; i++) {
 			cmd = g_strdup_printf(":DIG%d:TURN?", i);
-			res = get_cfg_string(sdi, cmd, &t_s);
+			res = sr_scpi_get_string(sdi->conn, cmd, &t_s);
 			g_free(cmd);
 			if (res != SR_OK)
 				return SR_ERR;
@@ -710,59 +741,70 @@ SR_PRIV int rigol_ds_get_dev_cfg(const struct sr_dev_inst *sdi)
 	}
 
 	/* Timebase. */
-	if (get_cfg_float(sdi, ":TIM:SCAL?", &devc->timebase) != SR_OK)
+	if (sr_scpi_get_float(sdi->conn, ":TIM:SCAL?", &devc->timebase) != SR_OK)
 		return SR_ERR;
 	sr_dbg("Current timebase %g", devc->timebase);
 
 	/* Vertical gain. */
-	if (get_cfg_float(sdi, ":CHAN1:SCAL?", &devc->vdiv[0]) != SR_OK)
-		return SR_ERR;
-	if (get_cfg_float(sdi, ":CHAN2:SCAL?", &devc->vdiv[1]) != SR_OK)
-		return SR_ERR;
-	sr_dbg("Current vertical gain CH1 %g CH2 %g", devc->vdiv[0], devc->vdiv[1]);
+	for (i = 0; i < devc->model->analog_channels; i++) {
+		cmd = g_strdup_printf(":CHAN%d:SCAL?", i + 1);
+		res = sr_scpi_get_float(sdi->conn, cmd, &devc->vdiv[i]);
+		g_free(cmd);
+		if (res != SR_OK)
+			return SR_ERR;
+	}
+	sr_dbg("Current vertical gain:");
+	for (i = 0; i < devc->model->analog_channels; i++)
+		sr_dbg("CH%d %g", i + 1, devc->vdiv[i]);
 
-	if (devc->model->protocol == PROTOCOL_IEEE488_2) {
+	sr_dbg("Current vertical reference:");
+	if (devc->model->series->protocol >= PROTOCOL_V3) {
 		/* Vertical reference - not certain if this is the place to read it. */
-		if (sr_scpi_send(sdi->conn, ":WAV:SOUR CHAN1") != SR_OK)
-			return SR_ERR;
-		if (get_cfg_int(sdi, ":WAV:YREF?", &devc->vert_reference[0]) != SR_OK)
-			return SR_ERR;
-		if (sr_scpi_send(sdi->conn, ":WAV:SOUR CHAN2") != SR_OK)
-			return SR_ERR;
-		if (get_cfg_int(sdi, ":WAV:YREF?", &devc->vert_reference[1]) != SR_OK)
-			return SR_ERR;
-		sr_dbg("Current vertical reference CH1 %d CH2 %d",
-				devc->vert_reference[0], devc->vert_reference[1]);
+		for (i = 0; i < devc->model->analog_channels; i++) {
+			if (rigol_ds_config_set(sdi, ":WAV:SOUR CHAN%d", i + 1) != SR_OK)
+				return SR_ERR;
+			if (sr_scpi_get_int(sdi->conn, ":WAV:YREF?", &devc->vert_reference[i]) != SR_OK)
+				return SR_ERR;
+			sr_dbg("CH%d %d", i + 1, devc->vert_reference[i]);
+		}
 	}
 
 	/* Vertical offset. */
-	if (get_cfg_float(sdi, ":CHAN1:OFFS?", &devc->vert_offset[0]) != SR_OK)
-		return SR_ERR;
-	if (get_cfg_float(sdi, ":CHAN2:OFFS?", &devc->vert_offset[1]) != SR_OK)
-		return SR_ERR;
-	sr_dbg("Current vertical offset CH1 %g CH2 %g", devc->vert_offset[0],
-			devc->vert_offset[1]);
+	for (i = 0; i < devc->model->analog_channels; i++) {
+		cmd = g_strdup_printf(":CHAN%d:OFFS?", i + 1);
+		res = sr_scpi_get_float(sdi->conn, cmd, &devc->vert_offset[i]);
+		g_free(cmd);
+		if (res != SR_OK)
+			return SR_ERR;
+	}
+	sr_dbg("Current vertical offset:");
+	for (i = 0; i < devc->model->analog_channels; i++)
+		sr_dbg("CH%d %g", i + 1, devc->vert_offset[i]);
 
 	/* Coupling. */
-	if (get_cfg_string(sdi, ":CHAN1:COUP?", &devc->coupling[0]) != SR_OK)
-		return SR_ERR;
-	if (get_cfg_string(sdi, ":CHAN2:COUP?", &devc->coupling[1]) != SR_OK)
-		return SR_ERR;
-	sr_dbg("Current coupling CH1 %s CH2 %s", devc->coupling[0],
-			devc->coupling[1]);
+	for (i = 0; i < devc->model->analog_channels; i++) {
+		cmd = g_strdup_printf(":CHAN%d:COUP?", i + 1);
+		res = sr_scpi_get_string(sdi->conn, cmd, &devc->coupling[i]);
+		g_free(cmd);
+		if (res != SR_OK)
+			return SR_ERR;
+	}
+	sr_dbg("Current coupling:");
+	for (i = 0; i < devc->model->analog_channels; i++)
+		sr_dbg("CH%d %s", i + 1, devc->coupling[i]);
 
 	/* Trigger source. */
-	if (get_cfg_string(sdi, ":TRIG:EDGE:SOUR?", &devc->trigger_source) != SR_OK)
+	if (sr_scpi_get_string(sdi->conn, ":TRIG:EDGE:SOUR?", &devc->trigger_source) != SR_OK)
 		return SR_ERR;
 	sr_dbg("Current trigger source %s", devc->trigger_source);
 
 	/* Horizontal trigger position. */
-	if (get_cfg_float(sdi, ":TIM:OFFS?", &devc->horiz_triggerpos) != SR_OK)
+	if (sr_scpi_get_float(sdi->conn, ":TIM:OFFS?", &devc->horiz_triggerpos) != SR_OK)
 		return SR_ERR;
 	sr_dbg("Current horizontal trigger position %g", devc->horiz_triggerpos);
 
 	/* Trigger slope. */
-	if (get_cfg_string(sdi, ":TRIG:EDGE:SLOP?", &devc->trigger_slope) != SR_OK)
+	if (sr_scpi_get_string(sdi->conn, ":TRIG:EDGE:SLOP?", &devc->trigger_slope) != SR_OK)
 		return SR_ERR;
 	sr_dbg("Current trigger slope %s", devc->trigger_slope);