#include <inttypes.h>
#include <glib.h>
#include <libusb.h>
+#include <sigrok.h>
#include "config.h"
-#include "sigrok.h"
#define USB_VENDOR 0x0925
#define USB_PRODUCT 0x3881
#define NUM_PROBES 8
#define NUM_TRIGGER_STAGES 4
#define TRIGGER_TYPES "01"
-#define FIRMWARE FIRMWARE_DIR "/saleae-logic.firmware"
+#define FIRMWARE FIRMWARE_DIR "/saleae-logic.fw"
/* delay in ms */
#define FIRMWARE_RENUM_DELAY 2000
#define NUM_SIMUL_TRANSFERS 10
#define MAX_EMPTY_TRANSFERS (NUM_SIMUL_TRANSFERS * 2)
-/* software trigger implementation: positive values indicate trigger stage */
+/* Software trigger implementation: positive values indicate trigger stage. */
#define TRIGGER_FIRED -1
/* There is only one model Saleae Logic, and this is what it supports: */
* upgrade -- this is like a global lock. No device will open until a proper
* delay after the last device was upgraded.
*/
-GTimeVal firmware_updated = { 0 };
+GTimeVal firmware_updated = { 0, 0 };
static libusb_context *usb_context = NULL;
static uint8_t trigger_mask[NUM_TRIGGER_STAGES] = { 0 };
static uint8_t trigger_value[NUM_TRIGGER_STAGES] = { 0 };
static uint8_t trigger_buffer[NUM_TRIGGER_STAGES] = { 0 };
+
int trigger_stage = TRIGGER_FIRED;
static int hw_set_configuration(int device_index, int capability, void *value);
+static void hw_stop_acquisition(int device_index, gpointer session_device_id);
-/* returns 1 if the device's configuration profile match the Logic firmware's
- * configuration, 0 otherwise
+/*
+ * Returns 1 if the device's configuration profile match the Logic firmware's
+ * configuration, 0 otherwise.
*/
int check_conf_profile(libusb_device *dev)
{
return ret;
}
+static int opendev2(int device_index, struct sigrok_device_instance **sdi,
+ libusb_device *dev, struct libusb_device_descriptor *des,
+ int *skip)
+{
+ int err;
+
+ if ((err = libusb_get_device_descriptor(dev, des))) {
+ g_warning("failed to get device descriptor: %d", err);
+ return -1;
+ }
+
+ if (des->idVendor != USB_VENDOR || des->idProduct != USB_PRODUCT)
+ return 0;
+
+ if (*skip != device_index) {
+ /* Skip devices of this type that aren't the one we want. */
+ *skip += 1;
+ return 0;
+ }
+
+ /*
+ * Should check the bus here, since we know that already. But what are
+ * we going to do if it doesn't match after the right number of skips?
+ */
+ if (!(err = libusb_open(dev, &((*sdi)->usb->devhdl)))) {
+ (*sdi)->usb->address = libusb_get_device_address(dev);
+ (*sdi)->status = ST_ACTIVE;
+ g_message("opened device %d on %d.%d interface %d",
+ (*sdi)->index, (*sdi)->usb->bus,
+ (*sdi)->usb->address, USB_INTERFACE);
+ } else {
+ g_warning("failed to open device: %d", err);
+ *sdi = NULL;
+ }
+
+ return 0;
+}
+
+static int opendev3(struct sigrok_device_instance **sdi, libusb_device *dev,
+ struct libusb_device_descriptor *des)
+{
+ int err;
+
+ if ((err = libusb_get_device_descriptor(dev, des))) {
+ g_warning("failed to get device descriptor: %d", err);
+ return -1;
+ }
+
+ if (des->idVendor != USB_VENDOR || des->idProduct != USB_PRODUCT)
+ return 0;
+
+ if (libusb_get_bus_number(dev) == (*sdi)->usb->bus
+ && libusb_get_device_address(dev) == (*sdi)->usb->address) {
+ /* Found it. */
+ if (!(err = libusb_open(dev, &((*sdi)->usb->devhdl)))) {
+ (*sdi)->status = ST_ACTIVE;
+ g_message("opened device %d on %d.%d interface %d",
+ (*sdi)->index, (*sdi)->usb->bus,
+ (*sdi)->usb->address, USB_INTERFACE);
+ } else {
+ g_warning("failed to open device: %d", err);
+ *sdi = NULL;
+ }
+ }
+
+ return 0;
+}
+
struct sigrok_device_instance *sl_open_device(int device_index)
{
struct sigrok_device_instance *sdi;
*/
skip = 0;
for (i = 0; devlist[i]; i++) {
- if ((err = libusb_get_device_descriptor(devlist[i], &des))) {
- g_warning("failed to get device descriptor: %d",
- err);
- continue;
- }
-
- if (des.idVendor == USB_VENDOR
- && des.idProduct == USB_PRODUCT) {
- if (skip != device_index) {
- /*
- * Skip past devices of this type that
- * aren't the one we want.
- */
- skip++;
- continue;
- }
-
- /*
- * Should check the bus here, since we know
- * that already... but what are we going to do
- * if it doesn't match after the right number
- * of skips?
- */
- if (!(err = libusb_open(devlist[i],
- &(sdi->usb->devhdl)))) {
- sdi->usb->address = libusb_get_device_address(devlist [i]);
- sdi->status = ST_ACTIVE;
- g_message("opened device %d on %d.%d "
- "interface %d",
- sdi->index, sdi->usb->bus,
- sdi->usb->address, USB_INTERFACE);
- } else {
- g_warning("failed to open device: %d",
- err);
- sdi = NULL;
- }
- }
+ /* TODO: Error handling. */
+ err = opendev2(device_index, &sdi, devlist[i], &des,
+ &skip);
}
} else if (sdi->status == ST_INACTIVE) {
/*
*/
libusb_get_device_list(usb_context, &devlist);
for (i = 0; devlist[i]; i++) {
- if ((err =
- libusb_get_device_descriptor(devlist[i], &des))) {
- g_warning("failed to get device descriptor: %d",
- err);
- continue;
- }
-
- if (des.idVendor == USB_VENDOR
- && des.idProduct == USB_PRODUCT) {
- if (libusb_get_bus_number(devlist[i]) ==
- sdi->usb->bus
- && libusb_get_device_address(devlist[i]) ==
- sdi->usb->address) {
- /* Found it. */
- if (!(err = libusb_open(devlist[i],
- &(sdi->usb->devhdl)))) {
- sdi->status = ST_ACTIVE;
- g_message("opened device %d on "
- "%d.%d interface %d",
- sdi->index, sdi->usb->bus,
- sdi->usb->address,
- USB_INTERFACE);
- } else {
- g_warning("failed to open device: %d", err);
- sdi = NULL;
- }
- }
- }
+ /* TODO: Error handling. */
+ err = opendev3(&sdi, devlist[i], &des);
}
} else {
/* Status must be ST_ACTIVE, i.e. already in use... */
int upload_firmware(libusb_device *dev)
{
- struct libusb_device_handle *hdl;
- int err;
-
- g_message("uploading firmware to device on %d.%d",
- libusb_get_bus_number(dev), libusb_get_device_address(dev));
-
- err = libusb_open(dev, &hdl);
- if (err != 0) {
- g_warning("failed to open device: %d", err);
- return 1;
- }
-
- err = libusb_set_configuration(hdl, USB_CONFIGURATION);
- if (err != 0) {
- g_warning("Unable to set configuration: %d", err);
- return 1;
- }
-
- if ((ezusb_reset(hdl, 1)) < 0)
- return 1;
-
- if (ezusb_install_firmware(hdl, FIRMWARE) != 0)
- return 1;
+ int ret;
- if ((ezusb_reset(hdl, 0)) < 0)
+ ret = ezusb_upload_firmware(dev, USB_CONFIGURATION, FIRMWARE);
+ if (ret != 0)
return 1;
- libusb_close(hdl);
-
/* Remember when the last firmware update was done. */
g_get_current_time(&firmware_updated);
static void close_device(struct sigrok_device_instance *sdi)
{
- if (sdi->usb->devhdl) {
- g_message("closing device %d on %d.%d interface %d", sdi->index,
- sdi->usb->bus, sdi->usb->address, USB_INTERFACE);
- libusb_release_interface(sdi->usb->devhdl, USB_INTERFACE);
- libusb_close(sdi->usb->devhdl);
- sdi->usb->devhdl = NULL;
- sdi->status = ST_INACTIVE;
- }
+ if (sdi->usb->devhdl == NULL)
+ return;
+
+ g_message("closing device %d on %d.%d interface %d", sdi->index,
+ sdi->usb->bus, sdi->usb->address, USB_INTERFACE);
+ libusb_release_interface(sdi->usb->devhdl, USB_INTERFACE);
+ libusb_close(sdi->usb->devhdl);
+ sdi->usb->devhdl = NULL;
+ sdi->status = ST_INACTIVE;
}
-static int configure_probes(GSList * probes)
+static int configure_probes(GSList *probes)
{
struct probe *probe;
GSList *l;
libusb_device **devlist;
int err, devcnt, i;
+ /* QUICK HACK */
+ deviceinfo = deviceinfo;
+
if (libusb_init(&usb_context) != 0) {
g_warning("Failed to initialize USB.");
return 0;
continue;
}
- if (des.idVendor == USB_VENDOR && des.idProduct == USB_PRODUCT) {
- /* Definitely a Saleae Logic... */
-
- sdi = sigrok_device_instance_new(devcnt,
- ST_INITIALIZING, USB_VENDOR_NAME,
- USB_MODEL_NAME, USB_MODEL_VERSION);
- if (!sdi)
- return 0;
- device_instances =
- g_slist_append(device_instances, sdi);
-
- if (check_conf_profile(devlist[i]) == 0) {
- if (upload_firmware(devlist[i]) > 0)
- /*
- * Continue on the off chance that the
- * device is in a working state.
- * TODO: Could maybe try a USB reset,
- * or uploading the firmware again.
- */
- g_warning("firmware upload failed for device %d", devcnt);
-
- sdi->usb = usb_device_instance_new
- (libusb_get_bus_number(devlist[i]), 0, NULL);
- } else {
- /*
- * Already has the firmware on it, so fix the
- * new address.
- */
- sdi->usb = usb_device_instance_new
- (libusb_get_bus_number(devlist[i]),
- libusb_get_device_address(devlist[i]),
- NULL);
- }
- devcnt++;
+ if (des.idVendor != USB_VENDOR || des.idProduct != USB_PRODUCT)
+ continue; /* Not a Saleae Logic... */
+
+ sdi = sigrok_device_instance_new(devcnt, ST_INITIALIZING,
+ USB_VENDOR_NAME, USB_MODEL_NAME, USB_MODEL_VERSION);
+ if (!sdi)
+ return 0;
+ device_instances = g_slist_append(device_instances, sdi);
+
+ if (check_conf_profile(devlist[i]) == 0) {
+ /*
+ * Continue on the off chance that the device is in a
+ * working state. TODO: Could maybe try a USB reset,
+ * or uploading the firmware again.
+ */
+ if (upload_firmware(devlist[i]) > 0)
+ g_warning("firmware upload failed for "
+ "device %d", devcnt);
+
+ sdi->usb = usb_device_instance_new
+ (libusb_get_bus_number(devlist[i]), 0, NULL);
+ } else {
+ /* Already has the firmware, so fix the new address. */
+ sdi->usb = usb_device_instance_new
+ (libusb_get_bus_number(devlist[i]),
+ libusb_get_device_address(devlist[i]), NULL);
}
+ devcnt++;
}
libusb_free_device_list(devlist, 1);
if (cur_samplerate == 0) {
/* Samplerate hasn't been set; default to the slowest one. */
if (hw_set_configuration(device_index, HWCAP_SAMPLERATE,
- &supported_samplerates[0]) == SIGROK_ERR)
+ &supported_samplerates[0]) == SIGROK_ERR)
return SIGROK_ERR;
}
if (supported_samplerates[i] == 0)
return SIGROK_ERR_SAMPLERATE;
- divider = (uint8_t) (48 / (float)(samplerate / 1000000)) - 1;
+ divider = (uint8_t) (48 / (samplerate / 1000000.0)) - 1;
g_message("setting samplerate to %" PRIu64 " Hz (divider %d)",
samplerate, divider);
{
struct timeval tv;
+ /* QUICK HACK */
+ fd = fd;
+ revents = revents;
+ user_data = user_data;
+
tv.tv_sec = tv.tv_usec = 0;
libusb_handle_events_timeout(usb_context, &tv);
return TRUE;
}
+static void trigger_helper(int i, unsigned char *cur_buf,
+ struct datafeed_packet *packet, void *user_data,
+ int *trigger_offset)
+{
+ if ((cur_buf[i] & trigger_mask[trigger_stage])
+ == trigger_value[trigger_stage]) {
+ /* Match on this trigger stage. */
+ trigger_buffer[trigger_stage] = cur_buf[i];
+ trigger_stage++;
+ if (trigger_stage == NUM_TRIGGER_STAGES
+ || trigger_mask[trigger_stage] == 0) {
+ /* Match on all trigger stages, we're done. */
+ *trigger_offset = i + 1;
+
+ /*
+ * TODO: Send pre-trigger buffer to session bus.
+ * Tell the frontend we hit the trigger here.
+ */
+ packet->type = DF_TRIGGER;
+ packet->length = 0;
+ session_bus(user_data, packet);
+
+ /*
+ * Send the samples that triggered it, since we're
+ * skipping past them.
+ */
+ packet->type = DF_LOGIC8;
+ packet->length = trigger_stage;
+ packet->payload = trigger_buffer;
+ session_bus(user_data, packet);
+ // break; // FIXME???
+
+ trigger_stage = TRIGGER_FIRED;
+ }
+ return;
+ }
+
+ /*
+ * We had a match before, but not in the next sample. However, we may
+ * have a match on this stage in the next bit -- trigger on 0001 will
+ * fail on seeing 00001, so we need to go back to stage 0 -- but at
+ * the next sample from the one that matched originally, which the
+ * counter increment at the end of the loop takes care of.
+ */
+ if (trigger_stage > 0) {
+ i -= trigger_stage;
+ if (i < -1)
+ i = -1; /* Oops, went back past this buffer. */
+ /* Reset trigger stage. */
+ trigger_stage = 0;
+ }
+}
+
void receive_transfer(struct libusb_transfer *transfer)
{
static int num_samples = 0;
int cur_buflen, trigger_offset, i;
unsigned char *cur_buf, *new_buf;
- if (transfer == NULL) {
- /* hw_stop_acquisition() is telling us to stop. */
+ /* hw_stop_acquisition() is telling us to stop. */
+ if (transfer == NULL)
num_samples = -1;
- }
+ /*
+ * If acquisition has already ended, just free any queued up
+ * transfer that come in.
+ */
if (num_samples == -1) {
- /*
- * Acquisition has already ended, just free any queued up
- * transfer that come in.
- */
- libusb_free_transfer(transfer);
- } else {
- g_message("receive_transfer(): status %d received %d bytes",
- transfer->status, transfer->actual_length);
-
- /* Save incoming transfer before reusing the transfer struct. */
- cur_buf = transfer->buffer;
- cur_buflen = transfer->actual_length;
- user_data = transfer->user_data;
-
- /* Fire off a new request. */
- new_buf = g_malloc(4096);
- transfer->buffer = new_buf;
- transfer->length = 4096;
- if (libusb_submit_transfer(transfer) != 0) {
- /* TODO: Stop session? */
- g_warning("eek");
- }
+ if (transfer)
+ libusb_free_transfer(transfer);
+ return;
+ }
- if (cur_buflen == 0) {
- empty_transfer_count++;
- if (empty_transfer_count > MAX_EMPTY_TRANSFERS) {
- /* The FX2 gave up. End the acquisition, the
- * frontend will work out that the samplecount
- * is short.
- */
- packet.type = DF_END;
- session_bus(user_data, &packet);
- num_samples = -1;
- }
- return;
- } else {
- empty_transfer_count = 0;
+ g_message("receive_transfer(): status %d received %d bytes",
+ transfer->status, transfer->actual_length);
+
+ /* Save incoming transfer before reusing the transfer struct. */
+ cur_buf = transfer->buffer;
+ cur_buflen = transfer->actual_length;
+ user_data = transfer->user_data;
+
+ /* Fire off a new request. */
+ new_buf = g_malloc(4096);
+ transfer->buffer = new_buf;
+ transfer->length = 4096;
+ if (libusb_submit_transfer(transfer) != 0) {
+ /* TODO: Stop session? */
+ g_warning("eek");
+ }
+
+ if (cur_buflen == 0) {
+ empty_transfer_count++;
+ if (empty_transfer_count > MAX_EMPTY_TRANSFERS) {
+ /*
+ * The FX2 gave up. End the acquisition, the frontend
+ * will work out that the samplecount is short.
+ */
+ hw_stop_acquisition(-1, user_data);
}
+ return;
+ } else {
+ empty_transfer_count = 0;
+ }
- trigger_offset = 0;
- if (trigger_stage >= 0) {
- for (i = 0; i < cur_buflen; i++) {
- if ((cur_buf[i] & trigger_mask[trigger_stage])
- == trigger_value[trigger_stage]) {
- /* Match on this trigger stage. */
- trigger_buffer[trigger_stage] =
- cur_buf[i];
- trigger_stage++;
- if (trigger_stage == NUM_TRIGGER_STAGES
- || trigger_mask[trigger_stage] == 0) {
- /* Match on all trigger stages, we're done */
- trigger_offset = i + 1;
-
- /* TODO: Send pre-trigger buffer to session bus. Tell the frontend we hit the trigger here. */
- packet.type = DF_TRIGGER;
- packet.length = 0;
- session_bus(user_data, &packet);
-
- /* Send the samples that triggered it, since we're skipping past them. */
- packet.type = DF_LOGIC8;
- packet.length = trigger_stage;
- packet.payload = trigger_buffer;
- session_bus(user_data, &packet);
- break;
-
- trigger_stage = TRIGGER_FIRED;
- }
- } else if (trigger_stage > 0) {
- /*
- * We had a match before, but not in the next sample. However, we may
- * have a match on this stage in the next bit -- trigger on 0001 will
- * fail on seeing 00001, so we need to go back to stage 0 -- but at
- * the next sample from the one that matched originally, which the
- * counter increment at the end of the loop takes care of.
- */
- i -= trigger_stage;
- if (i < -1)
- /* Oops, went back past this buffer. */
- i = -1;
- /* Reset trigger stage. */
- trigger_stage = 0;
- }
- }
+ trigger_offset = 0;
+ if (trigger_stage >= 0) {
+ for (i = 0; i < cur_buflen; i++) {
+ trigger_helper(i, cur_buf, &packet, user_data,
+ &trigger_offset);
}
+ }
- if (trigger_stage == TRIGGER_FIRED) {
- /* Send the incoming transfer to the session bus. */
- packet.type = DF_LOGIC8;
- packet.length = cur_buflen - trigger_offset;
- packet.payload = cur_buf + trigger_offset;
- session_bus(user_data, &packet);
- g_free(cur_buf);
-
- num_samples += cur_buflen;
- if (num_samples > limit_samples) {
- /* End the acquisition. */
- packet.type = DF_END;
- session_bus(user_data, &packet);
- num_samples = -1;
- }
- } else {
- /*
- * TODO: Buffer pre-trigger data in capture
- * ratio-sized buffer.
- */
+ if (trigger_stage == TRIGGER_FIRED) {
+ /* Send the incoming transfer to the session bus. */
+ packet.type = DF_LOGIC8;
+ packet.length = cur_buflen - trigger_offset;
+ packet.payload = cur_buf + trigger_offset;
+ session_bus(user_data, &packet);
+ g_free(cur_buf);
+
+ num_samples += cur_buflen;
+ if ((unsigned int)num_samples > limit_samples) {
+ hw_stop_acquisition(-1, user_data);
}
+ } else {
+ /*
+ * TODO: Buffer pre-trigger data in capture
+ * ratio-sized buffer.
+ */
}
}
lupfd = libusb_get_pollfds(usb_context);
for (i = 0; lupfd[i]; i++)
- source_add(lupfd[i]->fd, lupfd[i]->events, -1, receive_data,
+ source_add(lupfd[i]->fd, lupfd[i]->events, 40, receive_data,
NULL);
free(lupfd);
{
struct datafeed_packet packet;
+ /* QUICK HACK */
+ device_index = device_index;
+
packet.type = DF_END;
session_bus(session_device_id, &packet);