]> sigrok.org Git - libsigrok.git/blobdiff - hardware/rigol-ds/protocol.c
build: Portability fixes.
[libsigrok.git] / hardware / rigol-ds / protocol.c
index fa4a2217162aabe9e3c6dc1ee376b8218aa603dd..97cb353c6ca597d1b9fe19b7e94396a0c043d7e8 100644 (file)
@@ -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;
 
-       if (devc->model->protocol == PROTOCOL_LEGACY) {
-               if (devc->channel->type == SR_PROBE_LOGIC) {
+       sr_dbg("Starting reading data from channel %d", ch->index + 1);
+
+       if (devc->model->series->protocol <= PROTOCOL_V2) {
+               if (ch->type == SR_CHANNEL_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)
@@ -406,7 +483,8 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
        struct sr_datafeed_logic logic;
        double vdiv, offset;
        int len, i, vref;
-       struct sr_probe *probe;
+       struct sr_channel *ch;
+       gsize expected_data_bytes;
 
        (void)fd;
 
@@ -418,48 +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_CHANNEL_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;
-                               return TRUE;
 
-                       default:
-                               sr_err("BUG: Unknown event target encountered");
-                       }
-               }
+                       if (sr_scpi_read_begin(scpi) != SR_OK)
+                               return TRUE;
 
-               probe = devc->channel;
-               
-               if (devc->num_block_bytes == 0) {
-                       if (devc->model->protocol == PROTOCOL_IEEE488_2) {
+                       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.
@@ -467,49 +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;
                        } else {
-                               devc->num_block_bytes = probe->type == SR_PROBE_ANALOG ?
-                                       (devc->model->series == RIGOL_VS5000 ?
-                                               VS5000_ANALOG_LIVE_WAVEFORM_SIZE :
-                                               DS1000_ANALOG_LIVE_WAVEFORM_SIZE) :
-                                       DIGITAL_WAVEFORM_SIZE;
+                               devc->num_block_bytes = expected_data_bytes;
                        }
                        devc->num_block_read = 0;
                }
 
                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);
+               if (len > ACQ_BUFFER_SIZE)
+                       len = ACQ_BUFFER_SIZE;
+               sr_dbg("Requesting read of %d bytes", len);
 
-               sr_dbg("Received %d bytes.", len);
-               if (len == -1)
+               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;
+               }
 
-               devc->num_block_read += len;
+               sr_dbg("Received %d bytes.", len);
 
-               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) {
-                       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_CHANNEL_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,11 +605,11 @@ 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);
+                       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);
@@ -530,31 +617,37 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
 
                if (devc->num_block_read == devc->num_block_bytes) {
                        sr_dbg("Block has been completed");
-                       if (devc->model->protocol == PROTOCOL_IEEE488_2) {
-                               /* Discard the terminating linefeed and prepare for
-                                  possible next block */
-                               sr_scpi_read(scpi, (char *)devc->buffer, 1);
+                       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);
                }
 
-               devc->num_frame_samples += len;
+               devc->num_channel_bytes += len;
 
-               if (devc->num_frame_samples < (probe->type == SR_PROBE_ANALOG ?
-                                       devc->analog_frame_size : DIGITAL_WAVEFORM_SIZE))
-                       /* Don't have the whole frame yet. */
+               if (devc->num_channel_bytes < expected_data_bytes)
+                       /* Don't have the full data for this channel yet, re-run. */
                        return TRUE;
 
-               /* End of the frame. */
-               sr_dbg("Frame completed, %d samples", devc->num_frame_samples);
-               packet.type = SR_DF_FRAME_END;
-               sr_session_send(sdi, &packet);
-               if (devc->model->protocol == PROTOCOL_IEEE488_2) {
+               /* 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)
                                /*
@@ -562,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_CHANNEL_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);
+                               }
                        }
                }
        }
@@ -602,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;
@@ -706,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);