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