]> sigrok.org Git - libsigrok.git/blame - hardware/zeroplus-logic-cube/zeroplus.c
victor-dmm: Initial driver skeleton.
[libsigrok.git] / hardware / zeroplus-logic-cube / zeroplus.c
CommitLineData
a1bb33af
UH
1/*
2 * This file is part of the sigrok project.
3 *
c73d2ea4 4 * Copyright (C) 2010-2012 Bert Vermeulen <bert@biot.com>
a1bb33af
UH
5 *
6 * This program is free software: you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, either version 3 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
18 */
19
20#include <stdio.h>
21#include <stdlib.h>
c31e9ef4 22#include <string.h>
a1bb33af
UH
23#include <sys/time.h>
24#include <inttypes.h>
25#include <glib.h>
26#include <libusb.h>
45c59c8b
BV
27#include "libsigrok.h"
28#include "libsigrok-internal.h"
a1bb33af
UH
29#include "analyzer.h"
30
fed16f06 31#define USB_VENDOR 0x0c12
8fdecced
UH
32
33#define VENDOR_NAME "ZEROPLUS"
34#define MODEL_NAME "Logic Cube LAP-C"
35#define MODEL_VERSION NULL
a1bb33af 36
6752905e 37#define NUM_PROBES 16
a1bb33af
UH
38#define USB_INTERFACE 0
39#define USB_CONFIGURATION 1
40#define NUM_TRIGGER_STAGES 4
41#define TRIGGER_TYPES "01"
42
fed16f06 43#define PACKET_SIZE 2048 /* ?? */
a1bb33af 44
0ab0cb94
TY
45//#define ZP_EXPERIMENTAL
46
a1bb33af 47typedef struct {
428edbe1 48 unsigned short vid;
a1bb33af 49 unsigned short pid;
428edbe1 50 char *model_name;
a1bb33af 51 unsigned int channels;
fed16f06 52 unsigned int sample_depth; /* In Ksamples/channel */
a1bb33af
UH
53 unsigned int max_sampling_freq;
54} model_t;
55
fed16f06
UH
56/*
57 * Note -- 16032, 16064 and 16128 *usually* -- but not always -- have the
58 * same 128K sample depth.
59 */
29cbfeaf 60static model_t zeroplus_models[] = {
428edbe1
BV
61 {0x0c12, 0x7009, "LAP-C(16064)", 16, 64, 100},
62 {0x0c12, 0x700A, "LAP-C(16128)", 16, 128, 200},
3f848bb7 63 /* TODO: we don't know anything about these
428edbe1
BV
64 {0x0c12, 0x700B, "LAP-C(32128)", 32, 128, 200},
65 {0x0c12, 0x700C, "LAP-C(321000)", 32, 1024, 200},
66 {0x0c12, 0x700D, "LAP-C(322000)", 32, 2048, 200},
3f848bb7 67 */
428edbe1
BV
68 {0x0c12, 0x700E, "LAP-C(16032)", 16, 32, 100},
69 {0x0c12, 0x7016, "LAP-C(162000)", 16, 2048, 200},
70 { 0, 0, 0, 0, 0, 0 }
a1bb33af
UH
71};
72
915f7cc8 73static const int hwcaps[] = {
5a2326a7
UH
74 SR_HWCAP_LOGIC_ANALYZER,
75 SR_HWCAP_SAMPLERATE,
5a2326a7 76 SR_HWCAP_CAPTURE_RATIO,
a1bb33af 77
fed16f06 78 /* These are really implemented in the driver, not the hardware. */
5a2326a7 79 SR_HWCAP_LIMIT_SAMPLES,
fed16f06 80 0,
a1bb33af
UH
81};
82
d261dbbf
UH
83/*
84 * ZEROPLUS LAP-C (16032) numbers the 16 probes A0-A7 and B0-B7.
85 * We currently ignore other untested/unsupported devices here.
86 */
6752905e 87static const char *probe_names[NUM_PROBES + 1] = {
d261dbbf
UH
88 "A0",
89 "A1",
90 "A2",
91 "A3",
92 "A4",
93 "A5",
94 "A6",
95 "A7",
96 "B0",
97 "B1",
98 "B2",
99 "B3",
100 "B4",
101 "B5",
102 "B6",
103 "B7",
464d12c7
KS
104 NULL,
105};
106
e7eb703f 107/* List of struct sr_dev_inst, maintained by dev_open()/dev_close(). */
32756547
BV
108SR_PRIV struct sr_dev_driver zeroplus_logic_cube_driver_info;
109static struct sr_dev_driver *zdi = &zeroplus_logic_cube_driver_info;
a1bb33af
UH
110
111static libusb_context *usb_context = NULL;
112
fed16f06
UH
113/*
114 * The hardware supports more samplerates than these, but these are the
115 * options hardcoded into the vendor's Windows GUI.
116 */
a1bb33af 117
fed16f06
UH
118/*
119 * TODO: We shouldn't support 150MHz and 200MHz on devices that don't go up
120 * that high.
121 */
a533743d 122static const uint64_t supported_samplerates[] = {
c9140419
UH
123 SR_HZ(100),
124 SR_HZ(500),
59df0c77
UH
125 SR_KHZ(1),
126 SR_KHZ(5),
127 SR_KHZ(25),
128 SR_KHZ(50),
129 SR_KHZ(100),
130 SR_KHZ(200),
131 SR_KHZ(400),
132 SR_KHZ(800),
133 SR_MHZ(1),
134 SR_MHZ(10),
135 SR_MHZ(25),
136 SR_MHZ(50),
137 SR_MHZ(80),
138 SR_MHZ(100),
139 SR_MHZ(150),
140 SR_MHZ(200),
fed16f06 141 0,
a1bb33af
UH
142};
143
a533743d 144static const struct sr_samplerates samplerates = {
590b9f9a
UH
145 0,
146 0,
147 0,
fed16f06 148 supported_samplerates,
a1bb33af
UH
149};
150
ea9cfed7 151/* Private, per-device-instance driver context. */
310e9e9b 152struct dev_context {
bf43ea23 153 uint64_t cur_samplerate;
0ab0cb94 154 uint64_t max_samplerate;
bf43ea23
UH
155 uint64_t limit_samples;
156 int num_channels; /* TODO: This isn't initialized before it's needed :( */
0ab0cb94
TY
157 int memory_size;
158 unsigned int max_memory_size;
159 //uint8_t probe_mask;
160 //uint8_t trigger_mask[NUM_TRIGGER_STAGES];
161 //uint8_t trigger_value[NUM_TRIGGER_STAGES];
bf43ea23 162 // uint8_t trigger_buffer[NUM_TRIGGER_STAGES];
0ab0cb94
TY
163 int trigger;
164 unsigned int capture_ratio;
69890f73 165
7da6f9d5 166 /* TODO: this belongs in the device instance */
d68e2d1a 167 struct sr_usb_dev_inst *usb;
bf43ea23 168};
a1bb33af 169
25a0f108 170static int hw_dev_close(struct sr_dev_inst *sdi);
a1bb33af
UH
171
172static unsigned int get_memory_size(int type)
173{
fed16f06
UH
174 if (type == MEMORY_SIZE_8K)
175 return 8 * 1024;
176 else if (type == MEMORY_SIZE_64K)
177 return 64 * 1024;
178 else if (type == MEMORY_SIZE_128K)
179 return 128 * 1024;
180 else if (type == MEMORY_SIZE_512K)
181 return 512 * 1024;
182 else
183 return 0;
a1bb33af
UH
184}
185
0ab0cb94 186#if 0
014359e3 187static int configure_probes(const struct sr_dev_inst *sdi)
a1bb33af 188{
310e9e9b 189 struct dev_context *devc;
1b79df2f
JH
190 const struct sr_probe *probe;
191 const GSList *l;
a1bb33af
UH
192 int probe_bit, stage, i;
193 char *tc;
194
bf43ea23 195 /* Note: sdi and sdi->priv are non-NULL, the caller checked this. */
310e9e9b 196 devc = sdi->priv;
bf43ea23 197
310e9e9b 198 devc->probe_mask = 0;
fed16f06 199 for (i = 0; i < NUM_TRIGGER_STAGES; i++) {
310e9e9b
BV
200 devc->trigger_mask[i] = 0;
201 devc->trigger_value[i] = 0;
a1bb33af
UH
202 }
203
204 stage = -1;
014359e3 205 for (l = sdi->probes; l; l = l->next) {
1afe8989 206 probe = (struct sr_probe *)l->data;
fed16f06 207 if (probe->enabled == FALSE)
a1bb33af 208 continue;
b35c8293 209 probe_bit = 1 << (probe->index);
310e9e9b 210 devc->probe_mask |= probe_bit;
fed16f06
UH
211
212 if (probe->trigger) {
a1bb33af 213 stage = 0;
fed16f06 214 for (tc = probe->trigger; *tc; tc++) {
310e9e9b 215 devc->trigger_mask[stage] |= probe_bit;
fed16f06 216 if (*tc == '1')
310e9e9b 217 devc->trigger_value[stage] |= probe_bit;
a1bb33af 218 stage++;
fed16f06 219 if (stage > NUM_TRIGGER_STAGES)
e46b8fb1 220 return SR_ERR;
a1bb33af
UH
221 }
222 }
223 }
224
e46b8fb1 225 return SR_OK;
a1bb33af 226}
0ab0cb94
TY
227#endif
228
229static int configure_probes(const struct sr_dev_inst *sdi)
230{
231 struct dev_context *devc;
232 const GSList *l;
233 const struct sr_probe *probe;
234 char *tc;
235 int type;
236
237 /* Note: sdi and sdi->priv are non-NULL, the caller checked this. */
238 devc = sdi->priv;
239
240 for (l = sdi->probes; l; l = l->next) {
241 probe = (struct sr_probe *)l->data;
242 if (probe->enabled == FALSE)
243 continue;
244
245 if ((tc = probe->trigger)) {
246 switch (*tc) {
247 case '1':
248 type = TRIGGER_HIGH;
249 break;
250 case '0':
251 type = TRIGGER_LOW;
252 break;
253#if 0
254 case 'r':
255 type = TRIGGER_POSEDGE;
256 break;
257 case 'f':
258 type = TRIGGER_NEGEDGE;
259 break;
260 case 'c':
261 type = TRIGGER_ANYEDGE;
262 break;
263#endif
264 default:
265 return SR_ERR;
266 }
267 analyzer_add_trigger(probe->index, type);
268 devc->trigger = 1;
269 }
270 }
271
272 return SR_OK;
273}
a1bb33af 274
811deee4 275static int clear_instances(void)
7da6f9d5
BV
276{
277 GSList *l;
278 struct sr_dev_inst *sdi;
310e9e9b 279 struct drv_context *drvc;
fabe59b3 280 struct dev_context *devc;
7da6f9d5 281
310e9e9b
BV
282 drvc = zdi->priv;
283 for (l = drvc->instances; l; l = l->next) {
7da6f9d5 284 sdi = l->data;
fabe59b3
BV
285 if (!(devc = sdi->priv)) {
286 /* Log error, but continue cleaning up the rest. */
287 sr_err("zeroplus: %s: sdi->priv was NULL, continuing", __func__);
288 continue;
289 }
290 sr_usb_dev_inst_free(devc->usb);
7da6f9d5 291 /* Properly close all devices... */
25a0f108 292 hw_dev_close(sdi);
7da6f9d5
BV
293 /* ...and free all their memory. */
294 sr_dev_inst_free(sdi);
295 }
310e9e9b
BV
296 g_slist_free(drvc->instances);
297 drvc->instances = NULL;
7da6f9d5 298
811deee4 299 return SR_OK;
7da6f9d5
BV
300}
301
a1bb33af
UH
302/*
303 * API callbacks
304 */
305
40dda2c3 306static int hw_init(void)
61136ea6 307{
310e9e9b
BV
308 struct drv_context *drvc;
309
310 if (!(drvc = g_try_malloc0(sizeof(struct drv_context)))) {
311 sr_err("zeroplus: driver context malloc failed.");
886a52b6 312 return SR_ERR_MALLOC;
310e9e9b
BV
313 }
314 zdi->priv = drvc;
61136ea6 315
7da6f9d5
BV
316 if (libusb_init(&usb_context) != 0) {
317 sr_err("zp: Failed to initialize USB.");
318 return 0;
319 }
61136ea6
BV
320
321 return SR_OK;
322}
323
4ca38984 324static GSList *hw_scan(GSList *options)
a1bb33af 325{
d68e2d1a 326 struct sr_dev_inst *sdi;
428edbe1 327 struct sr_probe *probe;
310e9e9b
BV
328 struct drv_context *drvc;
329 struct dev_context *devc;
428edbe1 330 model_t *prof;
a1bb33af
UH
331 struct libusb_device_descriptor des;
332 libusb_device **devlist;
428edbe1
BV
333 GSList *devices;
334 int ret, devcnt, i, j;
a1bb33af 335
4ca38984 336 (void)options;
310e9e9b 337 drvc = zdi->priv;
4ca38984
BV
338 devices = NULL;
339
7da6f9d5
BV
340 clear_instances();
341
8fdecced 342 /* Find all ZEROPLUS analyzers and add them to device list. */
a1bb33af 343 devcnt = 0;
185ae2c5 344 libusb_get_device_list(usb_context, &devlist); /* TODO: Errors. */
fed16f06
UH
345
346 for (i = 0; devlist[i]; i++) {
ebc34738
UH
347 ret = libusb_get_device_descriptor(devlist[i], &des);
348 if (ret != 0) {
349 sr_err("zp: failed to get device descriptor: %d", ret);
a1bb33af
UH
350 continue;
351 }
352
428edbe1
BV
353 prof = NULL;
354 for (j = 0; j < zeroplus_models[j].vid; j++) {
355 if (des.idVendor == zeroplus_models[j].vid &&
356 des.idProduct == zeroplus_models[j].pid) {
357 prof = &zeroplus_models[j];
bf43ea23 358 }
a1bb33af 359 }
428edbe1
BV
360 /* Skip if the device was not found */
361 if (!prof)
362 continue;
363 sr_info("zp: Found ZEROPLUS model %s", prof->model_name);
364
365 /* Register the device with libsigrok. */
366 if (!(sdi = sr_dev_inst_new(devcnt, SR_ST_INACTIVE,
367 VENDOR_NAME, prof->model_name, NULL))) {
368 sr_err("zp: %s: sr_dev_inst_new failed", __func__);
369 return NULL;
370 }
371 sdi->driver = zdi;
372
373 /* Allocate memory for our private driver context. */
310e9e9b
BV
374 if (!(devc = g_try_malloc0(sizeof(struct dev_context)))) {
375 sr_err("zp: %s: devc malloc failed", __func__);
886a52b6 376 return NULL;
428edbe1 377 }
310e9e9b
BV
378 sdi->priv = devc;
379 devc->num_channels = prof->channels;
0ab0cb94
TY
380#ifdef ZP_EXPERIMENTAL
381 devc->max_memory_size = 128 * 1024;
382 devc->max_samplerate = 200;
383#else
384 devc->max_memory_size = prof->sample_depth * 1024;
385 devc->max_samplerate = prof->max_sampling_freq;
386#endif
387 devc->max_samplerate *= SR_MHZ(1);
388 devc->memory_size = MEMORY_SIZE_8K;
310e9e9b 389 // memset(devc->trigger_buffer, 0, NUM_TRIGGER_STAGES);
428edbe1
BV
390
391 /* Fill in probelist according to this device's profile. */
310e9e9b 392 for (j = 0; j < devc->num_channels; j++) {
428edbe1
BV
393 if (!(probe = sr_probe_new(j, SR_PROBE_LOGIC, TRUE,
394 probe_names[j])))
395 return NULL;
396 sdi->probes = g_slist_append(sdi->probes, probe);
397 }
398
399 devices = g_slist_append(devices, sdi);
310e9e9b
BV
400 drvc->instances = g_slist_append(drvc->instances, sdi);
401 devc->usb = sr_usb_dev_inst_new(
428edbe1
BV
402 libusb_get_bus_number(devlist[i]),
403 libusb_get_device_address(devlist[i]), NULL);
404 devcnt++;
405
a1bb33af
UH
406 }
407 libusb_free_device_list(devlist, 1);
408
4ca38984 409 return devices;
a1bb33af
UH
410}
411
811deee4
BV
412static GSList *hw_dev_list(void)
413{
414 struct drv_context *drvc;
415
416 drvc = zdi->priv;
417
418 return drvc->instances;
419}
420
25a0f108 421static int hw_dev_open(struct sr_dev_inst *sdi)
a1bb33af 422{
310e9e9b 423 struct dev_context *devc;
428edbe1
BV
424 libusb_device **devlist, *dev;
425 struct libusb_device_descriptor des;
426 int device_count, ret, i;
a1bb33af 427
310e9e9b 428 if (!(devc = sdi->priv)) {
bf43ea23
UH
429 sr_err("zp: %s: sdi->priv was NULL", __func__);
430 return SR_ERR_ARG;
431 }
432
428edbe1
BV
433 device_count = libusb_get_device_list(usb_context, &devlist);
434 if (device_count < 0) {
435 sr_err("zp: Failed to retrieve device list");
436 return SR_ERR;
437 }
438
439 dev = NULL;
440 for (i = 0; i < device_count; i++) {
441 if ((ret = libusb_get_device_descriptor(devlist[i], &des))) {
442 sr_err("fx2lafw: Failed to get device descriptor: %d.",
443 ret);
444 continue;
445 }
310e9e9b
BV
446 if (libusb_get_bus_number(devlist[i]) == devc->usb->bus
447 && libusb_get_device_address(devlist[i]) == devc->usb->address) {
428edbe1
BV
448 dev = devlist[i];
449 break;
450 }
451 }
452 if (!dev) {
453 sr_err("device on bus %d address %d disappeared!",
310e9e9b 454 devc->usb->bus, devc->usb->address);
428edbe1
BV
455 return SR_ERR;
456 }
457
310e9e9b 458 if (!(ret = libusb_open(dev, &(devc->usb->devhdl)))) {
428edbe1
BV
459 sdi->status = SR_ST_ACTIVE;
460 sr_info("zp: opened device %d on %d.%d interface %d",
310e9e9b
BV
461 sdi->index, devc->usb->bus,
462 devc->usb->address, USB_INTERFACE);
428edbe1
BV
463 } else {
464 sr_err("zp: failed to open device: %d", ret);
465 return SR_ERR;
466 }
467
310e9e9b 468 ret = libusb_set_configuration(devc->usb->devhdl, USB_CONFIGURATION);
ebc34738 469 if (ret < 0) {
133a37bf 470 sr_err("zp: Unable to set USB configuration %d: %d",
ebc34738 471 USB_CONFIGURATION, ret);
185ae2c5
UH
472 return SR_ERR;
473 }
474
310e9e9b 475 ret = libusb_claim_interface(devc->usb->devhdl, USB_INTERFACE);
ebc34738
UH
476 if (ret != 0) {
477 sr_err("zp: Unable to claim interface: %d", ret);
e46b8fb1 478 return SR_ERR;
a1bb33af 479 }
185ae2c5 480
0ab0cb94
TY
481 /* Set default configuration after power on */
482 if (analyzer_read_status(devc->usb->devhdl) == 0)
483 analyzer_configure(devc->usb->devhdl);
484
310e9e9b
BV
485 analyzer_reset(devc->usb->devhdl);
486 analyzer_initialize(devc->usb->devhdl);
a1bb33af 487
0ab0cb94 488 //analyzer_set_memory_size(MEMORY_SIZE_512K);
fed16f06 489 // analyzer_set_freq(g_freq, g_freq_scale);
a1bb33af 490 analyzer_set_trigger_count(1);
408e7199
UH
491 // analyzer_set_ramsize_trigger_address((((100 - g_pre_trigger)
492 // * get_memory_size(g_memory_size)) / 100) >> 2);
a1bb33af 493
fed16f06
UH
494#if 0
495 if (g_double_mode == 1)
a1bb33af
UH
496 analyzer_set_compression(COMPRESSION_DOUBLE);
497 else if (g_compression == 1)
498 analyzer_set_compression(COMPRESSION_ENABLE);
fed16f06
UH
499 else
500#endif
501 analyzer_set_compression(COMPRESSION_NONE);
a1bb33af 502
310e9e9b 503 if (devc->cur_samplerate == 0) {
0ab0cb94
TY
504 /* Samplerate hasn't been set. Default to 1MHz. */
505 analyzer_set_freq(1, FREQ_SCALE_MHZ);
506 devc->cur_samplerate = SR_MHZ(1);
a1bb33af
UH
507 }
508
e46b8fb1 509 return SR_OK;
a1bb33af
UH
510}
511
25a0f108 512static int hw_dev_close(struct sr_dev_inst *sdi)
a1bb33af 513{
310e9e9b 514 struct dev_context *devc;
a1bb33af 515
310e9e9b 516 if (!(devc = sdi->priv)) {
25a0f108
BV
517 sr_err("zp: %s: sdi->priv was NULL", __func__);
518 return SR_ERR;
697785d1
UH
519 }
520
310e9e9b 521 if (!devc->usb->devhdl)
25a0f108
BV
522 return SR_ERR;
523
524 sr_info("zp: closing device %d on %d.%d interface %d", sdi->index,
310e9e9b
BV
525 devc->usb->bus, devc->usb->address, USB_INTERFACE);
526 libusb_release_interface(devc->usb->devhdl, USB_INTERFACE);
527 libusb_reset_device(devc->usb->devhdl);
528 libusb_close(devc->usb->devhdl);
529 devc->usb->devhdl = NULL;
25a0f108 530 sdi->status = SR_ST_INACTIVE;
697785d1
UH
531
532 return SR_OK;
a1bb33af
UH
533}
534
57ab7d9f 535static int hw_cleanup(void)
a1bb33af 536{
310e9e9b
BV
537 struct drv_context *drvc;
538
539 if (!(drvc = zdi->priv))
540 return SR_OK;
a1bb33af 541
7da6f9d5 542 clear_instances();
a1bb33af 543
fed16f06 544 if (usb_context)
a1bb33af
UH
545 libusb_exit(usb_context);
546 usb_context = NULL;
57ab7d9f
UH
547
548 return SR_OK;
a1bb33af
UH
549}
550
626409ab
BV
551static int hw_info_get(int info_id, const void **data,
552 const struct sr_dev_inst *sdi)
a1bb33af 553{
310e9e9b 554 struct dev_context *devc;
a1bb33af 555
626409ab 556 switch (info_id) {
444adea2
BV
557 case SR_DI_HWCAPS:
558 *data = hwcaps;
559 break;
5a2326a7 560 case SR_DI_NUM_PROBES:
626409ab 561 if (sdi) {
310e9e9b
BV
562 devc = sdi->priv;
563 *data = GINT_TO_POINTER(devc->num_channels);
626409ab 564 sr_spew("zp: %s: Returning number of channels: %d.",
310e9e9b 565 __func__, devc->num_channels);
626409ab
BV
566 } else
567 return SR_ERR;
a1bb33af 568 break;
464d12c7 569 case SR_DI_PROBE_NAMES:
626409ab 570 *data = probe_names;
6752905e 571 sr_spew("zp: %s: Returning probenames.", __func__);
464d12c7 572 break;
5a2326a7 573 case SR_DI_SAMPLERATES:
626409ab 574 *data = &samplerates;
6752905e 575 sr_spew("zp: %s: Returning samplerates.", __func__);
a1bb33af 576 break;
5a2326a7 577 case SR_DI_TRIGGER_TYPES:
626409ab
BV
578 *data = TRIGGER_TYPES;
579 sr_spew("zp: %s: Returning triggertypes: %s.", __func__, TRIGGER_TYPES);
a1bb33af 580 break;
5a2326a7 581 case SR_DI_CUR_SAMPLERATE:
626409ab 582 if (sdi) {
310e9e9b
BV
583 devc = sdi->priv;
584 *data = &devc->cur_samplerate;
626409ab 585 sr_spew("zp: %s: Returning samplerate: %" PRIu64 "Hz.",
310e9e9b 586 __func__, devc->cur_samplerate);
626409ab
BV
587 } else
588 return SR_ERR;
bf43ea23
UH
589 break;
590 default:
626409ab 591 return SR_ERR_ARG;
a1bb33af
UH
592 }
593
626409ab 594 return SR_OK;
a1bb33af
UH
595}
596
0ab0cb94 597static int set_samplerate(struct dev_context *devc, uint64_t samplerate)
a1bb33af 598{
0ab0cb94 599 int i;
bf43ea23 600
0ab0cb94
TY
601 for (i = 0; supported_samplerates[i]; i++)
602 if (samplerate == supported_samplerates[i])
603 break;
604 if (!supported_samplerates[i] || samplerate > devc->max_samplerate) {
605 sr_err("zp: %s: unsupported samplerate", __func__);
bf43ea23
UH
606 return SR_ERR_ARG;
607 }
608
73017cf9
UH
609 sr_info("zp: Setting samplerate to %" PRIu64 "Hz.", samplerate);
610
0ab0cb94 611 if (samplerate >= SR_MHZ(1))
59df0c77 612 analyzer_set_freq(samplerate / SR_MHZ(1), FREQ_SCALE_MHZ);
0ab0cb94 613 else if (samplerate >= SR_KHZ(1))
59df0c77 614 analyzer_set_freq(samplerate / SR_KHZ(1), FREQ_SCALE_KHZ);
a1bb33af 615 else
fed16f06 616 analyzer_set_freq(samplerate, FREQ_SCALE_HZ);
a1bb33af 617
310e9e9b 618 devc->cur_samplerate = samplerate;
a1bb33af 619
e46b8fb1 620 return SR_OK;
a1bb33af
UH
621}
622
0ab0cb94
TY
623static int set_limit_samples(struct dev_context *devc, uint64_t samples)
624{
625 devc->limit_samples = samples;
626
627 if (samples <= 2 * 1024)
628 devc->memory_size = MEMORY_SIZE_8K;
629 else if (samples <= 16 * 1024)
630 devc->memory_size = MEMORY_SIZE_64K;
631 else if (samples <= 32 * 1024 ||
632 devc->max_memory_size <= 32 * 1024)
633 devc->memory_size = MEMORY_SIZE_128K;
634 else
635 devc->memory_size = MEMORY_SIZE_512K;
636
637 sr_info("zp: Setting memory size to %dK.",
638 get_memory_size(devc->memory_size) / 1024);
639
640 analyzer_set_memory_size(devc->memory_size);
641
642 return SR_OK;
643}
644
645static int set_capture_ratio(struct dev_context *devc, uint64_t ratio)
646{
647 if (ratio > 100) {
648 sr_err("zp: %s: invalid capture ratio", __func__);
649 return SR_ERR_ARG;
650 }
651
652 devc->capture_ratio = ratio;
653
654 sr_info("zp: Setting capture ratio to %d%%.", devc->capture_ratio);
655
656 return SR_OK;
657}
658
6f4b1868 659static int hw_dev_config_set(const struct sr_dev_inst *sdi, int hwcap,
0ab0cb94 660 const void *value)
a1bb33af 661{
310e9e9b 662 struct dev_context *devc;
a1bb33af 663
0ab0cb94
TY
664 if (!sdi) {
665 sr_err("zp: %s: sdi was NULL", __func__);
666 return SR_ERR_ARG;
667 }
668
310e9e9b 669 if (!(devc = sdi->priv)) {
bf43ea23
UH
670 sr_err("zp: %s: sdi->priv was NULL", __func__);
671 return SR_ERR_ARG;
672 }
a1bb33af 673
ffedd0bf 674 switch (hwcap) {
5a2326a7 675 case SR_HWCAP_SAMPLERATE:
0ab0cb94 676 return set_samplerate(devc, *(const uint64_t *)value);
5a2326a7 677 case SR_HWCAP_LIMIT_SAMPLES:
0ab0cb94
TY
678 return set_limit_samples(devc, *(const uint64_t *)value);
679 case SR_HWCAP_CAPTURE_RATIO:
680 return set_capture_ratio(devc, *(const uint64_t *)value);
fed16f06 681 default:
e46b8fb1 682 return SR_ERR;
a1bb33af
UH
683 }
684}
685
0ab0cb94
TY
686static void set_triggerbar(struct dev_context *devc)
687{
688 unsigned int ramsize;
689 unsigned int n;
690 unsigned int triggerbar;
691
692 ramsize = get_memory_size(devc->memory_size) / 4;
693 if (devc->trigger) {
694 n = ramsize;
695 if (devc->max_memory_size < n)
696 n = devc->max_memory_size;
697 if (devc->limit_samples < n)
698 n = devc->limit_samples;
699 n = n * devc->capture_ratio / 100;
700 if (n > ramsize - 8)
701 triggerbar = ramsize - 8;
702 else
703 triggerbar = n;
704 } else {
705 triggerbar = 0;
706 }
707 analyzer_set_triggerbar_address(triggerbar);
708 analyzer_set_ramsize_trigger_address(ramsize - triggerbar);
709
710 sr_dbg("zp: triggerbar_address = %d(0x%x)", triggerbar, triggerbar);
711 sr_dbg("zp: ramsize_triggerbar_address = %d(0x%x)",
712 ramsize - triggerbar, ramsize - triggerbar);
713}
714
3ffb6964
BV
715static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
716 void *cb_data)
a1bb33af 717{
b9c735a2 718 struct sr_datafeed_packet packet;
9c939c51 719 struct sr_datafeed_logic logic;
b9c735a2 720 struct sr_datafeed_header header;
f366e86c 721 struct sr_datafeed_meta_logic meta;
0ab0cb94 722 //uint64_t samples_read;
a1bb33af 723 int res;
afc8e4de 724 unsigned int packet_num;
0ab0cb94 725 unsigned int n;
a1bb33af 726 unsigned char *buf;
310e9e9b 727 struct dev_context *devc;
a1bb33af 728
310e9e9b 729 if (!(devc = sdi->priv)) {
bf43ea23
UH
730 sr_err("zp: %s: sdi->priv was NULL", __func__);
731 return SR_ERR_ARG;
732 }
a1bb33af 733
014359e3
BV
734 if (configure_probes(sdi) != SR_OK) {
735 sr_err("zp: failed to configured probes");
736 return SR_ERR;
737 }
738
0ab0cb94
TY
739 set_triggerbar(devc);
740
a143e4e5 741 /* push configured settings to device */
310e9e9b 742 analyzer_configure(devc->usb->devhdl);
a143e4e5 743
310e9e9b 744 analyzer_start(devc->usb->devhdl);
7b48d6e1 745 sr_info("zp: Waiting for data");
310e9e9b 746 analyzer_wait_data(devc->usb->devhdl);
a1bb33af 747
7b48d6e1 748 sr_info("zp: Stop address = 0x%x",
310e9e9b 749 analyzer_get_stop_address(devc->usb->devhdl));
7b48d6e1 750 sr_info("zp: Now address = 0x%x",
310e9e9b 751 analyzer_get_now_address(devc->usb->devhdl));
7b48d6e1 752 sr_info("zp: Trigger address = 0x%x",
310e9e9b 753 analyzer_get_trigger_address(devc->usb->devhdl));
a1bb33af 754
5a2326a7 755 packet.type = SR_DF_HEADER;
9c939c51 756 packet.payload = &header;
a1bb33af
UH
757 header.feed_version = 1;
758 gettimeofday(&header.starttime, NULL);
f366e86c
BV
759 sr_session_send(cb_data, &packet);
760
761 /* Send metadata about the SR_DF_LOGIC packets to come. */
762 packet.type = SR_DF_META_LOGIC;
763 packet.payload = &meta;
310e9e9b
BV
764 meta.samplerate = devc->cur_samplerate;
765 meta.num_probes = devc->num_channels;
3cd3a20b 766 sr_session_send(cb_data, &packet);
a1bb33af 767
b53738ba 768 if (!(buf = g_try_malloc(PACKET_SIZE))) {
bf43ea23 769 sr_err("zp: %s: buf malloc failed", __func__);
b53738ba
UH
770 return SR_ERR_MALLOC;
771 }
772
0ab0cb94 773 //samples_read = 0;
310e9e9b 774 analyzer_read_start(devc->usb->devhdl);
fed16f06 775 /* Send the incoming transfer to the session bus. */
0ab0cb94
TY
776 n = get_memory_size(devc->memory_size);
777 if (devc->max_memory_size * 4 < n)
778 n = devc->max_memory_size * 4;
779 for (packet_num = 0; packet_num < n / PACKET_SIZE; packet_num++) {
310e9e9b 780 res = analyzer_read_data(devc->usb->devhdl, buf, PACKET_SIZE);
0ab0cb94 781 sr_info("zp: Tried to read %d bytes, actually read %d bytes",
b08024a8 782 PACKET_SIZE, res);
a1bb33af 783
5a2326a7 784 packet.type = SR_DF_LOGIC;
9c939c51
BV
785 packet.payload = &logic;
786 logic.length = PACKET_SIZE;
787 logic.unitsize = 4;
788 logic.data = buf;
3cd3a20b 789 sr_session_send(cb_data, &packet);
0ab0cb94 790 //samples_read += res / 4;
a1bb33af 791 }
310e9e9b 792 analyzer_read_stop(devc->usb->devhdl);
a1bb33af
UH
793 g_free(buf);
794
5a2326a7 795 packet.type = SR_DF_END;
3cd3a20b 796 sr_session_send(cb_data, &packet);
a1bb33af 797
e46b8fb1 798 return SR_OK;
a1bb33af
UH
799}
800
3cd3a20b 801/* TODO: This stops acquisition on ALL devices, ignoring dev_index. */
3ffb6964
BV
802static int hw_dev_acquisition_stop(const struct sr_dev_inst *sdi,
803 void *cb_data)
a1bb33af 804{
b9c735a2 805 struct sr_datafeed_packet packet;
310e9e9b 806 struct dev_context *devc;
a1bb33af 807
5a2326a7 808 packet.type = SR_DF_END;
3cd3a20b 809 sr_session_send(cb_data, &packet);
a1bb33af 810
310e9e9b 811 if (!(devc = sdi->priv)) {
69890f73 812 sr_err("zp: %s: sdi->priv was NULL", __func__);
3010f21c 813 return SR_ERR_BUG;
69890f73 814 }
a1bb33af 815
310e9e9b 816 analyzer_reset(devc->usb->devhdl);
fed16f06 817 /* TODO: Need to cancel and free any queued up transfers. */
3010f21c
UH
818
819 return SR_OK;
a1bb33af
UH
820}
821
c09f0b57 822SR_PRIV struct sr_dev_driver zeroplus_logic_cube_driver_info = {
e519ba86 823 .name = "zeroplus-logic-cube",
8fdecced 824 .longname = "ZEROPLUS Logic Cube LAP-C series",
e519ba86
UH
825 .api_version = 1,
826 .init = hw_init,
827 .cleanup = hw_cleanup,
61136ea6 828 .scan = hw_scan,
811deee4
BV
829 .dev_list = hw_dev_list,
830 .dev_clear = hw_cleanup,
e7eb703f
UH
831 .dev_open = hw_dev_open,
832 .dev_close = hw_dev_close,
626409ab 833 .info_get = hw_info_get,
a9a245b4 834 .dev_config_set = hw_dev_config_set,
69040b7c
UH
835 .dev_acquisition_start = hw_dev_acquisition_start,
836 .dev_acquisition_stop = hw_dev_acquisition_stop,
310e9e9b 837 .priv = NULL,
a1bb33af 838};