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