2 * This file is part of the libsigrok project.
4 * Copyright (C) 2014 Daniel Elstner <daniel.kitta@gmail.com>
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.
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.
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/>.
25 #include <libsigrok/libsigrok.h>
26 #include <libsigrok-internal.h>
29 static const uint32_t scanopts[] = {
33 static const uint32_t drvopts[] = {
34 SR_CONF_LOGIC_ANALYZER,
37 static const int32_t trigger_matches[] = {
44 static const char *trigger_sources[] = {
45 [TRIGGER_CHANNELS] = "CH",
46 [TRIGGER_EXT_TRG] = "TRG",
49 static const char *signal_edges[] = {
50 [EDGE_POSITIVE] = "r",
51 [EDGE_NEGATIVE] = "f",
54 static struct sr_dev_inst *dev_inst_new(const struct model_info *model)
56 struct sr_dev_inst *sdi;
57 struct dev_context *devc;
61 devc = g_malloc0(sizeof(struct dev_context));
63 devc->active_fpga_config = FPGA_NOCONF;
65 devc->samplerate = model->samplerates[0];
66 devc->channel_mask = (UINT64_C(1) << model->num_channels) - 1;
68 sdi = g_malloc0(sizeof(struct sr_dev_inst));
69 sdi->status = SR_ST_INACTIVE;
70 sdi->vendor = g_strdup("SysClk");
71 sdi->model = g_strdup(model->name);
74 for (i = 0; i < model->num_channels; i++) {
75 g_snprintf(name, sizeof(name), "CH%d", i + 1);
76 sr_channel_new(sdi, i, SR_CHANNEL_LOGIC, TRUE, name);
82 /* Create a new device instance for a libusb device if it is a SysClk LWLA
83 * device and also matches the connection specification.
85 static struct sr_dev_inst *dev_inst_new_matching(GSList *conn_matches,
89 struct sr_usb_dev_inst *usb;
90 const struct model_info *model;
91 struct sr_dev_inst *sdi;
92 struct libusb_device_descriptor des;
93 int bus, address, ret;
94 unsigned int vid, pid;
96 bus = libusb_get_bus_number(dev);
97 address = libusb_get_device_address(dev);
99 for (node = conn_matches; node != NULL; node = node->next) {
101 if (usb && usb->bus == bus && usb->address == address)
104 if (conn_matches && !node)
105 return NULL; /* no match */
107 ret = libusb_get_device_descriptor(dev, &des);
109 sr_err("Failed to get USB device descriptor: %s.",
110 libusb_error_name(ret));
116 /* Create sigrok device instance. */
117 if (vid == USB_VID_SYSCLK && pid == USB_PID_LWLA1016) {
118 model = &lwla1016_info;
119 } else if (vid == USB_VID_SYSCLK && pid == USB_PID_LWLA1034) {
120 model = &lwla1034_info;
123 sr_warn("USB device %d.%d (%04x:%04x) is not a"
124 " SysClk LWLA.", bus, address, vid, pid);
127 sdi = dev_inst_new(model);
129 sdi->inst_type = SR_INST_USB;
130 sdi->conn = sr_usb_dev_inst_new(bus, address, NULL);
135 static GSList *scan(struct sr_dev_driver *di, GSList *options)
137 GSList *conn_devices, *devices, *node;
138 struct drv_context *drvc;
139 struct sr_dev_inst *sdi;
140 struct sr_config *src;
142 libusb_device **devlist;
150 for (node = options; node != NULL; node = node->next) {
152 if (src->key == SR_CONF_CONN) {
153 conn = g_variant_get_string(src->data, NULL);
158 /* Find devices matching the connection specification. */
159 conn_devices = sr_usb_find(drvc->sr_ctx->libusb_ctx, conn);
162 /* List all libusb devices. */
163 num_devs = libusb_get_device_list(drvc->sr_ctx->libusb_ctx, &devlist);
165 sr_err("Failed to list USB devices: %s.",
166 libusb_error_name(num_devs));
167 g_slist_free_full(conn_devices,
168 (GDestroyNotify)&sr_usb_dev_inst_free);
172 /* Scan the USB device list for matching LWLA devices. */
173 for (i = 0; i < num_devs; i++) {
174 sdi = dev_inst_new_matching(conn_devices, devlist[i]);
176 continue; /* no match */
178 /* Register device instance with driver. */
179 devices = g_slist_append(devices, sdi);
182 libusb_free_device_list(devlist, 1);
183 g_slist_free_full(conn_devices, (GDestroyNotify)&sr_usb_dev_inst_free);
185 return std_scan_complete(di, devices);
188 /* Drain any pending data from the USB transfer buffers on the device.
189 * This may be necessary e.g. after a crash or generally to clean up after
190 * an abnormal condition.
192 static int drain_usb(struct sr_usb_dev_inst *usb, unsigned int endpoint)
194 int drained, xfer_len, ret;
195 unsigned char buf[512];
196 const unsigned int drain_timeout_ms = 10;
201 ret = libusb_bulk_transfer(usb->devhdl, endpoint,
202 buf, sizeof(buf), &xfer_len,
205 } while (ret == LIBUSB_SUCCESS && xfer_len != 0);
207 if (ret != LIBUSB_SUCCESS && ret != LIBUSB_ERROR_TIMEOUT) {
208 sr_err("Failed to drain USB endpoint %u: %s.",
209 endpoint & (LIBUSB_ENDPOINT_IN - 1),
210 libusb_error_name(ret));
214 sr_warn("Drained %d bytes from USB endpoint %u.",
215 drained, endpoint & (LIBUSB_ENDPOINT_IN - 1));
221 static int dev_open(struct sr_dev_inst *sdi)
223 struct drv_context *drvc;
224 struct dev_context *devc;
225 struct sr_usb_dev_inst *usb;
228 drvc = sdi->driver->context;
232 /* Try the whole shebang three times, fingers crossed. */
233 for (i = 0; i < 3; i++) {
234 ret = sr_usb_open(drvc->sr_ctx->libusb_ctx, usb);
238 ret = libusb_set_configuration(usb->devhdl, USB_CONFIG);
239 if (ret != LIBUSB_SUCCESS) {
240 sr_err("Failed to set USB configuration: %s.",
241 libusb_error_name(ret));
246 ret = libusb_claim_interface(usb->devhdl, USB_INTERFACE);
247 if (ret != LIBUSB_SUCCESS) {
248 sr_err("Failed to claim interface: %s.",
249 libusb_error_name(ret));
254 ret = drain_usb(usb, EP_REPLY);
259 /* This delay appears to be necessary for reliable operation. */
262 sdi->status = SR_ST_ACTIVE;
264 devc->active_fpga_config = FPGA_NOCONF;
265 devc->short_transfer_quirk = FALSE;
266 devc->state = STATE_IDLE;
268 ret = (*devc->model->apply_fpga_config)(sdi);
271 ret = (*devc->model->device_init_check)(sdi);
275 /* Rinse and repeat. */
276 sdi->status = SR_ST_INACTIVE;
280 if (ret == SR_OK && devc->short_transfer_quirk)
281 sr_warn("Short transfer quirk detected! "
282 "Memory reads will be slow.");
286 static int dev_close(struct sr_dev_inst *sdi)
288 struct dev_context *devc;
289 struct sr_usb_dev_inst *usb;
295 if (devc->acquisition) {
296 sr_err("Cannot close device during acquisition!");
297 /* Request stop, leak handle, and prepare for the worst. */
298 devc->cancel_requested = TRUE;
302 /* Download of the shutdown bitstream, if any. */
303 ret = (*devc->model->apply_fpga_config)(sdi);
305 sr_warn("Unable to shut down device.");
308 libusb_release_interface(usb->devhdl, USB_INTERFACE);
315 /* Check whether the device options contain a specific key.
316 * Also match against get/set/list bits if specified.
318 static int has_devopt(const struct model_info *model, uint32_t key)
322 for (i = 0; i < model->num_devopts; i++) {
323 if ((model->devopts[i] & (SR_CONF_MASK | key)) == key)
330 static int config_get(uint32_t key, GVariant **data,
331 const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
333 struct dev_context *devc;
343 if (!has_devopt(devc->model, key | SR_CONF_GET))
347 case SR_CONF_SAMPLERATE:
348 *data = g_variant_new_uint64(devc->samplerate);
350 case SR_CONF_LIMIT_MSEC:
351 *data = g_variant_new_uint64(devc->limit_msec);
353 case SR_CONF_LIMIT_SAMPLES:
354 *data = g_variant_new_uint64(devc->limit_samples);
357 *data = g_variant_new_boolean(devc->cfg_rle);
359 case SR_CONF_EXTERNAL_CLOCK:
360 *data = g_variant_new_boolean(devc->cfg_clock_source
363 case SR_CONF_CLOCK_EDGE:
364 idx = devc->cfg_clock_edge;
365 if (idx >= ARRAY_SIZE(signal_edges))
367 *data = g_variant_new_string(signal_edges[idx]);
369 case SR_CONF_TRIGGER_SOURCE:
370 idx = devc->cfg_trigger_source;
371 if (idx >= ARRAY_SIZE(trigger_sources))
373 *data = g_variant_new_string(trigger_sources[idx]);
375 case SR_CONF_TRIGGER_SLOPE:
376 idx = devc->cfg_trigger_slope;
377 if (idx >= ARRAY_SIZE(signal_edges))
379 *data = g_variant_new_string(signal_edges[idx]);
382 /* Must not happen for a key listed in devopts. */
389 static int config_set(uint32_t key, GVariant *data,
390 const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
393 struct dev_context *devc;
403 if (!has_devopt(devc->model, key | SR_CONF_SET))
407 case SR_CONF_SAMPLERATE:
408 value = g_variant_get_uint64(data);
409 if (value < devc->model->samplerates[devc->model->num_samplerates - 1]
410 || value > devc->model->samplerates[0])
411 return SR_ERR_SAMPLERATE;
412 devc->samplerate = value;
414 case SR_CONF_LIMIT_MSEC:
415 value = g_variant_get_uint64(data);
416 if (value > MAX_LIMIT_MSEC)
418 devc->limit_msec = value;
420 case SR_CONF_LIMIT_SAMPLES:
421 value = g_variant_get_uint64(data);
422 if (value > MAX_LIMIT_SAMPLES)
424 devc->limit_samples = value;
427 devc->cfg_rle = g_variant_get_boolean(data);
429 case SR_CONF_EXTERNAL_CLOCK:
430 devc->cfg_clock_source = (g_variant_get_boolean(data))
431 ? CLOCK_EXT_CLK : CLOCK_INTERNAL;
433 case SR_CONF_CLOCK_EDGE:
434 if ((idx = std_str_idx(data, ARRAY_AND_SIZE(signal_edges))) < 0)
436 devc->cfg_clock_edge = idx;
438 case SR_CONF_TRIGGER_SOURCE:
439 if ((idx = std_str_idx(data, ARRAY_AND_SIZE(trigger_sources))) < 0)
441 devc->cfg_trigger_source = idx;
443 case SR_CONF_TRIGGER_SLOPE:
444 if ((idx = std_str_idx(data, ARRAY_AND_SIZE(signal_edges))) < 0)
446 devc->cfg_trigger_slope = idx;
449 /* Must not happen for a key listed in devopts. */
456 static int config_channel_set(const struct sr_dev_inst *sdi,
457 struct sr_channel *ch, unsigned int changes)
459 uint64_t channel_bit;
460 struct dev_context *devc;
467 if (ch->index < 0 || ch->index >= devc->model->num_channels) {
468 sr_err("Channel index %d out of range.", ch->index);
472 if ((changes & SR_CHANNEL_SET_ENABLED) != 0) {
473 channel_bit = UINT64_C(1) << ch->index;
475 /* Enable or disable logic input for this channel. */
477 devc->channel_mask |= channel_bit;
479 devc->channel_mask &= ~channel_bit;
485 /* Derive trigger masks from the session's trigger configuration. */
486 static int prepare_trigger_masks(const struct sr_dev_inst *sdi)
488 uint64_t trigger_mask, trigger_values, trigger_edge_mask;
489 uint64_t level_bit, type_bit;
490 struct dev_context *devc;
491 struct sr_trigger *trigger;
492 struct sr_trigger_stage *stage;
493 struct sr_trigger_match *match;
496 enum sr_trigger_matches trg;
500 trigger = sr_session_trigger_get(sdi->session);
501 if (!trigger || !trigger->stages)
504 if (trigger->stages->next) {
505 sr_err("This device only supports 1 trigger stage.");
508 stage = trigger->stages->data;
512 trigger_edge_mask = 0;
514 for (node = stage->matches; node; node = node->next) {
517 if (!match->channel->enabled)
518 continue; /* Ignore disabled channel. */
520 idx = match->channel->index;
523 if (idx < 0 || idx >= devc->model->num_channels) {
524 sr_err("Channel index %d out of range.", idx);
525 return SR_ERR_BUG; /* Should not happen. */
527 if (trg != SR_TRIGGER_ZERO
528 && trg != SR_TRIGGER_ONE
529 && trg != SR_TRIGGER_RISING
530 && trg != SR_TRIGGER_FALLING) {
531 sr_err("Unsupported trigger match for CH%d.", idx + 1);
534 level_bit = (trg == SR_TRIGGER_ONE
535 || trg == SR_TRIGGER_RISING) ? 1 : 0;
536 type_bit = (trg == SR_TRIGGER_RISING
537 || trg == SR_TRIGGER_FALLING) ? 1 : 0;
539 trigger_mask |= UINT64_C(1) << idx;
540 trigger_values |= level_bit << idx;
541 trigger_edge_mask |= type_bit << idx;
543 devc->trigger_mask = trigger_mask;
544 devc->trigger_values = trigger_values;
545 devc->trigger_edge_mask = trigger_edge_mask;
550 static int config_commit(const struct sr_dev_inst *sdi)
552 struct dev_context *devc;
557 if (devc->acquisition) {
558 sr_err("Acquisition still in progress?");
562 ret = prepare_trigger_masks(sdi);
566 ret = (*devc->model->apply_fpga_config)(sdi);
568 sr_err("Failed to apply FPGA configuration.");
575 static int config_list(uint32_t key, GVariant **data,
576 const struct sr_dev_inst *sdi, const struct sr_channel_group *cg)
578 struct dev_context *devc;
580 devc = (sdi) ? sdi->priv : NULL;
583 case SR_CONF_SCAN_OPTIONS:
584 case SR_CONF_DEVICE_OPTIONS:
585 return std_opts_config_list(key, data, sdi, cg,
586 ARRAY_AND_SIZE(scanopts), ARRAY_AND_SIZE(drvopts),
587 (devc) ? devc->model->devopts : NULL,
588 (devc) ? devc->model->num_devopts : 0);
593 if (!has_devopt(devc->model, key | SR_CONF_LIST))
597 case SR_CONF_SAMPLERATE:
598 *data = std_gvar_samplerates(devc->model->samplerates, devc->model->num_samplerates);
600 case SR_CONF_TRIGGER_MATCH:
601 *data = std_gvar_array_i32(ARRAY_AND_SIZE(trigger_matches));
603 case SR_CONF_TRIGGER_SOURCE:
604 *data = g_variant_new_strv(ARRAY_AND_SIZE(trigger_sources));
606 case SR_CONF_TRIGGER_SLOPE:
607 case SR_CONF_CLOCK_EDGE:
608 *data = g_variant_new_strv(ARRAY_AND_SIZE(signal_edges));
611 /* Must not happen for a key listed in devopts. */
618 /* Set up the device hardware to begin capturing samples as soon as the
619 * configured trigger conditions are met, or immediately if no triggers
622 static int dev_acquisition_start(const struct sr_dev_inst *sdi)
624 return lwla_start_acquisition(sdi);
627 static int dev_acquisition_stop(struct sr_dev_inst *sdi)
629 struct dev_context *devc;
633 if (devc->state != STATE_IDLE && !devc->cancel_requested) {
634 devc->cancel_requested = TRUE;
635 sr_dbg("Requesting cancel.");
641 static struct sr_dev_driver sysclk_lwla_driver_info = {
642 .name = "sysclk-lwla",
643 .longname = "SysClk LWLA series",
646 .cleanup = std_cleanup,
648 .dev_list = std_dev_list,
649 .dev_clear = std_dev_clear,
650 .config_get = config_get,
651 .config_set = config_set,
652 .config_channel_set = config_channel_set,
653 .config_commit = config_commit,
654 .config_list = config_list,
655 .dev_open = dev_open,
656 .dev_close = dev_close,
657 .dev_acquisition_start = dev_acquisition_start,
658 .dev_acquisition_stop = dev_acquisition_stop,
661 SR_REGISTER_DEV_DRIVER(sysclk_lwla_driver_info);