]> sigrok.org Git - libsigrok.git/blobdiff - hardware/rigol-ds/protocol.c
rigol-ds: Enable/disable LA pod when (de)selecting digital channels.
[libsigrok.git] / hardware / rigol-ds / protocol.c
index cd460e9f483b47c2d14e154731c79576871c01d6..55d437b468806c509487f73b7d620417f5fa8ab6 100644 (file)
@@ -211,13 +211,16 @@ 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_probe *probe;
        int tmp;
 
        if (!(devc = sdi->priv))
                return SR_ERR;
 
+       probe = devc->channel_entry->data;
+
        if (sr_scpi_send(sdi->conn, ":WAV:SOUR CHAN%d",
-                         devc->channel_frame->index + 1) != SR_OK)
+                         probe->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)
@@ -320,26 +323,39 @@ 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_probe *probe;
 
        if (!(devc = sdi->priv))
                return SR_ERR;
 
-       sr_dbg("Starting reading data from channel %d",
-              devc->channel_frame->index + 1);
+       probe = devc->channel_entry->data;
 
-       if (sr_scpi_send(sdi->conn, ":WAV:SOUR CHAN%d",
-                         devc->channel_frame->index + 1) != SR_OK)
-               return SR_ERR;
-       if (devc->data_source != DATA_SOURCE_LIVE) {
-               if (sr_scpi_send(sdi->conn, ":WAV:RES") != SR_OK)
-                       return SR_ERR;
-               if (sr_scpi_send(sdi->conn, ":WAV:BEG") != SR_OK)
+       sr_dbg("Starting reading data from channel %d", probe->index + 1);
+
+       if (devc->model->protocol == PROTOCOL_LEGACY) {
+               if (probe->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%d",
+                                       probe->index + 1) != SR_OK)
+                               return SR_ERR;
+               }
+       } else {
+               if (sr_scpi_send(sdi->conn, ":WAV:SOUR CHAN%d",
+                                 probe->index + 1) != SR_OK)
                        return SR_ERR;
-               rigol_ds_set_wait_event(devc, WAIT_BLOCK);
-       } else
-               rigol_ds_set_wait_event(devc, WAIT_NONE);
+               if (devc->data_source != DATA_SOURCE_LIVE) {
+                       if (sr_scpi_send(sdi->conn, ":WAV:RES") != SR_OK)
+                               return SR_ERR;
+                       if (sr_scpi_send(sdi->conn, ":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_bytes = 0;
+       devc->num_frame_samples = 0;
        devc->num_block_bytes = 0;
 
        return SR_OK;
@@ -352,7 +368,7 @@ static int rigol_ds_read_header(struct sr_scpi_dev_inst *scpi)
        int len, tmp;
 
        /* Read the hashsign and length digit. */
-       tmp = sr_scpi_read(scpi, start, 2);
+       tmp = sr_scpi_read_data(scpi, start, 2);
        start[2] = '\0';
        if (tmp != 2)
        {
@@ -367,7 +383,7 @@ static int rigol_ds_read_header(struct sr_scpi_dev_inst *scpi)
        len = atoi(start + 1);
 
        /* Read the data length. */
-       tmp = sr_scpi_read(scpi, length, len);
+       tmp = sr_scpi_read_data(scpi, length, len);
        length[len] = '\0';
        if (tmp != len)
        {
@@ -394,7 +410,7 @@ 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;
+       int len, i, vref;
        struct sr_probe *probe;
 
        (void)fd;
@@ -407,7 +423,7 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
 
        scpi = sdi->conn;
 
-       if (revents == G_IO_IN) {
+       if (revents == G_IO_IN || revents == 0) {
                if (devc->model->protocol == PROTOCOL_IEEE488_2) {
                        switch(devc->wait_event) {
                        case WAIT_NONE:
@@ -437,11 +453,21 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
                        default:
                                sr_err("BUG: Unknown event target encountered");
                        }
+               }
+
+               probe = devc->channel_entry->data;
                
-                       if (devc->num_block_bytes == 0) {
-                               sr_dbg("New block header expected");
+               if (devc->num_block_bytes == 0 &&
+                   devc->model->protocol == PROTOCOL_IEEE488_2) {
                                if (sr_scpi_send(sdi->conn, ":WAV:DATA?") != SR_OK)
                                        return TRUE;
+               }
+
+               if (devc->num_block_bytes == 0) {
+                       if (sr_scpi_read_begin(scpi) != SR_OK)
+                               return TRUE;
+                       if (devc->model->protocol == PROTOCOL_IEEE488_2) {
+                               sr_dbg("New block header expected");
                                len = rigol_ds_read_header(scpi);
                                if (len == -1)
                                        return TRUE;
@@ -452,40 +478,39 @@ 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_bytes) {
+                                               && (unsigned)len < devc->num_frame_samples) {
                                        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 = 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_read = 0;
                }
 
-               probe = devc->channel_frame;
-               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 ?
-                                       DS1000_ANALOG_LIVE_WAVEFORM_SIZE : DIGITAL_WAVEFORM_SIZE;
-                       len = sr_scpi_read(scpi, (char *)devc->buffer,
-                                       waveform_size - devc->num_frame_bytes);
-               }
+               len = devc->num_block_bytes - devc->num_block_read;
+               len = sr_scpi_read_data(scpi, (char *)devc->buffer,
+                               len < ACQ_BUFFER_SIZE ? len : ACQ_BUFFER_SIZE);
+
                sr_dbg("Received %d bytes.", len);
                if (len == -1)
                        return TRUE;
 
-               if (devc->num_frame_bytes == 0) {
+               devc->num_block_read += len;
+
+               if (devc->num_frame_samples == 0) {
                        /* Start of a new frame. */
                        packet.type = SR_DF_FRAME_BEGIN;
                        sr_session_send(sdi, &packet);
                }
 
                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];
@@ -505,27 +530,6 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
                        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_bytes += len;
-
-                       if (devc->num_frame_bytes < devc->analog_frame_size)
-                               /* Don't have the whole frame yet. */
-                               return TRUE;
-
-                       sr_dbg("Frame completed, %d samples", devc->num_frame_bytes);
                } else {
                        logic.length = len - 10;
                        logic.unitsize = 2;
@@ -533,18 +537,35 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
                        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. */
-                               return TRUE;
+               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_data(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);
+                       }
+                       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;
+
+               if (devc->num_frame_samples < (probe->type == SR_PROBE_ANALOG ?
+                                       devc->analog_frame_size : DIGITAL_WAVEFORM_SIZE))
+                       /* Don't have the whole frame yet. */
+                       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_LEGACY)
-                       devc->num_frame_bytes = 0;
-               else {
+               if (devc->model->protocol == PROTOCOL_IEEE488_2) {
                        /* Signal end of data download to scope */
                        if (devc->data_source != DATA_SOURCE_LIVE)
                                /*
@@ -555,47 +576,32 @@ SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
                                sr_scpi_send(sdi->conn, ":WAV:END");
                }
 
-               if (devc->enabled_analog_probes
-                               && devc->channel_frame == 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_frame = devc->enabled_analog_probes->next->data;
-                       if (devc->model->protocol == PROTOCOL_IEEE488_2) {
-                               rigol_ds_channel_start(sdi);
-                       } else {
-                               sr_scpi_send(sdi->conn, ":WAV:DATA? CHAN%c",
-                                               devc->channel_frame->name[2]);
-                       }
+               if (probe->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. */
+                       /* Done with all analog channels in this frame. */
                        if (devc->enabled_digital_probes
-                                       && devc->channel_frame != devc->enabled_digital_probes->data) {
+                                       && devc->channel_entry != devc->enabled_digital_probes) {
                                /* Now we need to get the digital data. */
-                               devc->channel_frame = devc->enabled_digital_probes->data;
-                               sr_scpi_send(sdi->conn, ":WAV:DATA? DIG");
+                               devc->channel_entry = devc->enabled_digital_probes;
+                               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->model->protocol == PROTOCOL_IEEE488_2) {
-                                       if (devc->enabled_analog_probes) {
-                                               devc->channel_frame = devc->enabled_analog_probes->data;
-                                               rigol_ds_capture_start(sdi);
-                                       }
-                               } else {
-                                       if (devc->enabled_analog_probes) {
-                                               devc->channel_frame = devc->enabled_analog_probes->data;
-                                               sr_scpi_send(sdi->conn, ":WAV:DATA? CHAN%c",
-                                                               devc->channel_frame->name[2]);
-                                       } else {
-                                               devc->channel_frame = devc->enabled_digital_probes->data;
-                                               sr_scpi_send(sdi->conn, ":WAV:DATA? DIG");
-                                       }
-                               }
+                               if (devc->enabled_analog_probes)
+                                       devc->channel_entry = devc->enabled_analog_probes;
+                               else
+                                       devc->channel_entry = devc->enabled_digital_probes;
+
+                               if (devc->model->protocol == PROTOCOL_LEGACY)
+                                       rigol_ds_channel_start(sdi);
+                               else
+                                       rigol_ds_capture_start(sdi);
                        }
                }
        }
@@ -610,10 +616,7 @@ static int get_cfg(const struct sr_dev_inst *sdi, char *cmd, char *reply, size_t
        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)
+       if (sr_scpi_get_string(scpi, cmd, &response) != SR_OK)
                return SR_ERR;
 
        g_strlcpy(reply, response, maxlen);
@@ -674,26 +677,31 @@ 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 = get_cfg_string(sdi, 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 (get_cfg_string(sdi, ":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);
@@ -712,41 +720,52 @@ SR_PRIV int rigol_ds_get_dev_cfg(const struct sr_dev_inst *sdi)
        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 = get_cfg_float(sdi, 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]);
 
+       sr_dbg("Current vertical reference:");
        if (devc->model->protocol == PROTOCOL_IEEE488_2) {
                /* 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 (sr_scpi_send(sdi->conn, ":WAV:SOUR CHAN%d", i + 1) != SR_OK)
+                               return SR_ERR;
+                       if (get_cfg_int(sdi, ":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 = get_cfg_float(sdi, 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 = get_cfg_string(sdi, 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)