]> sigrok.org Git - libsigrok.git/blob - src/hardware/hantek-dso/dso.c
79c160088dfa06d930669f4677be4f55f8f3b2d0
[libsigrok.git] / src / hardware / hantek-dso / dso.c
1 /*
2  * This file is part of the libsigrok project.
3  *
4  * Copyright (C) 2012 Bert Vermeulen <bert@biot.com>
5  * With protocol information from the hantekdso project,
6  * Copyright (C) 2008 Oleg Khudyakov <prcoder@gmail.com>
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 <string.h>
24 #include <glib.h>
25 #include <libusb.h>
26 #include <libsigrok/libsigrok.h>
27 #include "libsigrok-internal.h"
28 #include "dso.h"
29
30 #define NUM_CHANNELS 2
31
32 extern struct sr_dev_driver hantek_dso_driver_info;
33
34 static int send_begin(const struct sr_dev_inst *sdi)
35 {
36         struct sr_usb_dev_inst *usb;
37         int ret;
38         unsigned char buffer[] = {0x0f, 0x03, 0x03, 0x03, 0x68, 0xac, 0xfe,
39         0x00, 0x01, 0x00};
40
41         sr_dbg("Sending CTRL_BEGINCOMMAND.");
42
43         usb = sdi->conn;
44         if ((ret = libusb_control_transfer(usb->devhdl,
45                         LIBUSB_REQUEST_TYPE_VENDOR, CTRL_BEGINCOMMAND,
46                         0, 0, buffer, sizeof(buffer), 200)) != sizeof(buffer)) {
47                 sr_err("Failed to send begincommand: %s.",
48                        libusb_error_name(ret));
49                 return SR_ERR;
50         }
51
52         return SR_OK;
53 }
54
55 static int send_bulkcmd(const struct sr_dev_inst *sdi, uint8_t *cmdstring, int cmdlen)
56 {
57         struct sr_usb_dev_inst *usb;
58         int ret, tmp;
59
60         usb = sdi->conn;
61
62         if (send_begin(sdi) != SR_OK)
63                 return SR_ERR;
64
65         if ((ret = libusb_bulk_transfer(usb->devhdl, DSO_EP_OUT, cmdstring,
66                         cmdlen, &tmp, 200)) != 0)
67                 return SR_ERR;
68
69         return SR_OK;
70 }
71
72 static int dso_getmps(libusb_device *dev)
73 {
74         struct libusb_device_descriptor des;
75         struct libusb_config_descriptor *conf_dsc;
76         const struct libusb_interface_descriptor *intf_dsc;
77         int mps;
78
79         if (libusb_get_device_descriptor(dev, &des) != 0)
80                 return 0;
81
82         if (des.bNumConfigurations != 1)
83                 return 0;
84
85         if (libusb_get_config_descriptor(dev, 0, &conf_dsc) != 0)
86                 return 0;
87
88         mps = 0;
89         intf_dsc = &(conf_dsc->interface[0].altsetting[0]);
90         if (intf_dsc->bNumEndpoints != 2)
91                 goto err;
92
93         if ((intf_dsc->endpoint[0].bEndpointAddress & 0x8f) !=
94             (2 | LIBUSB_ENDPOINT_OUT))
95                 /* The first endpoint should be 2 (outbound). */
96                 goto err;
97
98         if ((intf_dsc->endpoint[1].bEndpointAddress & 0x8f) !=
99             (6 | LIBUSB_ENDPOINT_IN))
100                 /* The second endpoint should be 6 (inbound). */
101                 goto err;
102
103         mps = intf_dsc->endpoint[1].wMaxPacketSize;
104
105 err:
106         if (conf_dsc)
107                 libusb_free_config_descriptor(conf_dsc);
108
109         return mps;
110 }
111
112 SR_PRIV int dso_open(struct sr_dev_inst *sdi)
113 {
114         struct dev_context *devc;
115         struct drv_context *drvc = hantek_dso_driver_info.context;
116         struct sr_usb_dev_inst *usb;
117         struct libusb_device_descriptor des;
118         libusb_device **devlist;
119         int err, i;
120         char connection_id[64];
121
122         devc = sdi->priv;
123         usb = sdi->conn;
124
125         if (sdi->status == SR_ST_ACTIVE)
126                 /* already in use */
127                 return SR_ERR;
128
129         libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist);
130         for (i = 0; devlist[i]; i++) {
131                 if ((err = libusb_get_device_descriptor(devlist[i], &des))) {
132                         sr_err("Failed to get device descriptor: %s.",
133                                libusb_error_name(err));
134                         continue;
135                 }
136
137                 if (des.idVendor != devc->profile->fw_vid
138                     || des.idProduct != devc->profile->fw_pid)
139                         continue;
140
141                 if ((sdi->status == SR_ST_INITIALIZING) ||
142                                 (sdi->status == SR_ST_INACTIVE)) {
143                         /*
144                          * Check device by its physical USB bus/port address.
145                          */
146                         usb_get_port_path(devlist[i], connection_id, sizeof(connection_id));
147                         if (strcmp(sdi->connection_id, connection_id))
148                                 /* This is not the one. */
149                                 continue;
150                 }
151
152                 if (!(err = libusb_open(devlist[i], &usb->devhdl))) {
153                         if (usb->address == 0xff)
154                                 /*
155                                  * first time we touch this device after firmware upload,
156                                  * so we don't know the address yet.
157                                  */
158                                 usb->address = libusb_get_device_address(devlist[i]);
159
160                         if (!(devc->epin_maxpacketsize = dso_getmps(devlist[i])))
161                                 sr_err("Wrong endpoint profile.");
162                         else {
163                                 sdi->status = SR_ST_ACTIVE;
164                                 sr_info("Opened device on %d.%d (logical) / "
165                                                 "%s (physical) interface %d.",
166                                         usb->bus, usb->address,
167                                         sdi->connection_id, USB_INTERFACE);
168                         }
169                 } else {
170                         sr_err("Failed to open device: %s.",
171                                libusb_error_name(err));
172                 }
173
174                 /* If we made it here, we handled the device (somehow). */
175                 break;
176         }
177         libusb_free_device_list(devlist, 1);
178
179         if (sdi->status != SR_ST_ACTIVE)
180                 return SR_ERR;
181
182         return SR_OK;
183 }
184
185 SR_PRIV void dso_close(struct sr_dev_inst *sdi)
186 {
187         struct sr_usb_dev_inst *usb;
188
189         usb = sdi->conn;
190
191         if (!usb->devhdl)
192                 return;
193
194         sr_info("Closing device on %d.%d (logical) / %s (physical) interface %d.",
195                         usb->bus, usb->address, sdi->connection_id, USB_INTERFACE);
196         libusb_release_interface(usb->devhdl, USB_INTERFACE);
197         libusb_close(usb->devhdl);
198         usb->devhdl = NULL;
199         sdi->status = SR_ST_INACTIVE;
200
201 }
202
203 static int get_channel_offsets(const struct sr_dev_inst *sdi)
204 {
205         struct dev_context *devc;
206         struct sr_usb_dev_inst *usb;
207         GString *gs;
208         int chan, v, ret;
209
210         sr_dbg("Getting channel offsets.");
211
212         devc = sdi->priv;
213         usb = sdi->conn;
214
215         ret = libusb_control_transfer(usb->devhdl,
216                         LIBUSB_ENDPOINT_IN | LIBUSB_REQUEST_TYPE_VENDOR,
217                         CTRL_READ_EEPROM, EEPROM_CHANNEL_OFFSETS, 0,
218                         (unsigned char *)&devc->channel_levels,
219                         sizeof(devc->channel_levels), 200);
220         if (ret != sizeof(devc->channel_levels)) {
221                 sr_err("Failed to get channel offsets: %s.",
222                        libusb_error_name(ret));
223                 return SR_ERR;
224         }
225
226         /* Comes in as 16-bit numbers with the second byte always 0 on
227          * the DSO-2090. Guessing this is supposed to be big-endian,
228          * since that's how voltage offsets are submitted back to the DSO.
229          * Convert to host order now, so we can use them natively.
230          */
231         for (chan = 0; chan < NUM_CHANNELS; chan++) {
232                 for (v = 0; v < 9; v++) {
233                         devc->channel_levels[chan][v][0] =
234                                 g_ntohs(devc->channel_levels[chan][v][0]);
235                         devc->channel_levels[chan][v][1] =
236                                 g_ntohs(devc->channel_levels[chan][v][1]);
237                 }
238         }
239
240         if (sr_log_loglevel_get() >= SR_LOG_DBG) {
241                 gs = g_string_sized_new(128);
242                 for (chan = 0; chan < NUM_CHANNELS; chan++) {
243                         g_string_printf(gs, "CH%d:", chan + 1);
244                         for (v = 0; v < 9; v++) {
245                                 g_string_append_printf(gs, " %.4x-%.4x",
246                                         devc->channel_levels[chan][v][0],
247                                         devc->channel_levels[chan][v][1]);
248                         }
249                         sr_dbg("%s", gs->str);
250                 }
251                 g_string_free(gs, TRUE);
252         }
253
254         return SR_OK;
255 }
256
257 static int dso_set_trigger_samplerate(const struct sr_dev_inst *sdi)
258 {
259         struct dev_context *devc;
260         struct sr_usb_dev_inst *usb;
261         int ret, tmp;
262         uint8_t cmdstring[12];
263         uint16_t timebase_small[] = { 0xffff, 0xfffc, 0xfff7, 0xffe8, 0xffce,
264                 0xff9c, 0xff07, 0xfe0d, 0xfc19, 0xf63d, 0xec79, 0xd8f1 };
265         uint16_t timebase_large[] = { 0xffff, 0x0000, 0xfffc, 0xfff7, 0xffe8,
266                 0xffce, 0xff9d, 0xff07, 0xfe0d, 0xfc19, 0xf63d, 0xec79 };
267
268         sr_dbg("Preparing CMD_SET_TRIGGER_SAMPLERATE.");
269
270         devc = sdi->priv;
271         usb = sdi->conn;
272
273         memset(cmdstring, 0, sizeof(cmdstring));
274         /* Command */
275         cmdstring[0] = CMD_SET_TRIGGER_SAMPLERATE;
276
277         /* Trigger source */
278         sr_dbg("Trigger source %s.", devc->triggersource);
279         if (!strcmp("CH2", devc->triggersource))
280                 tmp = 0;
281         else if (!strcmp("CH1", devc->triggersource))
282                 tmp = 1;
283         else if (!strcmp("EXT", devc->triggersource))
284                 tmp = 2;
285         else {
286                 sr_err("Invalid trigger source: '%s'.", devc->triggersource);
287                 return SR_ERR_ARG;
288         }
289         cmdstring[2] = tmp;
290
291         /* Frame size */
292         sr_dbg("Frame size: %d.", devc->framesize);
293         cmdstring[2] |= (devc->framesize == FRAMESIZE_SMALL ? 0x01 : 0x02) << 2;
294
295         /* Timebase fast */
296         sr_dbg("Time base index: %d.", devc->timebase);
297         if (devc->framesize == FRAMESIZE_SMALL) {
298                 if (devc->timebase < TIME_20us)
299                         tmp = 0;
300                 else if (devc->timebase == TIME_20us)
301                         tmp = 1;
302                 else if (devc->timebase == TIME_40us)
303                         tmp = 2;
304                 else if (devc->timebase == TIME_100us)
305                         tmp = 3;
306                 else if (devc->timebase >= TIME_200us)
307                         tmp = 4;
308         } else {
309                 if (devc->timebase < TIME_40us) {
310                         sr_err("Timebase < 40us only supported with 10K buffer.");
311                         return SR_ERR_ARG;
312                 }
313                 else if (devc->timebase == TIME_40us)
314                         tmp = 0;
315                 else if (devc->timebase == TIME_100us)
316                         tmp = 2;
317                 else if (devc->timebase == TIME_200us)
318                         tmp = 3;
319                 else if (devc->timebase >= TIME_400us)
320                         tmp = 4;
321         }
322         cmdstring[2] |= (tmp & 0x07) << 5;
323
324         /* Enabled channels: 00=CH1 01=CH2 10=both */
325         sr_dbg("Channels CH1=%d CH2=%d", devc->ch1_enabled, devc->ch2_enabled);
326         tmp = (((devc->ch2_enabled ? 1 : 0) << 1) + (devc->ch1_enabled ? 1 : 0)) - 1;
327         cmdstring[3] = tmp;
328
329         /* Fast rates channel */
330         /* TODO: Is this right? */
331         tmp = devc->timebase < TIME_10us ? 1 : 0;
332         cmdstring[3] |= tmp << 2;
333
334         /* Trigger slope: 0=positive 1=negative */
335         /* TODO: Does this work? */
336         sr_dbg("Trigger slope: %d.", devc->triggerslope);
337         cmdstring[3] |= (devc->triggerslope == SLOPE_NEGATIVE ? 1 : 0) << 3;
338
339         /* Timebase slow */
340         if (devc->timebase < TIME_100us)
341                 tmp = 0;
342         else if (devc->timebase > TIME_400ms)
343                 tmp = 0xffed;
344         else {
345                 if (devc->framesize == FRAMESIZE_SMALL)
346                         tmp = timebase_small[devc->timebase - 3];
347                 else
348                         tmp = timebase_large[devc->timebase - 3];
349         }
350         cmdstring[4] = tmp & 0xff;
351         cmdstring[5] = (tmp >> 8) & 0xff;
352
353         /* Horizontal trigger position */
354         sr_dbg("Trigger position: %3.2f.", devc->triggerposition);
355         tmp = 0x77fff + 0x8000 * devc->triggerposition;
356         cmdstring[6] = tmp & 0xff;
357         cmdstring[7] = (tmp >> 8) & 0xff;
358         cmdstring[10] = (tmp >> 16) & 0xff;
359
360         if (send_begin(sdi) != SR_OK)
361                 return SR_ERR;
362
363         if ((ret = libusb_bulk_transfer(usb->devhdl, DSO_EP_OUT,
364                         cmdstring, sizeof(cmdstring), &tmp, 100)) != 0) {
365                 sr_err("Failed to set trigger/samplerate: %s.",
366                        libusb_error_name(ret));
367                 return SR_ERR;
368         }
369         sr_dbg("Sent CMD_SET_TRIGGER_SAMPLERATE.");
370
371         return SR_OK;
372 }
373
374 static int dso_set_filters(const struct sr_dev_inst *sdi)
375 {
376         struct dev_context *devc;
377         struct sr_usb_dev_inst *usb;
378         int ret, tmp;
379         uint8_t cmdstring[8];
380
381         sr_dbg("Preparing CMD_SET_FILTERS.");
382
383         devc = sdi->priv;
384         usb = sdi->conn;
385
386         memset(cmdstring, 0, sizeof(cmdstring));
387         cmdstring[0] = CMD_SET_FILTERS;
388         cmdstring[1] = 0x0f;
389         if (devc->filter[0]) {
390                 sr_dbg("Turning on CH1 filter.");
391                 cmdstring[2] |= 0x80;
392         }
393         if (devc->filter[1]) {
394                 sr_dbg("Turning on CH2 filter.");
395                 cmdstring[2] |= 0x40;
396         }
397         /*
398          * Not supported: filtering on the trigger
399          * cmdstring[2] |= 0x20;
400          */
401
402         if (send_begin(sdi) != SR_OK)
403                 return SR_ERR;
404
405         if ((ret = libusb_bulk_transfer(usb->devhdl, DSO_EP_OUT,
406                         cmdstring, sizeof(cmdstring), &tmp, 100)) != 0) {
407                 sr_err("Failed to set filters: %s.", libusb_error_name(ret));
408                 return SR_ERR;
409         }
410         sr_dbg("Sent CMD_SET_FILTERS.");
411
412         return SR_OK;
413 }
414
415 static int dso_set_voltage(const struct sr_dev_inst *sdi)
416 {
417         struct dev_context *devc;
418         struct sr_usb_dev_inst *usb;
419         int ret, tmp;
420         uint8_t cmdstring[8];
421
422         sr_dbg("Preparing CMD_SET_VOLTAGE.");
423
424         devc = sdi->priv;
425         usb = sdi->conn;
426
427         memset(cmdstring, 0, sizeof(cmdstring));
428         cmdstring[0] = CMD_SET_VOLTAGE;
429         cmdstring[1] = 0x0f;
430         cmdstring[2] = 0x30;
431
432         /* CH1 volts/div is encoded in bits 0-1 */
433         sr_dbg("CH1 vdiv index: %d.", devc->voltage[0]);
434         switch (devc->voltage[0]) {
435         case VDIV_1V:
436         case VDIV_100MV:
437         case VDIV_10MV:
438                 cmdstring[2] |= 0x00;
439                 break;
440         case VDIV_2V:
441         case VDIV_200MV:
442         case VDIV_20MV:
443                 cmdstring[2] |= 0x01;
444                 break;
445         case VDIV_5V:
446         case VDIV_500MV:
447         case VDIV_50MV:
448                 cmdstring[2] |= 0x02;
449                 break;
450         }
451
452         /* CH2 volts/div is encoded in bits 2-3 */
453         sr_dbg("CH2 vdiv index: %d.", devc->voltage[1]);
454         switch (devc->voltage[1]) {
455         case VDIV_1V:
456         case VDIV_100MV:
457         case VDIV_10MV:
458                 cmdstring[2] |= 0x00;
459                 break;
460         case VDIV_2V:
461         case VDIV_200MV:
462         case VDIV_20MV:
463                 cmdstring[2] |= 0x04;
464                 break;
465         case VDIV_5V:
466         case VDIV_500MV:
467         case VDIV_50MV:
468                 cmdstring[2] |= 0x08;
469                 break;
470         }
471
472         if (send_begin(sdi) != SR_OK)
473                 return SR_ERR;
474
475         if ((ret = libusb_bulk_transfer(usb->devhdl, DSO_EP_OUT,
476                         cmdstring, sizeof(cmdstring), &tmp, 100)) != 0) {
477                 sr_err("Failed to set voltage: %s.", libusb_error_name(ret));
478                 return SR_ERR;
479         }
480         sr_dbg("Sent CMD_SET_VOLTAGE.");
481
482         return SR_OK;
483 }
484
485 static int dso_set_relays(const struct sr_dev_inst *sdi)
486 {
487         struct dev_context *devc;
488         struct sr_usb_dev_inst *usb;
489         GString *gs;
490         int ret, i;
491         uint8_t relays[17] = { 0x00, 0x04, 0x08, 0x02, 0x20, 0x40, 0x10, 0x01,
492                         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
493
494         sr_dbg("Preparing CTRL_SETRELAYS.");
495
496         devc = sdi->priv;
497         usb = sdi->conn;
498
499         if (devc->voltage[0] < VDIV_1V)
500                 relays[1] = ~relays[1];
501
502         if (devc->voltage[0] < VDIV_100MV)
503                 relays[2] = ~relays[2];
504
505         sr_dbg("CH1 coupling: %d.", devc->coupling[0]);
506         if (devc->coupling[0] != COUPLING_AC)
507                 relays[3] = ~relays[3];
508
509         if (devc->voltage[1] < VDIV_1V)
510                 relays[4] = ~relays[4];
511
512         if (devc->voltage[1] < VDIV_100MV)
513                 relays[5] = ~relays[5];
514
515         sr_dbg("CH2 coupling: %d.", devc->coupling[1]);
516         if (devc->coupling[1] != COUPLING_AC)
517                 relays[6] = ~relays[6];
518
519         if (!strcmp(devc->triggersource, "EXT"))
520                 relays[7] = ~relays[7];
521
522         if (sr_log_loglevel_get() >= SR_LOG_DBG) {
523                 gs = g_string_sized_new(128);
524                 g_string_printf(gs, "Relays:");
525                 for (i = 0; i < 17; i++)
526                         g_string_append_printf(gs, " %.2x", relays[i]);
527                 sr_dbg("%s", gs->str);
528                 g_string_free(gs, TRUE);
529         }
530
531         if ((ret = libusb_control_transfer(usb->devhdl,
532                         LIBUSB_REQUEST_TYPE_VENDOR, CTRL_SETRELAYS,
533                         0, 0, relays, 17, 100)) != sizeof(relays)) {
534                 sr_err("Failed to set relays: %s.", libusb_error_name(ret));
535                 return SR_ERR;
536         }
537         sr_dbg("Sent CTRL_SETRELAYS.");
538
539         return SR_OK;
540 }
541
542 static int dso_set_voffsets(const struct sr_dev_inst *sdi)
543 {
544         struct dev_context *devc;
545         struct sr_usb_dev_inst *usb;
546         int offset, ret;
547         uint16_t *ch_levels;
548         uint8_t offsets[17];
549
550         sr_dbg("Preparing CTRL_SETOFFSET.");
551
552         devc = sdi->priv;
553         usb = sdi->conn;
554
555         memset(offsets, 0, sizeof(offsets));
556         /* Channel 1 */
557         ch_levels = devc->channel_levels[0][devc->voltage[0]];
558         offset = (ch_levels[1] - ch_levels[0]) * devc->voffset_ch1 + ch_levels[0];
559         offsets[0] = (offset >> 8) | 0x20;
560         offsets[1] = offset & 0xff;
561         sr_dbg("CH1 offset: %3.2f (%.2x%.2x).", devc->voffset_ch1,
562                offsets[0], offsets[1]);
563
564         /* Channel 2 */
565         ch_levels = devc->channel_levels[1][devc->voltage[1]];
566         offset = (ch_levels[1] - ch_levels[0]) * devc->voffset_ch2 + ch_levels[0];
567         offsets[2] = (offset >> 8) | 0x20;
568         offsets[3] = offset & 0xff;
569         sr_dbg("CH2 offset: %3.2f (%.2x%.2x).", devc->voffset_ch2,
570                offsets[2], offsets[3]);
571
572         /* Trigger */
573         offset = MAX_VERT_TRIGGER * devc->voffset_trigger;
574         offsets[4] = (offset >> 8) | 0x20;
575         offsets[5] = offset & 0xff;
576         sr_dbg("Trigger offset: %3.2f (%.2x%.2x).", devc->voffset_trigger,
577                         offsets[4], offsets[5]);
578
579         if ((ret = libusb_control_transfer(usb->devhdl,
580                         LIBUSB_REQUEST_TYPE_VENDOR, CTRL_SETOFFSET,
581                         0, 0, offsets, sizeof(offsets), 100)) != sizeof(offsets)) {
582                 sr_err("Failed to set offsets: %s.", libusb_error_name(ret));
583                 return SR_ERR;
584         }
585         sr_dbg("Sent CTRL_SETOFFSET.");
586
587         return SR_OK;
588 }
589
590 SR_PRIV int dso_enable_trigger(const struct sr_dev_inst *sdi)
591 {
592         struct sr_usb_dev_inst *usb;
593         int ret, tmp;
594         uint8_t cmdstring[2];
595
596         sr_dbg("Sending CMD_ENABLE_TRIGGER.");
597
598         usb = sdi->conn;
599
600         memset(cmdstring, 0, sizeof(cmdstring));
601         cmdstring[0] = CMD_ENABLE_TRIGGER;
602         cmdstring[1] = 0x00;
603
604         if (send_begin(sdi) != SR_OK)
605                 return SR_ERR;
606
607         if ((ret = libusb_bulk_transfer(usb->devhdl, DSO_EP_OUT,
608                         cmdstring, sizeof(cmdstring), &tmp, 100)) != 0) {
609                 sr_err("Failed to enable trigger: %s.", libusb_error_name(ret));
610                 return SR_ERR;
611         }
612
613         return SR_OK;
614 }
615
616 SR_PRIV int dso_force_trigger(const struct sr_dev_inst *sdi)
617 {
618         struct sr_usb_dev_inst *usb;
619         int ret, tmp;
620         uint8_t cmdstring[2];
621
622         sr_dbg("Sending CMD_FORCE_TRIGGER.");
623
624         usb = sdi->conn;
625
626         memset(cmdstring, 0, sizeof(cmdstring));
627         cmdstring[0] = CMD_FORCE_TRIGGER;
628         cmdstring[1] = 0x00;
629
630         if (send_begin(sdi) != SR_OK)
631                 return SR_ERR;
632
633         if ((ret = libusb_bulk_transfer(usb->devhdl, DSO_EP_OUT,
634                         cmdstring, sizeof(cmdstring), &tmp, 100)) != 0) {
635                 sr_err("Failed to force trigger: %s.", libusb_error_name(ret));
636                 return SR_ERR;
637         }
638
639         return SR_OK;
640 }
641
642 SR_PRIV int dso_init(const struct sr_dev_inst *sdi)
643 {
644
645         sr_dbg("Initializing DSO.");
646
647         if (get_channel_offsets(sdi) != SR_OK)
648                 return SR_ERR;
649
650         if (dso_set_trigger_samplerate(sdi) != SR_OK)
651                 return SR_ERR;
652
653         if (dso_set_filters(sdi) != SR_OK)
654                 return SR_ERR;
655
656         if (dso_set_voltage(sdi) != SR_OK)
657                 return SR_ERR;
658
659         if (dso_set_relays(sdi) != SR_OK)
660                 return SR_ERR;
661
662         if (dso_set_voffsets(sdi) != SR_OK)
663                 return SR_ERR;
664
665         if (dso_enable_trigger(sdi) != SR_OK)
666                 return SR_ERR;
667
668         return SR_OK;
669 }
670
671 SR_PRIV int dso_get_capturestate(const struct sr_dev_inst *sdi,
672                 uint8_t *capturestate, uint32_t *trigger_offset)
673 {
674         struct sr_usb_dev_inst *usb;
675         int ret, tmp, i;
676         unsigned int bitvalue, toff;
677         uint8_t cmdstring[2], inbuf[512];
678
679         sr_dbg("Sending CMD_GET_CAPTURESTATE.");
680
681         usb = sdi->conn;
682
683         cmdstring[0] = CMD_GET_CAPTURESTATE;
684         cmdstring[1] = 0;
685
686         if ((ret = send_bulkcmd(sdi, cmdstring, sizeof(cmdstring))) != SR_OK) {
687                 sr_dbg("Failed to send get_capturestate command: %s.",
688                        libusb_error_name(ret));
689                 return SR_ERR;
690         }
691
692         if ((ret = libusb_bulk_transfer(usb->devhdl, DSO_EP_IN,
693                         inbuf, 512, &tmp, 100)) != 0) {
694                 sr_dbg("Failed to get capturestate: %s.",
695                        libusb_error_name(ret));
696                 return SR_ERR;
697         }
698         *capturestate = inbuf[0];
699         toff = (inbuf[1] << 16) | (inbuf[3] << 8) | inbuf[2];
700
701         /*
702          * This conversion comes from the openhantek project.
703          * Each set bit in the 24-bit value inverts all bits with a lower
704          * value. No idea why the device reports the trigger point this way.
705          */
706         bitvalue = 1;
707         for (i = 0; i < 24; i++) {
708                 /* Each set bit inverts all bits with a lower value. */
709                 if (toff & bitvalue)
710                         toff ^= bitvalue - 1;
711                 bitvalue <<= 1;
712         }
713         *trigger_offset = toff;
714
715         return SR_OK;
716 }
717
718 SR_PRIV int dso_capture_start(const struct sr_dev_inst *sdi)
719 {
720         int ret;
721         uint8_t cmdstring[2];
722
723         sr_dbg("Sending CMD_CAPTURE_START.");
724
725         cmdstring[0] = CMD_CAPTURE_START;
726         cmdstring[1] = 0;
727
728         if ((ret = send_bulkcmd(sdi, cmdstring, sizeof(cmdstring))) != SR_OK) {
729                 sr_err("Failed to send capture_start command: %s.",
730                        libusb_error_name(ret));
731                 return SR_ERR;
732         }
733
734         return SR_OK;
735 }
736
737 SR_PRIV int dso_get_channeldata(const struct sr_dev_inst *sdi,
738                 libusb_transfer_cb_fn cb)
739 {
740         struct dev_context *devc;
741         struct sr_usb_dev_inst *usb;
742         struct libusb_transfer *transfer;
743         int num_transfers, ret, i;
744         uint8_t cmdstring[2];
745         unsigned char *buf;
746
747         sr_dbg("Sending CMD_GET_CHANNELDATA.");
748
749         devc = sdi->priv;
750         usb = sdi->conn;
751
752         cmdstring[0] = CMD_GET_CHANNELDATA;
753         cmdstring[1] = 0;
754
755         if ((ret = send_bulkcmd(sdi, cmdstring, sizeof(cmdstring))) != SR_OK) {
756                 sr_err("Failed to get channel data: %s.",
757                        libusb_error_name(ret));
758                 return SR_ERR;
759         }
760
761         /* TODO: DSO-2xxx only. */
762         num_transfers = devc->framesize *
763                         sizeof(unsigned short) / devc->epin_maxpacketsize;
764         sr_dbg("Queueing up %d transfers.", num_transfers);
765         for (i = 0; i < num_transfers; i++) {
766                 if (!(buf = g_try_malloc(devc->epin_maxpacketsize))) {
767                         sr_err("Failed to malloc USB endpoint buffer.");
768                         return SR_ERR_MALLOC;
769                 }
770                 transfer = libusb_alloc_transfer(0);
771                 libusb_fill_bulk_transfer(transfer, usb->devhdl, DSO_EP_IN, buf,
772                                 devc->epin_maxpacketsize, cb, (void *)sdi, 40);
773                 if ((ret = libusb_submit_transfer(transfer)) != 0) {
774                         sr_err("Failed to submit transfer: %s.",
775                                libusb_error_name(ret));
776                         /* TODO: Free them all. */
777                         libusb_free_transfer(transfer);
778                         g_free(buf);
779                         return SR_ERR;
780                 }
781         }
782
783         return SR_OK;
784 }