]> sigrok.org Git - libsigrok.git/blame_incremental - src/hardware/rigol-ds/protocol.c
rigol-ds: fix use-after-free
[libsigrok.git] / src / hardware / rigol-ds / protocol.c
... / ...
CommitLineData
1/*
2 * This file is part of the libsigrok project.
3 *
4 * Copyright (C) 2012 Martin Ling <martin-git@earth.li>
5 * Copyright (C) 2013 Bert Vermeulen <bert@biot.com>
6 * Copyright (C) 2013 Mathias Grimmberger <mgri@zaphod.sax.de>
7 *
8 * This program is free software: you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation, either version 3 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program. If not, see <http://www.gnu.org/licenses/>.
20 */
21
22#include <config.h>
23#include <stdlib.h>
24#include <stdarg.h>
25#include <unistd.h>
26#include <errno.h>
27#include <string.h>
28#include <math.h>
29#include <ctype.h>
30#include <time.h>
31#include <glib.h>
32#include <libsigrok/libsigrok.h>
33#include "libsigrok-internal.h"
34#include "scpi.h"
35#include "protocol.h"
36
37/*
38 * This is a unified protocol driver for the DS1000 and DS2000 series.
39 *
40 * DS1000 support tested with a Rigol DS1102D.
41 *
42 * DS2000 support tested with a Rigol DS2072 using firmware version 01.01.00.02.
43 *
44 * The Rigol DS2000 series scopes try to adhere to the IEEE 488.2 (I think)
45 * standard. If you want to read it - it costs real money...
46 *
47 * Every response from the scope has a linefeed appended because the
48 * standard says so. In principle this could be ignored because sending the
49 * next command clears the output queue of the scope. This driver tries to
50 * avoid doing that because it may cause an error being generated inside the
51 * scope and who knows what bugs the firmware has WRT this.
52 *
53 * Waveform data is transferred in a format called "arbitrary block program
54 * data" specified in IEEE 488.2. See Agilents programming manuals for their
55 * 2000/3000 series scopes for a nice description.
56 *
57 * Each data block from the scope has a header, e.g. "#900000001400".
58 * The '#' marks the start of a block.
59 * Next is one ASCII decimal digit between 1 and 9, this gives the number of
60 * ASCII decimal digits following.
61 * Last are the ASCII decimal digits giving the number of bytes (not
62 * samples!) in the block.
63 *
64 * After this header as many data bytes as indicated follow.
65 *
66 * Each data block has a trailing linefeed too.
67 */
68
69static int parse_int(const char *str, int *ret)
70{
71 char *e;
72 long tmp;
73
74 errno = 0;
75 tmp = strtol(str, &e, 10);
76 if (e == str || *e != '\0') {
77 sr_dbg("Failed to parse integer: '%s'", str);
78 return SR_ERR;
79 }
80 if (errno) {
81 sr_dbg("Failed to parse integer: '%s', numerical overflow", str);
82 return SR_ERR;
83 }
84 if (tmp > INT_MAX || tmp < INT_MIN) {
85 sr_dbg("Failed to parse integer: '%s', value to large/small", str);
86 return SR_ERR;
87 }
88
89 *ret = (int)tmp;
90 return SR_OK;
91}
92
93/* Set the next event to wait for in rigol_ds_receive */
94static void rigol_ds_set_wait_event(struct dev_context *devc, enum wait_events event)
95{
96 if (event == WAIT_STOP)
97 devc->wait_status = 2;
98 else
99 devc->wait_status = 1;
100 devc->wait_event = event;
101}
102
103/*
104 * Waiting for a event will return a timeout after 2 to 3 seconds in order
105 * to not block the application.
106 */
107static int rigol_ds_event_wait(const struct sr_dev_inst *sdi, char status1, char status2)
108{
109 char *buf, c;
110 struct dev_context *devc;
111 time_t start;
112
113 if (!(devc = sdi->priv))
114 return SR_ERR;
115
116 start = time(NULL);
117
118 /*
119 * Trigger status may return:
120 * "TD" or "T'D" - triggered
121 * "AUTO" - autotriggered
122 * "RUN" - running
123 * "WAIT" - waiting for trigger
124 * "STOP" - stopped
125 */
126
127 if (devc->wait_status == 1) {
128 do {
129 if (time(NULL) - start >= 3) {
130 sr_dbg("Timeout waiting for trigger");
131 return SR_ERR_TIMEOUT;
132 }
133
134 if (sr_scpi_get_string(sdi->conn, ":TRIG:STAT?", &buf) != SR_OK)
135 return SR_ERR;
136 c = buf[0];
137 g_free(buf);
138 } while (c == status1 || c == status2);
139
140 devc->wait_status = 2;
141 }
142 if (devc->wait_status == 2) {
143 do {
144 if (time(NULL) - start >= 3) {
145 sr_dbg("Timeout waiting for trigger");
146 return SR_ERR_TIMEOUT;
147 }
148
149 if (sr_scpi_get_string(sdi->conn, ":TRIG:STAT?", &buf) != SR_OK)
150 return SR_ERR;
151 c = buf[0];
152 g_free(buf);
153 } while (c != status1 && c != status2);
154
155 rigol_ds_set_wait_event(devc, WAIT_NONE);
156 }
157
158 return SR_OK;
159}
160
161/*
162 * For live capture we need to wait for a new trigger event to ensure that
163 * sample data is not returned twice.
164 *
165 * Unfortunately this will never really work because for sufficiently fast
166 * timebases and trigger rates it just can't catch the status changes.
167 *
168 * What would be needed is a trigger event register with autoreset like the
169 * Agilents have. The Rigols don't seem to have anything like this.
170 *
171 * The workaround is to only wait for the trigger when the timebase is slow
172 * enough. Of course this means that for faster timebases sample data can be
173 * returned multiple times, this effect is mitigated somewhat by sleeping
174 * for about one sweep time in that case.
175 */
176static int rigol_ds_trigger_wait(const struct sr_dev_inst *sdi)
177{
178 struct dev_context *devc;
179 long s;
180
181 if (!(devc = sdi->priv))
182 return SR_ERR;
183
184 /*
185 * If timebase < 50 msecs/DIV just sleep about one sweep time except
186 * for really fast sweeps.
187 */
188 if (devc->timebase < 0.0499) {
189 if (devc->timebase > 0.99e-6) {
190 /*
191 * Timebase * num hor. divs * 85(%) * 1e6(usecs) / 100
192 * -> 85 percent of sweep time
193 */
194 s = (devc->timebase * devc->model->series->num_horizontal_divs
195 * 85e6) / 100L;
196 sr_spew("Sleeping for %ld usecs instead of trigger-wait", s);
197 g_usleep(s);
198 }
199 rigol_ds_set_wait_event(devc, WAIT_NONE);
200 return SR_OK;
201 } else {
202 return rigol_ds_event_wait(sdi, 'T', 'A');
203 }
204}
205
206/* Wait for scope to got to "Stop" in single shot mode */
207static int rigol_ds_stop_wait(const struct sr_dev_inst *sdi)
208{
209 return rigol_ds_event_wait(sdi, 'S', 'S');
210}
211
212/* Check that a single shot acquisition actually succeeded on the DS2000 */
213static int rigol_ds_check_stop(const struct sr_dev_inst *sdi)
214{
215 struct dev_context *devc;
216 struct sr_channel *ch;
217 int tmp;
218
219 if (!(devc = sdi->priv))
220 return SR_ERR;
221
222 ch = devc->channel_entry->data;
223
224 if (devc->model->series->protocol != PROTOCOL_V3)
225 return SR_OK;
226
227 if (ch->type == SR_CHANNEL_LOGIC) {
228 if (rigol_ds_config_set(sdi, ":WAV:SOUR LA") != SR_OK)
229 return SR_ERR;
230 } else {
231 if (rigol_ds_config_set(sdi, ":WAV:SOUR CHAN%d",
232 ch->index + 1) != SR_OK)
233 return SR_ERR;
234 }
235 /* Check that the number of samples will be accepted */
236 if (rigol_ds_config_set(sdi, ":WAV:POIN %d",
237 ch->type == SR_CHANNEL_LOGIC ?
238 devc->digital_frame_size :
239 devc->analog_frame_size) != SR_OK)
240 return SR_ERR;
241 if (sr_scpi_get_int(sdi->conn, "*ESR?", &tmp) != SR_OK)
242 return SR_ERR;
243 /*
244 * If we get an "Execution error" the scope went from "Single" to
245 * "Stop" without actually triggering. There is no waveform
246 * displayed and trying to download one will fail - the scope thinks
247 * it has 1400 samples (like display memory) and the driver thinks
248 * it has a different number of samples.
249 *
250 * In that case just try to capture something again. Might still
251 * fail in interesting ways.
252 *
253 * Ain't firmware fun?
254 */
255 if (tmp & 0x10) {
256 sr_warn("Single shot acquisition failed, retrying...");
257 /* Sleep a bit, otherwise the single shot will often fail */
258 g_usleep(500 * 1000);
259 rigol_ds_config_set(sdi, ":SING");
260 rigol_ds_set_wait_event(devc, WAIT_STOP);
261 return SR_ERR;
262 }
263
264 return SR_OK;
265}
266
267/* Wait for enough data becoming available in scope output buffer */
268static int rigol_ds_block_wait(const struct sr_dev_inst *sdi)
269{
270 char *buf, c;
271 struct dev_context *devc;
272 time_t start;
273 int len, ret;
274
275 if (!(devc = sdi->priv))
276 return SR_ERR;
277
278 if (devc->model->series->protocol == PROTOCOL_V3) {
279
280 start = time(NULL);
281
282 do {
283 if (time(NULL) - start >= 3) {
284 sr_dbg("Timeout waiting for data block");
285 return SR_ERR_TIMEOUT;
286 }
287
288 /*
289 * The scope copies data really slowly from sample
290 * memory to its output buffer, so try not to bother
291 * it too much with SCPI requests but don't wait too
292 * long for short sample frame sizes.
293 */
294 g_usleep(devc->analog_frame_size < (15 * 1000) ? (100 * 1000) : (1000 * 1000));
295
296 /* "READ,nnnn" (still working) or "IDLE,nnnn" (finished) */
297 if (sr_scpi_get_string(sdi->conn, ":WAV:STAT?", &buf) != SR_OK)
298 return SR_ERR;
299 ret = parse_int(buf + 5, &len);
300 c = buf[0];
301 g_free(buf);
302 if (ret != SR_OK)
303 return SR_ERR;
304 } while (c == 'R' && len < (1000 * 1000));
305 }
306
307 rigol_ds_set_wait_event(devc, WAIT_NONE);
308
309 return SR_OK;
310}
311
312/* Send a configuration setting. */
313SR_PRIV int rigol_ds_config_set(const struct sr_dev_inst *sdi, const char *format, ...)
314{
315 struct dev_context *devc = sdi->priv;
316 va_list args;
317 int ret;
318
319 va_start(args, format);
320 ret = sr_scpi_send_variadic(sdi->conn, format, args);
321 va_end(args);
322
323 if (ret != SR_OK)
324 return SR_ERR;
325
326 if (devc->model->series->protocol == PROTOCOL_V2) {
327 /* The DS1000 series needs this stupid delay, *OPC? doesn't work. */
328 sr_spew("delay %dms", 100);
329 g_usleep(100 * 1000);
330 return SR_OK;
331 } else {
332 return sr_scpi_get_opc(sdi->conn);
333 }
334}
335
336/* Start capturing a new frameset */
337SR_PRIV int rigol_ds_capture_start(const struct sr_dev_inst *sdi)
338{
339 struct dev_context *devc;
340 gchar *trig_mode;
341 unsigned int num_channels, i, j;
342 int buffer_samples;
343 int ret;
344
345 if (!(devc = sdi->priv))
346 return SR_ERR;
347
348 const gboolean first_frame = (devc->num_frames == 0);
349
350 uint64_t limit_frames = devc->limit_frames;
351 if (devc->num_frames_segmented != 0 && devc->num_frames_segmented < limit_frames)
352 limit_frames = devc->num_frames_segmented;
353 if (limit_frames == 0)
354 sr_dbg("Starting data capture for frameset %" PRIu64,
355 devc->num_frames + 1);
356 else
357 sr_dbg("Starting data capture for frameset %" PRIu64 " of %"
358 PRIu64, devc->num_frames + 1, limit_frames);
359
360 switch (devc->model->series->protocol) {
361 case PROTOCOL_V1:
362 rigol_ds_set_wait_event(devc, WAIT_TRIGGER);
363 break;
364 case PROTOCOL_V2:
365 if (devc->data_source == DATA_SOURCE_LIVE) {
366 if (rigol_ds_config_set(sdi, ":WAV:POIN:MODE NORMAL") != SR_OK)
367 return SR_ERR;
368 rigol_ds_set_wait_event(devc, WAIT_TRIGGER);
369 } else {
370 if (rigol_ds_config_set(sdi, ":STOP") != SR_OK)
371 return SR_ERR;
372 if (rigol_ds_config_set(sdi, ":WAV:POIN:MODE RAW") != SR_OK)
373 return SR_ERR;
374 if (sr_scpi_get_string(sdi->conn, ":TRIG:MODE?", &trig_mode) != SR_OK)
375 return SR_ERR;
376 ret = rigol_ds_config_set(sdi, ":TRIG:%s:SWE SING", trig_mode);
377 g_free(trig_mode);
378 if (ret != SR_OK)
379 return SR_ERR;
380 if (rigol_ds_config_set(sdi, ":RUN") != SR_OK)
381 return SR_ERR;
382 rigol_ds_set_wait_event(devc, WAIT_STOP);
383 }
384 break;
385 case PROTOCOL_V3:
386 case PROTOCOL_V4:
387 case PROTOCOL_V5:
388 if (first_frame && rigol_ds_config_set(sdi, ":WAV:FORM BYTE") != SR_OK)
389 return SR_ERR;
390 if (devc->data_source == DATA_SOURCE_LIVE) {
391 if (first_frame && rigol_ds_config_set(sdi, ":WAV:MODE NORM") != SR_OK)
392 return SR_ERR;
393 devc->analog_frame_size = devc->model->series->live_samples;
394 devc->digital_frame_size = devc->model->series->live_samples;
395 rigol_ds_set_wait_event(devc, WAIT_TRIGGER);
396 } else {
397 if (devc->model->series->protocol == PROTOCOL_V3) {
398 if (first_frame && rigol_ds_config_set(sdi, ":WAV:MODE RAW") != SR_OK)
399 return SR_ERR;
400 } else if (devc->model->series->protocol >= PROTOCOL_V4) {
401 num_channels = 0;
402
403 /* Channels 3 and 4 are multiplexed with D0-7 and D8-15 */
404 for (i = 0; i < devc->model->analog_channels; i++) {
405 if (devc->analog_channels[i]) {
406 num_channels++;
407 } else if (i >= 2 && devc->model->has_digital) {
408 for (j = 0; j < 8; j++) {
409 if (devc->digital_channels[8 * (i - 2) + j]) {
410 num_channels++;
411 break;
412 }
413 }
414 }
415 }
416
417 buffer_samples = devc->model->series->buffer_samples;
418 if (first_frame && buffer_samples == 0)
419 {
420 /* The DS4000 series does not have a fixed memory depth, it
421 * can be chosen from the menu and also varies with number
422 * of active channels. Retrieve the actual number with the
423 * ACQ:MDEP command. */
424 sr_scpi_get_int(sdi->conn, "ACQ:MDEP?", &buffer_samples);
425 devc->analog_frame_size = devc->digital_frame_size =
426 buffer_samples;
427 }
428 else if (first_frame)
429 {
430 /* The DS1000Z series has a fixed memory depth which we
431 * need to divide correctly according to the number of
432 * active channels. */
433 devc->analog_frame_size = devc->digital_frame_size =
434 num_channels == 1 ?
435 buffer_samples :
436 num_channels == 2 ?
437 buffer_samples / 2 :
438 buffer_samples / 4;
439 }
440 }
441
442 if (devc->data_source == DATA_SOURCE_LIVE && rigol_ds_config_set(sdi, ":SINGL") != SR_OK)
443 return SR_ERR;
444 rigol_ds_set_wait_event(devc, WAIT_STOP);
445 if (devc->data_source == DATA_SOURCE_SEGMENTED &&
446 devc->model->series->protocol <= PROTOCOL_V4)
447 if (rigol_ds_config_set(sdi, "FUNC:WREP:FCUR %d", devc->num_frames + 1) != SR_OK)
448 return SR_ERR;
449 }
450 break;
451 }
452
453 return SR_OK;
454}
455
456/* Start reading data from the current channel */
457SR_PRIV int rigol_ds_channel_start(const struct sr_dev_inst *sdi)
458{
459 struct dev_context *devc;
460 struct sr_channel *ch;
461
462 if (!(devc = sdi->priv))
463 return SR_ERR;
464
465 ch = devc->channel_entry->data;
466
467 sr_dbg("Starting reading data from channel %d", ch->index + 1);
468
469 const gboolean first_frame = (devc->num_frames == 0);
470
471 switch (devc->model->series->protocol) {
472 case PROTOCOL_V1:
473 case PROTOCOL_V2:
474 if (ch->type == SR_CHANNEL_LOGIC) {
475 if (sr_scpi_send(sdi->conn, ":WAV:DATA? DIG") != SR_OK)
476 return SR_ERR;
477 } else {
478 if (sr_scpi_send(sdi->conn, ":WAV:DATA? CHAN%d",
479 ch->index + 1) != SR_OK)
480 return SR_ERR;
481 }
482 rigol_ds_set_wait_event(devc, WAIT_NONE);
483 break;
484 case PROTOCOL_V3:
485 if (ch->type == SR_CHANNEL_LOGIC) {
486 if (rigol_ds_config_set(sdi, ":WAV:SOUR LA") != SR_OK)
487 return SR_ERR;
488 } else {
489 if (rigol_ds_config_set(sdi, ":WAV:SOUR CHAN%d",
490 ch->index + 1) != SR_OK)
491 return SR_ERR;
492 }
493 if (devc->data_source != DATA_SOURCE_LIVE) {
494 if (rigol_ds_config_set(sdi, ":WAV:RES") != SR_OK)
495 return SR_ERR;
496 if (rigol_ds_config_set(sdi, ":WAV:BEG") != SR_OK)
497 return SR_ERR;
498 }
499 break;
500 case PROTOCOL_V4:
501 case PROTOCOL_V5:
502 if (ch->type == SR_CHANNEL_ANALOG) {
503 if (rigol_ds_config_set(sdi, ":WAV:SOUR CHAN%d",
504 ch->index + 1) != SR_OK)
505 return SR_ERR;
506 } else {
507 if (rigol_ds_config_set(sdi, ":WAV:SOUR D%d",
508 ch->index) != SR_OK)
509 return SR_ERR;
510 }
511
512 if (first_frame && rigol_ds_config_set(sdi,
513 devc->data_source == DATA_SOURCE_LIVE ?
514 ":WAV:MODE NORM" :":WAV:MODE RAW") != SR_OK)
515 return SR_ERR;
516
517 if (devc->data_source != DATA_SOURCE_LIVE) {
518 if (rigol_ds_config_set(sdi, ":WAV:RES") != SR_OK)
519 return SR_ERR;
520 }
521 break;
522 }
523
524 if (devc->model->series->protocol >= PROTOCOL_V3 &&
525 ch->type == SR_CHANNEL_ANALOG) {
526 /* Vertical increment. */
527 if (first_frame && sr_scpi_get_float(sdi->conn, ":WAV:YINC?",
528 &devc->vert_inc[ch->index]) != SR_OK)
529 return SR_ERR;
530 /* Vertical origin. */
531 if (first_frame && sr_scpi_get_float(sdi->conn, ":WAV:YOR?",
532 &devc->vert_origin[ch->index]) != SR_OK)
533 return SR_ERR;
534 /* Vertical reference. */
535 if (first_frame && sr_scpi_get_int(sdi->conn, ":WAV:YREF?",
536 &devc->vert_reference[ch->index]) != SR_OK)
537 return SR_ERR;
538 } else if (ch->type == SR_CHANNEL_ANALOG) {
539 devc->vert_inc[ch->index] = devc->vdiv[ch->index] / 25.6;
540 }
541
542 rigol_ds_set_wait_event(devc, WAIT_BLOCK);
543
544 devc->num_channel_bytes = 0;
545 devc->num_header_bytes = 0;
546 devc->num_block_bytes = 0;
547
548 return SR_OK;
549}
550
551/* Read the header of a data block */
552static int rigol_ds_read_header(struct sr_dev_inst *sdi)
553{
554 struct sr_scpi_dev_inst *scpi = sdi->conn;
555 struct dev_context *devc = sdi->priv;
556 char *buf = (char *) devc->buffer;
557 size_t header_length;
558 int ret;
559
560 /* Try to read the hashsign and length digit. */
561 if (devc->num_header_bytes < 2) {
562 ret = sr_scpi_read_data(scpi, buf + devc->num_header_bytes,
563 2 - devc->num_header_bytes);
564 if (ret < 0) {
565 sr_err("Read error while reading data header.");
566 return SR_ERR;
567 }
568 devc->num_header_bytes += ret;
569 }
570
571 if (devc->num_header_bytes < 2)
572 return 0;
573
574 if (buf[0] != '#' || !isdigit(buf[1]) || buf[1] == '0') {
575 sr_err("Received invalid data block header '%c%c'.", buf[0], buf[1]);
576 return SR_ERR;
577 }
578
579 header_length = 2 + buf[1] - '0';
580
581 /* Try to read the length. */
582 if (devc->num_header_bytes < header_length) {
583 ret = sr_scpi_read_data(scpi, buf + devc->num_header_bytes,
584 header_length - devc->num_header_bytes);
585 if (ret < 0) {
586 sr_err("Read error while reading data header.");
587 return SR_ERR;
588 }
589 devc->num_header_bytes += ret;
590 }
591
592 if (devc->num_header_bytes < header_length)
593 return 0;
594
595 /* Read the data length. */
596 buf[header_length] = '\0';
597
598 if (parse_int(buf + 2, &ret) != SR_OK) {
599 sr_err("Received invalid data block length '%s'.", buf + 2);
600 return -1;
601 }
602
603 sr_dbg("Received data block header: '%s' -> block length %d", buf, ret);
604
605 return ret;
606}
607
608SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
609{
610 struct sr_dev_inst *sdi;
611 struct sr_scpi_dev_inst *scpi;
612 struct dev_context *devc;
613 struct sr_datafeed_packet packet;
614 struct sr_datafeed_analog analog;
615 struct sr_analog_encoding encoding;
616 struct sr_analog_meaning meaning;
617 struct sr_analog_spec spec;
618 struct sr_datafeed_logic logic;
619 double vdiv, offset, origin;
620 int len, i, vref;
621 struct sr_channel *ch;
622 gsize expected_data_bytes;
623
624 (void)fd;
625
626 if (!(sdi = cb_data))
627 return TRUE;
628
629 if (!(devc = sdi->priv))
630 return TRUE;
631
632 scpi = sdi->conn;
633
634 if (!(revents == G_IO_IN || revents == 0))
635 return TRUE;
636
637 const gboolean first_frame = (devc->num_frames == 0);
638
639 switch (devc->wait_event) {
640 case WAIT_NONE:
641 break;
642 case WAIT_TRIGGER:
643 if (rigol_ds_trigger_wait(sdi) != SR_OK)
644 return TRUE;
645 if (rigol_ds_channel_start(sdi) != SR_OK)
646 return TRUE;
647 return TRUE;
648 case WAIT_BLOCK:
649 if (rigol_ds_block_wait(sdi) != SR_OK)
650 return TRUE;
651 break;
652 case WAIT_STOP:
653 if (rigol_ds_stop_wait(sdi) != SR_OK)
654 return TRUE;
655 if (rigol_ds_check_stop(sdi) != SR_OK)
656 return TRUE;
657 if (rigol_ds_channel_start(sdi) != SR_OK)
658 return TRUE;
659 return TRUE;
660 default:
661 sr_err("BUG: Unknown event target encountered");
662 break;
663 }
664
665 ch = devc->channel_entry->data;
666
667 expected_data_bytes = ch->type == SR_CHANNEL_ANALOG ?
668 devc->analog_frame_size : devc->digital_frame_size;
669
670 if (devc->num_block_bytes == 0) {
671 if (devc->model->series->protocol >= PROTOCOL_V4) {
672 if (first_frame && rigol_ds_config_set(sdi, ":WAV:START %d",
673 devc->num_channel_bytes + 1) != SR_OK)
674 return TRUE;
675 if (first_frame && rigol_ds_config_set(sdi, ":WAV:STOP %d",
676 MIN(devc->num_channel_bytes + ACQ_BLOCK_SIZE,
677 devc->analog_frame_size)) != SR_OK)
678 return TRUE;
679 }
680
681 if (devc->model->series->protocol >= PROTOCOL_V3) {
682 if (rigol_ds_config_set(sdi, ":WAV:BEG") != SR_OK)
683 return TRUE;
684 if (sr_scpi_send(sdi->conn, ":WAV:DATA?") != SR_OK)
685 return TRUE;
686 }
687
688 if (sr_scpi_read_begin(scpi) != SR_OK)
689 return TRUE;
690
691 if (devc->format == FORMAT_IEEE488_2) {
692 sr_dbg("New block header expected");
693 len = rigol_ds_read_header(sdi);
694 if (len == 0)
695 /* Still reading the header. */
696 return TRUE;
697 if (len == -1) {
698 sr_err("Error while reading block header, aborting capture.");
699 std_session_send_df_frame_end(sdi);
700 sr_dev_acquisition_stop(sdi);
701 return TRUE;
702 }
703 /* At slow timebases in live capture the DS2072 and
704 * DS1054Z sometimes return "short" data blocks, with
705 * apparently no way to get the rest of the data.
706 * Discard these, the complete data block will appear
707 * eventually.
708 */
709 if (devc->data_source == DATA_SOURCE_LIVE
710 && (unsigned)len < expected_data_bytes) {
711 sr_dbg("Discarding short data block: got %d/%d bytes\n", len, (int)expected_data_bytes);
712 sr_scpi_read_data(scpi, (char *)devc->buffer, len + 1);
713 devc->num_header_bytes = 0;
714 return TRUE;
715 }
716 devc->num_block_bytes = len;
717 } else {
718 devc->num_block_bytes = expected_data_bytes;
719 }
720 devc->num_block_read = 0;
721 }
722
723 len = devc->num_block_bytes - devc->num_block_read;
724 if (len > ACQ_BUFFER_SIZE)
725 len = ACQ_BUFFER_SIZE;
726 sr_dbg("Requesting read of %d bytes", len);
727
728 len = sr_scpi_read_data(scpi, (char *)devc->buffer, len);
729
730 if (len == -1) {
731 sr_err("Error while reading block data, aborting capture.");
732 std_session_send_df_frame_end(sdi);
733 sr_dev_acquisition_stop(sdi);
734 return TRUE;
735 }
736
737 sr_dbg("Received %d bytes.", len);
738
739 devc->num_block_read += len;
740
741 if (ch->type == SR_CHANNEL_ANALOG) {
742 vref = devc->vert_reference[ch->index];
743 vdiv = devc->vert_inc[ch->index];
744 origin = devc->vert_origin[ch->index];
745 offset = devc->vert_offset[ch->index];
746 if (devc->model->series->protocol >= PROTOCOL_V3)
747 for (i = 0; i < len; i++)
748 devc->data[i] = ((int)devc->buffer[i] - vref - origin) * vdiv;
749 else
750 for (i = 0; i < len; i++)
751 devc->data[i] = (128 - devc->buffer[i]) * vdiv - offset;
752 float vdivlog = log10f(vdiv);
753 int digits = -(int)vdivlog + (vdivlog < 0.0);
754 sr_analog_init(&analog, &encoding, &meaning, &spec, digits);
755 analog.meaning->channels = g_slist_append(NULL, ch);
756 analog.num_samples = len;
757 analog.data = devc->data;
758 analog.meaning->mq = SR_MQ_VOLTAGE;
759 analog.meaning->unit = SR_UNIT_VOLT;
760 analog.meaning->mqflags = 0;
761 packet.type = SR_DF_ANALOG;
762 packet.payload = &analog;
763 sr_session_send(sdi, &packet);
764 g_slist_free(analog.meaning->channels);
765 } else {
766 logic.length = len;
767 // TODO: For the MSO1000Z series, we need a way to express that
768 // this data is in fact just for a single channel, with the valid
769 // data for that channel in the LSB of each byte.
770 logic.unitsize = devc->model->series->protocol >= PROTOCOL_V4 ? 1 : 2;
771 logic.data = devc->buffer;
772 packet.type = SR_DF_LOGIC;
773 packet.payload = &logic;
774 sr_session_send(sdi, &packet);
775 }
776
777 if (devc->num_block_read == devc->num_block_bytes) {
778 sr_dbg("Block has been completed");
779 if (devc->model->series->protocol >= PROTOCOL_V3) {
780 /* Discard the terminating linefeed */
781 sr_scpi_read_data(scpi, (char *)devc->buffer, 1);
782 }
783 if (devc->format == FORMAT_IEEE488_2) {
784 /* Prepare for possible next block */
785 devc->num_header_bytes = 0;
786 devc->num_block_bytes = 0;
787 if (devc->data_source != DATA_SOURCE_LIVE)
788 rigol_ds_set_wait_event(devc, WAIT_BLOCK);
789 }
790 if (!sr_scpi_read_complete(scpi) && !devc->channel_entry->next) {
791 sr_err("Read should have been completed");
792 }
793 devc->num_block_read = 0;
794 } else {
795 sr_dbg("%" PRIu64 " of %" PRIu64 " block bytes read",
796 devc->num_block_read, devc->num_block_bytes);
797 }
798
799 devc->num_channel_bytes += len;
800
801 if (devc->num_channel_bytes < expected_data_bytes)
802 /* Don't have the full data for this channel yet, re-run. */
803 return TRUE;
804
805 /* End of data for this channel. */
806 if (devc->model->series->protocol == PROTOCOL_V3) {
807 /* Signal end of data download to scope */
808 if (devc->data_source != DATA_SOURCE_LIVE)
809 /*
810 * This causes a query error, without it switching
811 * to the next channel causes an error. Fun with
812 * firmware...
813 */
814 rigol_ds_config_set(sdi, ":WAV:END");
815 }
816
817 if (devc->channel_entry->next) {
818 /* We got the frame for this channel, now get the next channel. */
819 devc->channel_entry = devc->channel_entry->next;
820 rigol_ds_channel_start(sdi);
821 } else {
822 /* Done with this frame. */
823 std_session_send_df_frame_end(sdi);
824
825 devc->num_frames++;
826
827 /* V5 has no way to read the number of recorded frames, so try to set the
828 * next frame and read it back instead.
829 */
830 if (devc->data_source == DATA_SOURCE_SEGMENTED &&
831 devc->model->series->protocol == PROTOCOL_V5) {
832 int frames = 0;
833 if (rigol_ds_config_set(sdi, "REC:CURR %d", devc->num_frames + 1) != SR_OK)
834 return SR_ERR;
835 if (sr_scpi_get_int(sdi->conn, "REC:CURR?", &frames) != SR_OK)
836 return SR_ERR;
837 devc->num_frames_segmented = frames;
838 }
839
840 if (devc->num_frames == devc->limit_frames ||
841 devc->num_frames == devc->num_frames_segmented ||
842 devc->data_source == DATA_SOURCE_MEMORY) {
843 /* Last frame, stop capture. */
844 sr_dev_acquisition_stop(sdi);
845 } else {
846 /* Get the next frame, starting with the first channel. */
847 devc->channel_entry = devc->enabled_channels;
848
849 rigol_ds_capture_start(sdi);
850
851 /* Start of next frame. */
852 std_session_send_df_frame_begin(sdi);
853 }
854 }
855
856 return TRUE;
857}
858
859SR_PRIV int rigol_ds_get_dev_cfg(const struct sr_dev_inst *sdi)
860{
861 struct dev_context *devc;
862 struct sr_channel *ch;
863 char *cmd;
864 unsigned int i;
865 int res;
866
867 devc = sdi->priv;
868
869 /* Analog channel state. */
870 for (i = 0; i < devc->model->analog_channels; i++) {
871 cmd = g_strdup_printf(":CHAN%d:DISP?", i + 1);
872 res = sr_scpi_get_bool(sdi->conn, cmd, &devc->analog_channels[i]);
873 g_free(cmd);
874 if (res != SR_OK)
875 return SR_ERR;
876 ch = g_slist_nth_data(sdi->channels, i);
877 ch->enabled = devc->analog_channels[i];
878 }
879 sr_dbg("Current analog channel state:");
880 for (i = 0; i < devc->model->analog_channels; i++)
881 sr_dbg("CH%d %s", i + 1, devc->analog_channels[i] ? "on" : "off");
882
883 /* Digital channel state. */
884 if (devc->model->has_digital) {
885 if (sr_scpi_get_bool(sdi->conn,
886 devc->model->series->protocol >= PROTOCOL_V3 ?
887 ":LA:STAT?" : ":LA:DISP?",
888 &devc->la_enabled) != SR_OK)
889 return SR_ERR;
890 sr_dbg("Logic analyzer %s, current digital channel state:",
891 devc->la_enabled ? "enabled" : "disabled");
892 for (i = 0; i < ARRAY_SIZE(devc->digital_channels); i++) {
893 if (devc->model->series->protocol >= PROTOCOL_V5)
894 cmd = g_strdup_printf(":LA:DISP? D%d", i);
895 else if (devc->model->series->protocol >= PROTOCOL_V3)
896 cmd = g_strdup_printf(":LA:DIG%d:DISP?", i);
897 else
898 cmd = g_strdup_printf(":DIG%d:TURN?", i);
899 res = sr_scpi_get_bool(sdi->conn, cmd, &devc->digital_channels[i]);
900 g_free(cmd);
901 if (res != SR_OK)
902 return SR_ERR;
903 ch = g_slist_nth_data(sdi->channels, i + devc->model->analog_channels);
904 ch->enabled = devc->digital_channels[i];
905 sr_dbg("D%d: %s", i, devc->digital_channels[i] ? "on" : "off");
906 }
907 }
908
909 /* Timebase. */
910 if (sr_scpi_get_float(sdi->conn, ":TIM:SCAL?", &devc->timebase) != SR_OK)
911 return SR_ERR;
912 sr_dbg("Current timebase %g", devc->timebase);
913
914 /* Probe attenuation. */
915 for (i = 0; i < devc->model->analog_channels; i++) {
916 cmd = g_strdup_printf(":CHAN%d:PROB?", i + 1);
917
918 /* DSO1000B series prints an X after the probe factor, so
919 * we get a string and check for that instead of only handling
920 * floats. */
921 char *response;
922 res = sr_scpi_get_string(sdi->conn, cmd, &response);
923 if (res != SR_OK)
924 return SR_ERR;
925
926 int len = strlen(response);
927 if (response[len-1] == 'X')
928 response[len-1] = 0;
929
930 res = sr_atof_ascii(response, &devc->attenuation[i]);
931 g_free(response);
932 g_free(cmd);
933 if (res != SR_OK)
934 return SR_ERR;
935 }
936 sr_dbg("Current probe attenuation:");
937 for (i = 0; i < devc->model->analog_channels; i++)
938 sr_dbg("CH%d %g", i + 1, devc->attenuation[i]);
939
940 /* Vertical gain and offset. */
941 if (rigol_ds_get_dev_cfg_vertical(sdi) != SR_OK)
942 return SR_ERR;
943
944 /* Coupling. */
945 for (i = 0; i < devc->model->analog_channels; i++) {
946 cmd = g_strdup_printf(":CHAN%d:COUP?", i + 1);
947 g_free(devc->coupling[i]);
948 devc->coupling[i] = NULL;
949 res = sr_scpi_get_string(sdi->conn, cmd, &devc->coupling[i]);
950 g_free(cmd);
951 if (res != SR_OK)
952 return SR_ERR;
953 }
954 sr_dbg("Current coupling:");
955 for (i = 0; i < devc->model->analog_channels; i++)
956 sr_dbg("CH%d %s", i + 1, devc->coupling[i]);
957
958 /* Trigger source. */
959 g_free(devc->trigger_source);
960 devc->trigger_source = NULL;
961 if (sr_scpi_get_string(sdi->conn, ":TRIG:EDGE:SOUR?", &devc->trigger_source) != SR_OK)
962 return SR_ERR;
963 sr_dbg("Current trigger source %s", devc->trigger_source);
964
965 /* Horizontal trigger position. */
966 if (sr_scpi_get_float(sdi->conn, devc->model->cmds[CMD_GET_HORIZ_TRIGGERPOS].str,
967 &devc->horiz_triggerpos) != SR_OK)
968 return SR_ERR;
969 sr_dbg("Current horizontal trigger position %g", devc->horiz_triggerpos);
970
971 /* Trigger slope. */
972 g_free(devc->trigger_slope);
973 devc->trigger_slope = NULL;
974 if (sr_scpi_get_string(sdi->conn, ":TRIG:EDGE:SLOP?", &devc->trigger_slope) != SR_OK)
975 return SR_ERR;
976 sr_dbg("Current trigger slope %s", devc->trigger_slope);
977
978 /* Trigger level. */
979 if (sr_scpi_get_float(sdi->conn, ":TRIG:EDGE:LEV?", &devc->trigger_level) != SR_OK)
980 return SR_ERR;
981 sr_dbg("Current trigger level %g", devc->trigger_level);
982
983 return SR_OK;
984}
985
986SR_PRIV int rigol_ds_get_dev_cfg_vertical(const struct sr_dev_inst *sdi)
987{
988 struct dev_context *devc;
989 char *cmd;
990 unsigned int i;
991 int res;
992
993 devc = sdi->priv;
994
995 /* Vertical gain. */
996 for (i = 0; i < devc->model->analog_channels; i++) {
997 cmd = g_strdup_printf(":CHAN%d:SCAL?", i + 1);
998 res = sr_scpi_get_float(sdi->conn, cmd, &devc->vdiv[i]);
999 g_free(cmd);
1000 if (res != SR_OK)
1001 return SR_ERR;
1002 }
1003 sr_dbg("Current vertical gain:");
1004 for (i = 0; i < devc->model->analog_channels; i++)
1005 sr_dbg("CH%d %g", i + 1, devc->vdiv[i]);
1006
1007 /* Vertical offset. */
1008 for (i = 0; i < devc->model->analog_channels; i++) {
1009 cmd = g_strdup_printf(":CHAN%d:OFFS?", i + 1);
1010 res = sr_scpi_get_float(sdi->conn, cmd, &devc->vert_offset[i]);
1011 g_free(cmd);
1012 if (res != SR_OK)
1013 return SR_ERR;
1014 }
1015 sr_dbg("Current vertical offset:");
1016 for (i = 0; i < devc->model->analog_channels; i++)
1017 sr_dbg("CH%d %g", i + 1, devc->vert_offset[i]);
1018
1019 return SR_OK;
1020}