]> sigrok.org Git - libsigrok.git/blame - src/hardware/rigol-ds/protocol.c
Add initial Voltcraft VC-870 support.
[libsigrok.git] / src / hardware / rigol-ds / protocol.c
CommitLineData
f4816ac6
ML
1/*
2 * This file is part of the libsigrok project.
3 *
4 * Copyright (C) 2012 Martin Ling <martin-git@earth.li>
88e429c9 5 * Copyright (C) 2013 Bert Vermeulen <bert@biot.com>
bafd4890 6 * Copyright (C) 2013 Mathias Grimmberger <mgri@zaphod.sax.de>
f4816ac6
ML
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 <stdlib.h>
e0b7d23c
ML
23#include <stdarg.h>
24#include <unistd.h>
25#include <errno.h>
a3df166f 26#include <string.h>
254dd102 27#include <math.h>
bafd4890
ML
28#include <ctype.h>
29#include <time.h>
f4816ac6
ML
30#include <glib.h>
31#include "libsigrok.h"
32#include "libsigrok-internal.h"
33#include "protocol.h"
34
bafd4890
ML
35/*
36 * This is a unified protocol driver for the DS1000 and DS2000 series.
37 *
38 * DS1000 support tested with a Rigol DS1102D.
39 *
40 * DS2000 support tested with a Rigol DS2072 using firmware version 01.01.00.02.
41 *
42 * The Rigol DS2000 series scopes try to adhere to the IEEE 488.2 (I think)
43 * standard. If you want to read it - it costs real money...
44 *
45 * Every response from the scope has a linefeed appended because the
46 * standard says so. In principle this could be ignored because sending the
47 * next command clears the output queue of the scope. This driver tries to
48 * avoid doing that because it may cause an error being generated inside the
49 * scope and who knows what bugs the firmware has WRT this.
50 *
51 * Waveform data is transferred in a format called "arbitrary block program
52 * data" specified in IEEE 488.2. See Agilents programming manuals for their
53 * 2000/3000 series scopes for a nice description.
54 *
55 * Each data block from the scope has a header, e.g. "#900000001400".
56 * The '#' marks the start of a block.
57 * Next is one ASCII decimal digit between 1 and 9, this gives the number of
58 * ASCII decimal digits following.
59 * Last are the ASCII decimal digits giving the number of bytes (not
60 * samples!) in the block.
61 *
62 * After this header as many data bytes as indicated follow.
63 *
64 * Each data block has a trailing linefeed too.
65 */
66
bafd4890
ML
67static int parse_int(const char *str, int *ret)
68{
69 char *e;
70 long tmp;
71
72 errno = 0;
73 tmp = strtol(str, &e, 10);
74 if (e == str || *e != '\0') {
75 sr_dbg("Failed to parse integer: '%s'", str);
76 return SR_ERR;
77 }
78 if (errno) {
79 sr_dbg("Failed to parse integer: '%s', numerical overflow", str);
80 return SR_ERR;
81 }
82 if (tmp > INT_MAX || tmp < INT_MIN) {
83 sr_dbg("Failed to parse integer: '%s', value to large/small", str);
84 return SR_ERR;
85 }
86
87 *ret = (int)tmp;
88 return SR_OK;
89}
90
babab622
ML
91/* Set the next event to wait for in rigol_ds_receive */
92static void rigol_ds_set_wait_event(struct dev_context *devc, enum wait_events event)
93{
94 if (event == WAIT_STOP)
95 devc->wait_status = 2;
96 else
97 devc->wait_status = 1;
98 devc->wait_event = event;
99}
100
bafd4890 101/*
babab622
ML
102 * Waiting for a event will return a timeout after 2 to 3 seconds in order
103 * to not block the application.
bafd4890 104 */
babab622 105static int rigol_ds_event_wait(const struct sr_dev_inst *sdi, char status1, char status2)
bafd4890 106{
334fbc2a 107 char *buf;
bafd4890
ML
108 struct dev_context *devc;
109 time_t start;
110
111 if (!(devc = sdi->priv))
112 return SR_ERR;
113
114 start = time(NULL);
115
116 /*
117 * Trigger status may return:
babab622
ML
118 * "TD" or "T'D" - triggered
119 * "AUTO" - autotriggered
120 * "RUN" - running
121 * "WAIT" - waiting for trigger
122 * "STOP" - stopped
bafd4890
ML
123 */
124
babab622 125 if (devc->wait_status == 1) {
bafd4890
ML
126 do {
127 if (time(NULL) - start >= 3) {
128 sr_dbg("Timeout waiting for trigger");
129 return SR_ERR_TIMEOUT;
130 }
131
334fbc2a 132 if (sr_scpi_get_string(sdi->conn, ":TRIG:STAT?", &buf) != SR_OK)
bafd4890 133 return SR_ERR;
babab622 134 } while (buf[0] == status1 || buf[0] == status2);
bafd4890 135
babab622 136 devc->wait_status = 2;
bafd4890 137 }
babab622 138 if (devc->wait_status == 2) {
bafd4890
ML
139 do {
140 if (time(NULL) - start >= 3) {
141 sr_dbg("Timeout waiting for trigger");
142 return SR_ERR_TIMEOUT;
143 }
144
334fbc2a 145 if (sr_scpi_get_string(sdi->conn, ":TRIG:STAT?", &buf) != SR_OK)
bafd4890 146 return SR_ERR;
babab622 147 } while (buf[0] != status1 && buf[0] != status2);
bafd4890 148
babab622 149 rigol_ds_set_wait_event(devc, WAIT_NONE);
bafd4890
ML
150 }
151
152 return SR_OK;
153}
154
155/*
babab622
ML
156 * For live capture we need to wait for a new trigger event to ensure that
157 * sample data is not returned twice.
bafd4890
ML
158 *
159 * Unfortunately this will never really work because for sufficiently fast
babab622 160 * timebases and trigger rates it just can't catch the status changes.
bafd4890
ML
161 *
162 * What would be needed is a trigger event register with autoreset like the
163 * Agilents have. The Rigols don't seem to have anything like this.
164 *
165 * The workaround is to only wait for the trigger when the timebase is slow
166 * enough. Of course this means that for faster timebases sample data can be
babab622
ML
167 * returned multiple times, this effect is mitigated somewhat by sleeping
168 * for about one sweep time in that case.
bafd4890 169 */
babab622 170static int rigol_ds_trigger_wait(const struct sr_dev_inst *sdi)
bafd4890
ML
171{
172 struct dev_context *devc;
babab622 173 long s;
bafd4890
ML
174
175 if (!(devc = sdi->priv))
176 return SR_ERR;
177
babab622
ML
178 /*
179 * If timebase < 50 msecs/DIV just sleep about one sweep time except
180 * for really fast sweeps.
181 */
c2b394d5 182 if (devc->timebase < 0.0499) {
babab622
ML
183 if (devc->timebase > 0.99e-6) {
184 /*
185 * Timebase * num hor. divs * 85(%) * 1e6(usecs) / 100
186 * -> 85 percent of sweep time
187 */
569d4dbd 188 s = (devc->timebase * devc->model->series->num_horizontal_divs
babab622
ML
189 * 85e6) / 100L;
190 sr_spew("Sleeping for %ld usecs instead of trigger-wait", s);
191 g_usleep(s);
192 }
193 rigol_ds_set_wait_event(devc, WAIT_NONE);
194 return SR_OK;
195 } else {
196 return rigol_ds_event_wait(sdi, 'T', 'A');
197 }
198}
bafd4890 199
babab622
ML
200/* Wait for scope to got to "Stop" in single shot mode */
201static int rigol_ds_stop_wait(const struct sr_dev_inst *sdi)
202{
203 return rigol_ds_event_wait(sdi, 'S', 'S');
204}
205
206/* Check that a single shot acquisition actually succeeded on the DS2000 */
207static int rigol_ds_check_stop(const struct sr_dev_inst *sdi)
208{
209 struct dev_context *devc;
ba7dd8bb 210 struct sr_channel *ch;
babab622
ML
211 int tmp;
212
213 if (!(devc = sdi->priv))
bafd4890 214 return SR_ERR;
babab622 215
ba7dd8bb 216 ch = devc->channel_entry->data;
821fbcad 217
569d4dbd 218 if (devc->model->series->protocol <= PROTOCOL_V2)
e086b750
ML
219 return SR_OK;
220
38354d9d 221 if (rigol_ds_config_set(sdi, ":WAV:SOUR CHAN%d",
ba7dd8bb 222 ch->index + 1) != SR_OK)
babab622
ML
223 return SR_ERR;
224 /* Check that the number of samples will be accepted */
38354d9d 225 if (rigol_ds_config_set(sdi, ":WAV:POIN %d", devc->analog_frame_size) != SR_OK)
babab622 226 return SR_ERR;
334fbc2a 227 if (sr_scpi_get_int(sdi->conn, "*ESR?", &tmp) != SR_OK)
bafd4890 228 return SR_ERR;
babab622
ML
229 /*
230 * If we get an "Execution error" the scope went from "Single" to
231 * "Stop" without actually triggering. There is no waveform
232 * displayed and trying to download one will fail - the scope thinks
233 * it has 1400 samples (like display memory) and the driver thinks
234 * it has a different number of samples.
235 *
236 * In that case just try to capture something again. Might still
237 * fail in interesting ways.
238 *
239 * Ain't firmware fun?
240 */
241 if (tmp & 0x10) {
242 sr_warn("Single shot acquisition failed, retrying...");
243 /* Sleep a bit, otherwise the single shot will often fail */
244 g_usleep(500000);
38354d9d 245 rigol_ds_config_set(sdi, ":SING");
babab622 246 rigol_ds_set_wait_event(devc, WAIT_STOP);
bafd4890 247 return SR_ERR;
babab622 248 }
bafd4890 249
babab622
ML
250 return SR_OK;
251}
bafd4890 252
babab622
ML
253/* Wait for enough data becoming available in scope output buffer */
254static int rigol_ds_block_wait(const struct sr_dev_inst *sdi)
255{
334fbc2a 256 char *buf;
babab622
ML
257 struct dev_context *devc;
258 time_t start;
259 int len;
260
261 if (!(devc = sdi->priv))
262 return SR_ERR;
263
4472867a 264 if (devc->model->series->protocol >= PROTOCOL_V3) {
babab622 265
4472867a
ML
266 start = time(NULL);
267
268 do {
269 if (time(NULL) - start >= 3) {
270 sr_dbg("Timeout waiting for data block");
271 return SR_ERR_TIMEOUT;
272 }
babab622 273
4472867a
ML
274 /*
275 * The scope copies data really slowly from sample
276 * memory to its output buffer, so try not to bother
277 * it too much with SCPI requests but don't wait too
278 * long for short sample frame sizes.
279 */
280 g_usleep(devc->analog_frame_size < 15000 ? 100000 : 1000000);
281
282 /* "READ,nnnn" (still working) or "IDLE,nnnn" (finished) */
283 if (sr_scpi_get_string(sdi->conn, ":WAV:STAT?", &buf) != SR_OK)
284 return SR_ERR;
285
286 if (parse_int(buf + 5, &len) != SR_OK)
287 return SR_ERR;
288 } while (buf[0] == 'R' && len < 1000000);
289 }
babab622
ML
290
291 rigol_ds_set_wait_event(devc, WAIT_NONE);
292
293 return SR_OK;
294}
295
38354d9d
ML
296/* Send a configuration setting. */
297SR_PRIV int rigol_ds_config_set(const struct sr_dev_inst *sdi, const char *format, ...)
298{
299 struct dev_context *devc = sdi->priv;
300 va_list args;
301 int ret;
302
303 va_start(args, format);
304 ret = sr_scpi_send_variadic(sdi->conn, format, args);
305 va_end(args);
306
307 if (ret != SR_OK)
308 return SR_ERR;
309
569d4dbd 310 if (devc->model->series->protocol == PROTOCOL_V2) {
38354d9d
ML
311 /* The DS1000 series needs this stupid delay, *OPC? doesn't work. */
312 sr_spew("delay %dms", 100);
313 g_usleep(100000);
314 return SR_OK;
315 } else {
316 return sr_scpi_get_opc(sdi->conn);
317 }
318}
319
babab622
ML
320/* Start capturing a new frameset */
321SR_PRIV int rigol_ds_capture_start(const struct sr_dev_inst *sdi)
322{
323 struct dev_context *devc;
e086b750 324 gchar *trig_mode;
babab622
ML
325
326 if (!(devc = sdi->priv))
327 return SR_ERR;
328
329 sr_dbg("Starting data capture for frameset %lu of %lu",
330 devc->num_frames + 1, devc->limit_frames);
331
569d4dbd
ML
332 switch (devc->model->series->protocol) {
333 case PROTOCOL_V1:
334 rigol_ds_set_wait_event(devc, WAIT_TRIGGER);
335 break;
336 case PROTOCOL_V2:
337 if (devc->data_source == DATA_SOURCE_LIVE) {
338 if (rigol_ds_config_set(sdi, ":WAV:POIN:MODE NORMAL") != SR_OK)
e086b750 339 return SR_ERR;
569d4dbd 340 rigol_ds_set_wait_event(devc, WAIT_TRIGGER);
e086b750 341 } else {
e086b750
ML
342 if (rigol_ds_config_set(sdi, ":STOP") != SR_OK)
343 return SR_ERR;
344 if (rigol_ds_config_set(sdi, ":WAV:POIN:MODE RAW") != SR_OK)
345 return SR_ERR;
346 if (sr_scpi_get_string(sdi->conn, ":TRIG:MODE?", &trig_mode) != SR_OK)
347 return SR_ERR;
348 if (rigol_ds_config_set(sdi, ":TRIG:%s:SWE SING", trig_mode) != SR_OK)
349 return SR_ERR;
350 if (rigol_ds_config_set(sdi, ":RUN") != SR_OK)
351 return SR_ERR;
569d4dbd
ML
352 rigol_ds_set_wait_event(devc, WAIT_STOP);
353 }
354 break;
355 case PROTOCOL_V3:
356 if (rigol_ds_config_set(sdi, ":WAV:FORM BYTE") != SR_OK)
357 return SR_ERR;
358 if (devc->data_source == DATA_SOURCE_LIVE) {
359 if (rigol_ds_config_set(sdi, ":WAV:MODE NORM") != SR_OK)
360 return SR_ERR;
361 rigol_ds_set_wait_event(devc, WAIT_TRIGGER);
e086b750
ML
362 } else {
363 if (rigol_ds_config_set(sdi, ":WAV:MODE RAW") != SR_OK)
364 return SR_ERR;
365 if (rigol_ds_config_set(sdi, ":SING") != SR_OK)
366 return SR_ERR;
569d4dbd 367 rigol_ds_set_wait_event(devc, WAIT_STOP);
e086b750 368 }
569d4dbd 369 break;
bafd4890
ML
370 }
371
372 return SR_OK;
373}
374
babab622
ML
375/* Start reading data from the current channel */
376SR_PRIV int rigol_ds_channel_start(const struct sr_dev_inst *sdi)
377{
378 struct dev_context *devc;
ba7dd8bb 379 struct sr_channel *ch;
babab622
ML
380
381 if (!(devc = sdi->priv))
382 return SR_ERR;
383
ba7dd8bb 384 ch = devc->channel_entry->data;
821fbcad 385
ba7dd8bb 386 sr_dbg("Starting reading data from channel %d", ch->index + 1);
babab622 387
569d4dbd 388 if (devc->model->series->protocol <= PROTOCOL_V2) {
3f239f08 389 if (ch->type == SR_CHANNEL_LOGIC) {
677f85d0
ML
390 if (sr_scpi_send(sdi->conn, ":WAV:DATA? DIG") != SR_OK)
391 return SR_ERR;
392 } else {
821fbcad 393 if (sr_scpi_send(sdi->conn, ":WAV:DATA? CHAN%d",
ba7dd8bb 394 ch->index + 1) != SR_OK)
677f85d0
ML
395 return SR_ERR;
396 }
e086b750 397 rigol_ds_set_wait_event(devc, WAIT_NONE);
677f85d0 398 } else {
38354d9d 399 if (rigol_ds_config_set(sdi, ":WAV:SOUR CHAN%d",
ba7dd8bb 400 ch->index + 1) != SR_OK)
babab622 401 return SR_ERR;
677f85d0 402 if (devc->data_source != DATA_SOURCE_LIVE) {
38354d9d 403 if (rigol_ds_config_set(sdi, ":WAV:RES") != SR_OK)
677f85d0 404 return SR_ERR;
38354d9d 405 if (rigol_ds_config_set(sdi, ":WAV:BEG") != SR_OK)
677f85d0 406 return SR_ERR;
aff00e40 407 }
677f85d0 408 }
babab622 409
aff00e40
ML
410 rigol_ds_set_wait_event(devc, WAIT_BLOCK);
411
f76c24f6 412 devc->num_channel_bytes = 0;
aff00e40 413 devc->num_header_bytes = 0;
babab622
ML
414 devc->num_block_bytes = 0;
415
416 return SR_OK;
417}
418
419/* Read the header of a data block */
aff00e40 420static int rigol_ds_read_header(struct sr_dev_inst *sdi)
bafd4890 421{
aff00e40
ML
422 struct sr_scpi_dev_inst *scpi = sdi->conn;
423 struct dev_context *devc = sdi->priv;
424 char *buf = (char *) devc->buffer;
fe0d9caa
ML
425 size_t header_length;
426 int ret;
aff00e40
ML
427
428 /* Try to read the hashsign and length digit. */
429 if (devc->num_header_bytes < 2) {
fe0d9caa 430 ret = sr_scpi_read_data(scpi, buf + devc->num_header_bytes,
aff00e40 431 2 - devc->num_header_bytes);
fe0d9caa 432 if (ret < 0) {
aff00e40
ML
433 sr_err("Read error while reading data header.");
434 return SR_ERR;
435 }
fe0d9caa 436 devc->num_header_bytes += ret;
bafd4890 437 }
aff00e40
ML
438
439 if (devc->num_header_bytes < 2)
440 return 0;
441
442 if (buf[0] != '#' || !isdigit(buf[1]) || buf[1] == '0') {
443 sr_err("Received invalid data block header '%c%c'.", buf[0], buf[1]);
444 return SR_ERR;
bafd4890 445 }
bafd4890 446
fe0d9caa 447 header_length = 2 + buf[1] - '0';
aff00e40
ML
448
449 /* Try to read the length. */
fe0d9caa
ML
450 if (devc->num_header_bytes < header_length) {
451 ret = sr_scpi_read_data(scpi, buf + devc->num_header_bytes,
452 header_length - devc->num_header_bytes);
453 if (ret < 0) {
aff00e40
ML
454 sr_err("Read error while reading data header.");
455 return SR_ERR;
456 }
fe0d9caa 457 devc->num_header_bytes += ret;
bafd4890 458 }
aff00e40 459
fe0d9caa 460 if (devc->num_header_bytes < header_length)
aff00e40
ML
461 return 0;
462
463 /* Read the data length. */
fe0d9caa 464 buf[header_length] = '\0';
aff00e40 465
fe0d9caa 466 if (parse_int(buf + 2, &ret) != SR_OK) {
aff00e40 467 sr_err("Received invalid data block length '%s'.", buf + 2);
bafd4890
ML
468 return -1;
469 }
470
fe0d9caa 471 sr_dbg("Received data block header: '%s' -> block length %d", buf, ret);
bafd4890 472
fe0d9caa 473 return ret;
bafd4890
ML
474}
475
3086efdd 476SR_PRIV int rigol_ds_receive(int fd, int revents, void *cb_data)
f4816ac6 477{
e0b7d23c 478 struct sr_dev_inst *sdi;
ae1bc1cc 479 struct sr_scpi_dev_inst *scpi;
f4816ac6 480 struct dev_context *devc;
e0b7d23c
ML
481 struct sr_datafeed_packet packet;
482 struct sr_datafeed_analog analog;
6bb192bc 483 struct sr_datafeed_logic logic;
254dd102 484 double vdiv, offset;
f80a0bf2 485 int len, i, vref;
ba7dd8bb 486 struct sr_channel *ch;
bac11aeb 487 gsize expected_data_bytes;
f4816ac6 488
decfe89d 489 (void)fd;
9bd4c956 490
f4816ac6
ML
491 if (!(sdi = cb_data))
492 return TRUE;
493
494 if (!(devc = sdi->priv))
495 return TRUE;
496
ae1bc1cc 497 scpi = sdi->conn;
9bd4c956 498
d5876cfb 499 if (revents == G_IO_IN || revents == 0) {
e086b750
ML
500 switch(devc->wait_event) {
501 case WAIT_NONE:
502 break;
503 case WAIT_TRIGGER:
504 if (rigol_ds_trigger_wait(sdi) != SR_OK)
bafd4890 505 return TRUE;
e086b750
ML
506 if (rigol_ds_channel_start(sdi) != SR_OK)
507 return TRUE;
3918fbb0 508 return TRUE;
e086b750
ML
509 case WAIT_BLOCK:
510 if (rigol_ds_block_wait(sdi) != SR_OK)
511 return TRUE;
512 break;
513 case WAIT_STOP:
514 if (rigol_ds_stop_wait(sdi) != SR_OK)
515 return TRUE;
516 if (rigol_ds_check_stop(sdi) != SR_OK)
517 return TRUE;
518 if (rigol_ds_channel_start(sdi) != SR_OK)
519 return TRUE;
520 return TRUE;
521 default:
522 sr_err("BUG: Unknown event target encountered");
f44f7e61 523 break;
f80a0bf2
ML
524 }
525
ba7dd8bb 526 ch = devc->channel_entry->data;
bac11aeb 527
3f239f08 528 expected_data_bytes = ch->type == SR_CHANNEL_ANALOG ?
bac11aeb 529 devc->analog_frame_size : devc->digital_frame_size;
f76c24f6 530
e086b750 531 if (devc->num_block_bytes == 0) {
569d4dbd 532 if (devc->model->series->protocol >= PROTOCOL_V3)
a53278de
AJ
533 if (sr_scpi_send(sdi->conn, ":WAV:DATA?") != SR_OK)
534 return TRUE;
bac11aeb 535
05c644ea
ML
536 if (sr_scpi_read_begin(scpi) != SR_OK)
537 return TRUE;
bac11aeb 538
569d4dbd 539 if (devc->format == FORMAT_IEEE488_2) {
babab622 540 sr_dbg("New block header expected");
aff00e40
ML
541 len = rigol_ds_read_header(sdi);
542 if (len == 0)
543 /* Still reading the header. */
544 return TRUE;
545 if (len == -1) {
546 sr_err("Read error, aborting capture.");
547 packet.type = SR_DF_FRAME_END;
548 sr_session_send(cb_data, &packet);
549 sdi->driver->dev_acquisition_stop(sdi, cb_data);
babab622 550 return TRUE;
aff00e40 551 }
babab622
ML
552 /* At slow timebases in live capture the DS2072
553 * sometimes returns "short" data blocks, with
554 * apparently no way to get the rest of the data.
555 * Discard these, the complete data block will
556 * appear eventually.
557 */
558 if (devc->data_source == DATA_SOURCE_LIVE
bac11aeb 559 && (unsigned)len < expected_data_bytes) {
babab622 560 sr_dbg("Discarding short data block");
05c644ea 561 sr_scpi_read_data(scpi, (char *)devc->buffer, len + 1);
babab622
ML
562 return TRUE;
563 }
564 devc->num_block_bytes = len;
f80a0bf2 565 } else {
bac11aeb 566 devc->num_block_bytes = expected_data_bytes;
f80a0bf2
ML
567 }
568 devc->num_block_read = 0;
bafd4890 569 }
f80a0bf2
ML
570
571 len = devc->num_block_bytes - devc->num_block_read;
ae3a1913
ML
572 if (len > ACQ_BUFFER_SIZE)
573 len = ACQ_BUFFER_SIZE;
574 sr_dbg("Requesting read of %d bytes", len);
575
576 len = sr_scpi_read_data(scpi, (char *)devc->buffer, len);
f80a0bf2 577
7d63347e
ML
578 if (len == -1) {
579 sr_err("Read error, aborting capture.");
580 packet.type = SR_DF_FRAME_END;
581 sr_session_send(cb_data, &packet);
582 sdi->driver->dev_acquisition_stop(sdi, cb_data);
583 return TRUE;
584 }
ae3a1913
ML
585
586 sr_dbg("Received %d bytes.", len);
75d8a4e5 587
48460c6f
ML
588 devc->num_block_read += len;
589
3f239f08 590 if (ch->type == SR_CHANNEL_ANALOG) {
ba7dd8bb
UH
591 vref = devc->vert_reference[ch->index];
592 vdiv = devc->vdiv[ch->index] / 25.6;
593 offset = devc->vert_offset[ch->index];
569d4dbd 594 if (devc->model->series->protocol >= PROTOCOL_V3)
bafd4890 595 for (i = 0; i < len; i++)
babab622 596 devc->data[i] = ((int)devc->buffer[i] - vref) * vdiv - offset;
bafd4890
ML
597 else
598 for (i = 0; i < len; i++)
babab622 599 devc->data[i] = (128 - devc->buffer[i]) * vdiv - offset;
ba7dd8bb 600 analog.channels = g_slist_append(NULL, ch);
6bb192bc 601 analog.num_samples = len;
babab622 602 analog.data = devc->data;
6bb192bc
ML
603 analog.mq = SR_MQ_VOLTAGE;
604 analog.unit = SR_UNIT_VOLT;
605 analog.mqflags = 0;
606 packet.type = SR_DF_ANALOG;
607 packet.payload = &analog;
608 sr_session_send(cb_data, &packet);
ba7dd8bb 609 g_slist_free(analog.channels);
6bb192bc 610 } else {
470140fc 611 logic.length = len;
6bb192bc 612 logic.unitsize = 2;
470140fc 613 logic.data = devc->buffer;
6bb192bc
ML
614 packet.type = SR_DF_LOGIC;
615 packet.payload = &logic;
616 sr_session_send(cb_data, &packet);
48460c6f 617 }
6bb192bc 618
48460c6f
ML
619 if (devc->num_block_read == devc->num_block_bytes) {
620 sr_dbg("Block has been completed");
2b399703 621 if (devc->model->series->protocol >= PROTOCOL_V3) {
470140fc 622 /* Discard the terminating linefeed */
05c644ea 623 sr_scpi_read_data(scpi, (char *)devc->buffer, 1);
2b399703
ML
624 }
625 if (devc->format == FORMAT_IEEE488_2) {
470140fc 626 /* Prepare for possible next block */
aff00e40 627 devc->num_header_bytes = 0;
48460c6f
ML
628 devc->num_block_bytes = 0;
629 if (devc->data_source != DATA_SOURCE_LIVE)
630 rigol_ds_set_wait_event(devc, WAIT_BLOCK);
631 }
3ed7a40c
ML
632 if (!sr_scpi_read_complete(scpi)) {
633 sr_err("Read should have been completed");
7d63347e
ML
634 packet.type = SR_DF_FRAME_END;
635 sr_session_send(cb_data, &packet);
3ed7a40c
ML
636 sdi->driver->dev_acquisition_stop(sdi, cb_data);
637 return TRUE;
638 }
48460c6f
ML
639 devc->num_block_read = 0;
640 } else {
641 sr_dbg("%d of %d block bytes read", devc->num_block_read, devc->num_block_bytes);
ee7e9bee 642 }
75d8a4e5 643
f76c24f6 644 devc->num_channel_bytes += len;
48460c6f 645
f76c24f6
ML
646 if (devc->num_channel_bytes < expected_data_bytes)
647 /* Don't have the full data for this channel yet, re-run. */
48460c6f
ML
648 return TRUE;
649
f76c24f6 650 /* End of data for this channel. */
569d4dbd 651 if (devc->model->series->protocol >= PROTOCOL_V3) {
babab622
ML
652 /* Signal end of data download to scope */
653 if (devc->data_source != DATA_SOURCE_LIVE)
654 /*
655 * This causes a query error, without it switching
656 * to the next channel causes an error. Fun with
657 * firmware...
658 */
38354d9d 659 rigol_ds_config_set(sdi, ":WAV:END");
babab622 660 }
254dd102 661
3f239f08 662 if (ch->type == SR_CHANNEL_ANALOG
821fbcad
ML
663 && devc->channel_entry->next != NULL) {
664 /* We got the frame for this analog channel, but
665 * there's another analog channel. */
666 devc->channel_entry = devc->channel_entry->next;
677f85d0 667 rigol_ds_channel_start(sdi);
254dd102 668 } else {
821fbcad 669 /* Done with all analog channels in this frame. */
ba7dd8bb
UH
670 if (devc->enabled_digital_channels
671 && devc->channel_entry != devc->enabled_digital_channels) {
6bb192bc 672 /* Now we need to get the digital data. */
ba7dd8bb 673 devc->channel_entry = devc->enabled_digital_channels;
677f85d0 674 rigol_ds_channel_start(sdi);
254dd102 675 } else {
f76c24f6
ML
676 /* Done with this frame. */
677 packet.type = SR_DF_FRAME_END;
678 sr_session_send(cb_data, &packet);
679
680 if (++devc->num_frames == devc->limit_frames) {
681 /* Last frame, stop capture. */
682 sdi->driver->dev_acquisition_stop(sdi, cb_data);
683 } else {
684 /* Get the next frame, starting with the first analog channel. */
ba7dd8bb
UH
685 if (devc->enabled_analog_channels)
686 devc->channel_entry = devc->enabled_analog_channels;
f76c24f6 687 else
ba7dd8bb 688 devc->channel_entry = devc->enabled_digital_channels;
f76c24f6 689
e086b750 690 rigol_ds_capture_start(sdi);
f76c24f6
ML
691
692 /* Start of next frame. */
693 packet.type = SR_DF_FRAME_BEGIN;
694 sr_session_send(cb_data, &packet);
695 }
254dd102 696 }
75d8a4e5 697 }
f4816ac6
ML
698 }
699
700 return TRUE;
701}
e0b7d23c 702
3086efdd 703SR_PRIV int rigol_ds_get_dev_cfg(const struct sr_dev_inst *sdi)
254dd102
BV
704{
705 struct dev_context *devc;
98bfc474 706 char *cmd;
821fbcad
ML
707 unsigned int i;
708 int res;
254dd102
BV
709
710 devc = sdi->priv;
711
6bb192bc 712 /* Analog channel state. */
821fbcad
ML
713 for (i = 0; i < devc->model->analog_channels; i++) {
714 cmd = g_strdup_printf(":CHAN%d:DISP?", i + 1);
98bfc474 715 res = sr_scpi_get_bool(sdi->conn, cmd, &devc->analog_channels[i]);
821fbcad
ML
716 g_free(cmd);
717 if (res != SR_OK)
718 return SR_ERR;
821fbcad
ML
719 }
720 sr_dbg("Current analog channel state:");
721 for (i = 0; i < devc->model->analog_channels; i++)
722 sr_dbg("CH%d %s", i + 1, devc->analog_channels[i] ? "on" : "off");
6bb192bc
ML
723
724 /* Digital channel state. */
bafd4890 725 if (devc->model->has_digital) {
98bfc474
ML
726 if (sr_scpi_get_bool(sdi->conn, ":LA:DISP?",
727 &devc->la_enabled) != SR_OK)
04e8e01e 728 return SR_ERR;
04e8e01e
ML
729 sr_dbg("Logic analyzer %s, current digital channel state:",
730 devc->la_enabled ? "enabled" : "disabled");
effb9dd1 731 for (i = 0; i < ARRAY_SIZE(devc->digital_channels); i++) {
bfaf112b 732 cmd = g_strdup_printf(":DIG%d:TURN?", i);
98bfc474 733 res = sr_scpi_get_bool(sdi->conn, cmd, &devc->digital_channels[i]);
6bb192bc
ML
734 g_free(cmd);
735 if (res != SR_OK)
736 return SR_ERR;
bfaf112b 737 sr_dbg("D%d: %s", i, devc->digital_channels[i] ? "on" : "off");
6bb192bc
ML
738 }
739 }
254dd102
BV
740
741 /* Timebase. */
334fbc2a 742 if (sr_scpi_get_float(sdi->conn, ":TIM:SCAL?", &devc->timebase) != SR_OK)
254dd102 743 return SR_ERR;
bafd4890 744 sr_dbg("Current timebase %g", devc->timebase);
254dd102
BV
745
746 /* Vertical gain. */
821fbcad
ML
747 for (i = 0; i < devc->model->analog_channels; i++) {
748 cmd = g_strdup_printf(":CHAN%d:SCAL?", i + 1);
334fbc2a 749 res = sr_scpi_get_float(sdi->conn, cmd, &devc->vdiv[i]);
821fbcad
ML
750 g_free(cmd);
751 if (res != SR_OK)
752 return SR_ERR;
753 }
754 sr_dbg("Current vertical gain:");
755 for (i = 0; i < devc->model->analog_channels; i++)
756 sr_dbg("CH%d %g", i + 1, devc->vdiv[i]);
bafd4890 757
821fbcad 758 sr_dbg("Current vertical reference:");
569d4dbd 759 if (devc->model->series->protocol >= PROTOCOL_V3) {
bafd4890 760 /* Vertical reference - not certain if this is the place to read it. */
821fbcad 761 for (i = 0; i < devc->model->analog_channels; i++) {
38354d9d 762 if (rigol_ds_config_set(sdi, ":WAV:SOUR CHAN%d", i + 1) != SR_OK)
821fbcad 763 return SR_ERR;
334fbc2a 764 if (sr_scpi_get_int(sdi->conn, ":WAV:YREF?", &devc->vert_reference[i]) != SR_OK)
821fbcad
ML
765 return SR_ERR;
766 sr_dbg("CH%d %d", i + 1, devc->vert_reference[i]);
767 }
bafd4890 768 }
254dd102
BV
769
770 /* Vertical offset. */
821fbcad
ML
771 for (i = 0; i < devc->model->analog_channels; i++) {
772 cmd = g_strdup_printf(":CHAN%d:OFFS?", i + 1);
334fbc2a 773 res = sr_scpi_get_float(sdi->conn, cmd, &devc->vert_offset[i]);
821fbcad
ML
774 g_free(cmd);
775 if (res != SR_OK)
776 return SR_ERR;
777 }
778 sr_dbg("Current vertical offset:");
779 for (i = 0; i < devc->model->analog_channels; i++)
780 sr_dbg("CH%d %g", i + 1, devc->vert_offset[i]);
254dd102
BV
781
782 /* Coupling. */
821fbcad
ML
783 for (i = 0; i < devc->model->analog_channels; i++) {
784 cmd = g_strdup_printf(":CHAN%d:COUP?", i + 1);
334fbc2a 785 res = sr_scpi_get_string(sdi->conn, cmd, &devc->coupling[i]);
821fbcad
ML
786 g_free(cmd);
787 if (res != SR_OK)
788 return SR_ERR;
789 }
790 sr_dbg("Current coupling:");
791 for (i = 0; i < devc->model->analog_channels; i++)
792 sr_dbg("CH%d %s", i + 1, devc->coupling[i]);
254dd102
BV
793
794 /* Trigger source. */
334fbc2a 795 if (sr_scpi_get_string(sdi->conn, ":TRIG:EDGE:SOUR?", &devc->trigger_source) != SR_OK)
254dd102
BV
796 return SR_ERR;
797 sr_dbg("Current trigger source %s", devc->trigger_source);
798
799 /* Horizontal trigger position. */
334fbc2a 800 if (sr_scpi_get_float(sdi->conn, ":TIM:OFFS?", &devc->horiz_triggerpos) != SR_OK)
254dd102 801 return SR_ERR;
bafd4890 802 sr_dbg("Current horizontal trigger position %g", devc->horiz_triggerpos);
254dd102
BV
803
804 /* Trigger slope. */
334fbc2a 805 if (sr_scpi_get_string(sdi->conn, ":TRIG:EDGE:SLOP?", &devc->trigger_slope) != SR_OK)
254dd102
BV
806 return SR_ERR;
807 sr_dbg("Current trigger slope %s", devc->trigger_slope);
808
809 return SR_OK;
810}