la8: Adapt to new driver conventions.

This commit is contained in:
Uwe Hermann 2012-10-27 21:27:15 +02:00
parent 9eb2bb9601
commit f3a35908ef
3 changed files with 122 additions and 113 deletions

View File

@ -26,7 +26,7 @@
#include "driver.h" #include "driver.h"
SR_PRIV struct sr_dev_driver chronovu_la8_driver_info; SR_PRIV struct sr_dev_driver chronovu_la8_driver_info;
static struct sr_dev_driver *cdi = &chronovu_la8_driver_info; static struct sr_dev_driver *di = &chronovu_la8_driver_info;
/* /*
* The ChronoVu LA8 can have multiple PIDs. Older versions shipped with * The ChronoVu LA8 can have multiple PIDs. Older versions shipped with
@ -39,7 +39,7 @@ static const uint16_t usb_pids[] = {
/* Function prototypes. */ /* Function prototypes. */
static int hw_dev_acquisition_stop(const struct sr_dev_inst *sdi, static int hw_dev_acquisition_stop(const struct sr_dev_inst *sdi,
void *cb_data); void *cb_data);
static int clear_instances(void) static int clear_instances(void)
{ {
@ -48,13 +48,13 @@ static int clear_instances(void)
struct drv_context *drvc; struct drv_context *drvc;
struct dev_context *devc; struct dev_context *devc;
drvc = cdi->priv; drvc = di->priv;
/* Properly close all devices. */ /* Properly close all devices. */
for (l = drvc->instances; l; l = l->next) { for (l = drvc->instances; l; l = l->next) {
if (!(sdi = l->data)) { if (!(sdi = l->data)) {
/* Log error, but continue cleaning up the rest. */ /* Log error, but continue cleaning up the rest. */
sr_err("la8: %s: sdi was NULL, continuing", __func__); sr_err("%s: sdi was NULL, continuing.", __func__);
continue; continue;
} }
if (sdi->priv) { if (sdi->priv) {
@ -74,10 +74,11 @@ static int hw_init(void)
struct drv_context *drvc; struct drv_context *drvc;
if (!(drvc = g_try_malloc0(sizeof(struct drv_context)))) { if (!(drvc = g_try_malloc0(sizeof(struct drv_context)))) {
sr_err("chronovu-la8: driver context malloc failed."); sr_err("Driver context malloc failed.");
return SR_ERR; return SR_ERR_MALLOC;
} }
cdi->priv = drvc;
di->priv = drvc;
return SR_OK; return SR_OK;
} }
@ -93,12 +94,13 @@ static GSList *hw_scan(GSList *options)
int ret; int ret;
(void)options; (void)options;
drvc = cdi->priv;
drvc = di->priv;
devices = NULL; devices = NULL;
/* Allocate memory for our private device context. */ /* Allocate memory for our private device context. */
if (!(devc = g_try_malloc(sizeof(struct dev_context)))) { if (!(devc = g_try_malloc(sizeof(struct dev_context)))) {
sr_err("la8: %s: struct context malloc failed", __func__); sr_err("Device context malloc failed.");
goto err_free_nothing; goto err_free_nothing;
} }
@ -121,24 +123,24 @@ static GSList *hw_scan(GSList *options)
/* Allocate memory where we'll store the de-mangled data. */ /* Allocate memory where we'll store the de-mangled data. */
if (!(devc->final_buf = g_try_malloc(SDRAM_SIZE))) { if (!(devc->final_buf = g_try_malloc(SDRAM_SIZE))) {
sr_err("la8: %s: final_buf malloc failed", __func__); sr_err("final_buf malloc failed.");
goto err_free_devc; goto err_free_devc;
} }
/* Allocate memory for the FTDI context (ftdic) and initialize it. */ /* Allocate memory for the FTDI context (ftdic) and initialize it. */
if (!(devc->ftdic = ftdi_new())) { if (!(devc->ftdic = ftdi_new())) {
sr_err("la8: %s: ftdi_new failed", __func__); sr_err("%s: ftdi_new failed.", __func__);
goto err_free_final_buf; goto err_free_final_buf;
} }
/* Check for the device and temporarily open it. */ /* Check for the device and temporarily open it. */
for (i = 0; i < ARRAY_SIZE(usb_pids); i++) { for (i = 0; i < ARRAY_SIZE(usb_pids); i++) {
sr_dbg("la8: Probing for VID/PID %04x:%04x.", USB_VENDOR_ID, sr_dbg("Probing for VID/PID %04x:%04x.", USB_VENDOR_ID,
usb_pids[i]); usb_pids[i]);
ret = ftdi_usb_open_desc(devc->ftdic, USB_VENDOR_ID, ret = ftdi_usb_open_desc(devc->ftdic, USB_VENDOR_ID,
usb_pids[i], USB_DESCRIPTION, NULL); usb_pids[i], USB_DESCRIPTION, NULL);
if (ret == 0) { if (ret == 0) {
sr_dbg("la8: Found LA8 device (%04x:%04x).", sr_dbg("Found LA8 device (%04x:%04x).",
USB_VENDOR_ID, usb_pids[i]); USB_VENDOR_ID, usb_pids[i]);
devc->usb_pid = usb_pids[i]; devc->usb_pid = usb_pids[i];
} }
@ -151,15 +153,15 @@ static GSList *hw_scan(GSList *options)
sdi = sr_dev_inst_new(0, SR_ST_INITIALIZING, sdi = sr_dev_inst_new(0, SR_ST_INITIALIZING,
USB_VENDOR_NAME, USB_MODEL_NAME, USB_MODEL_VERSION); USB_VENDOR_NAME, USB_MODEL_NAME, USB_MODEL_VERSION);
if (!sdi) { if (!sdi) {
sr_err("la8: %s: sr_dev_inst_new failed", __func__); sr_err("%s: sr_dev_inst_new failed.", __func__);
goto err_close_ftdic; goto err_close_ftdic;
} }
sdi->driver = cdi; sdi->driver = di;
sdi->priv = devc; sdi->priv = devc;
for (i = 0; probe_names[i]; i++) { for (i = 0; probe_names[i]; i++) {
if (!(probe = sr_probe_new(i, SR_PROBE_ANALOG, TRUE, if (!(probe = sr_probe_new(i, SR_PROBE_ANALOG, TRUE,
probe_names[i]))) probe_names[i])))
return NULL; return NULL;
sdi->probes = g_slist_append(sdi->probes, probe); sdi->probes = g_slist_append(sdi->probes, probe);
} }
@ -167,7 +169,7 @@ static GSList *hw_scan(GSList *options)
devices = g_slist_append(devices, sdi); devices = g_slist_append(devices, sdi);
drvc->instances = g_slist_append(drvc->instances, sdi); drvc->instances = g_slist_append(drvc->instances, sdi);
sr_spew("la8: Device init successful."); sr_spew("Device init successful.");
/* Close device. We'll reopen it again when we need it. */ /* Close device. We'll reopen it again when we need it. */
(void) la8_close(devc); /* Log, but ignore errors. */ (void) la8_close(devc); /* Log, but ignore errors. */
@ -191,7 +193,7 @@ static GSList *hw_dev_list(void)
{ {
struct drv_context *drvc; struct drv_context *drvc;
drvc = cdi->priv; drvc = di->priv;
return drvc->instances; return drvc->instances;
} }
@ -202,40 +204,40 @@ static int hw_dev_open(struct sr_dev_inst *sdi)
int ret; int ret;
if (!(devc = sdi->priv)) { if (!(devc = sdi->priv)) {
sr_err("la8: %s: sdi->priv was NULL", __func__); sr_err("%s: sdi->priv was NULL.", __func__);
return SR_ERR_BUG; return SR_ERR_BUG;
} }
sr_dbg("la8: Opening LA8 device (%04x:%04x).", USB_VENDOR_ID, sr_dbg("Opening LA8 device (%04x:%04x).", USB_VENDOR_ID,
devc->usb_pid); devc->usb_pid);
/* Open the device. */ /* Open the device. */
if ((ret = ftdi_usb_open_desc(devc->ftdic, USB_VENDOR_ID, if ((ret = ftdi_usb_open_desc(devc->ftdic, USB_VENDOR_ID,
devc->usb_pid, USB_DESCRIPTION, NULL)) < 0) { devc->usb_pid, USB_DESCRIPTION, NULL)) < 0) {
sr_err("la8: %s: ftdi_usb_open_desc: (%d) %s", sr_err("%s: ftdi_usb_open_desc: (%d) %s",
__func__, ret, ftdi_get_error_string(devc->ftdic)); __func__, ret, ftdi_get_error_string(devc->ftdic));
(void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */ (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
return SR_ERR; return SR_ERR;
} }
sr_dbg("la8: Device opened successfully."); sr_dbg("Device opened successfully.");
/* Purge RX/TX buffers in the FTDI chip. */ /* Purge RX/TX buffers in the FTDI chip. */
if ((ret = ftdi_usb_purge_buffers(devc->ftdic)) < 0) { if ((ret = ftdi_usb_purge_buffers(devc->ftdic)) < 0) {
sr_err("la8: %s: ftdi_usb_purge_buffers: (%d) %s", sr_err("%s: ftdi_usb_purge_buffers: (%d) %s",
__func__, ret, ftdi_get_error_string(devc->ftdic)); __func__, ret, ftdi_get_error_string(devc->ftdic));
(void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */ (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
goto err_dev_open_close_ftdic; goto err_dev_open_close_ftdic;
} }
sr_dbg("la8: FTDI buffers purged successfully."); sr_dbg("FTDI buffers purged successfully.");
/* Enable flow control in the FTDI chip. */ /* Enable flow control in the FTDI chip. */
if ((ret = ftdi_setflowctrl(devc->ftdic, SIO_RTS_CTS_HS)) < 0) { if ((ret = ftdi_setflowctrl(devc->ftdic, SIO_RTS_CTS_HS)) < 0) {
sr_err("la8: %s: ftdi_setflowcontrol: (%d) %s", sr_err("%s: ftdi_setflowcontrol: (%d) %s",
__func__, ret, ftdi_get_error_string(devc->ftdic)); __func__, ret, ftdi_get_error_string(devc->ftdic));
(void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */ (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
goto err_dev_open_close_ftdic; goto err_dev_open_close_ftdic;
} }
sr_dbg("la8: FTDI flow control enabled successfully."); sr_dbg("FTDI flow control enabled successfully.");
/* Wait 100ms. */ /* Wait 100ms. */
g_usleep(100 * 1000); g_usleep(100 * 1000);
@ -254,22 +256,22 @@ static int hw_dev_close(struct sr_dev_inst *sdi)
struct dev_context *devc; struct dev_context *devc;
if (!(devc = sdi->priv)) { if (!(devc = sdi->priv)) {
sr_err("la8: %s: sdi->priv was NULL", __func__); sr_err("%s: sdi->priv was NULL.", __func__);
return SR_ERR_BUG; return SR_ERR_BUG;
} }
sr_dbg("la8: Closing device."); sr_dbg("Closing device.");
if (sdi->status == SR_ST_ACTIVE) { if (sdi->status == SR_ST_ACTIVE) {
sr_dbg("la8: Status ACTIVE, closing device."); sr_dbg("Status ACTIVE, closing device.");
(void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */ (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
} else { } else {
sr_spew("la8: Status not ACTIVE, nothing to do."); sr_spew("Status not ACTIVE, nothing to do.");
} }
sdi->status = SR_ST_INACTIVE; sdi->status = SR_ST_INACTIVE;
sr_dbg("la8: Freeing sample buffer."); sr_dbg("Freeing sample buffer.");
g_free(devc->final_buf); g_free(devc->final_buf);
return SR_OK; return SR_OK;
@ -277,9 +279,10 @@ static int hw_dev_close(struct sr_dev_inst *sdi)
static int hw_cleanup(void) static int hw_cleanup(void)
{ {
if (!di->priv) {
if (!cdi->priv) sr_err("%s: di->priv was NULL.", __func__);
return SR_OK; return SR_ERR_BUG;
}
clear_instances(); clear_instances();
@ -287,7 +290,7 @@ static int hw_cleanup(void)
} }
static int hw_info_get(int info_id, const void **data, static int hw_info_get(int info_id, const void **data,
const struct sr_dev_inst *sdi) const struct sr_dev_inst *sdi)
{ {
struct dev_context *devc; struct dev_context *devc;
@ -297,28 +300,28 @@ static int hw_info_get(int info_id, const void **data,
break; break;
case SR_DI_NUM_PROBES: case SR_DI_NUM_PROBES:
*data = GINT_TO_POINTER(NUM_PROBES); *data = GINT_TO_POINTER(NUM_PROBES);
sr_spew("la8: %s: Returning number of probes: %d.", __func__, sr_spew("%s: Returning number of probes: %d.", __func__,
NUM_PROBES); NUM_PROBES);
break; break;
case SR_DI_PROBE_NAMES: case SR_DI_PROBE_NAMES:
*data = probe_names; *data = probe_names;
sr_spew("la8: %s: Returning probenames.", __func__); sr_spew("%s: Returning probenames.", __func__);
break; break;
case SR_DI_SAMPLERATES: case SR_DI_SAMPLERATES:
fill_supported_samplerates_if_needed(); fill_supported_samplerates_if_needed();
*data = &samplerates; *data = &samplerates;
sr_spew("la8: %s: Returning samplerates.", __func__); sr_spew("%s: Returning samplerates.", __func__);
break; break;
case SR_DI_TRIGGER_TYPES: case SR_DI_TRIGGER_TYPES:
*data = (char *)TRIGGER_TYPES; *data = (char *)TRIGGER_TYPES;
sr_spew("la8: %s: Returning trigger types: %s.", __func__, sr_spew("%s: Returning trigger types: %s.", __func__,
TRIGGER_TYPES); TRIGGER_TYPES);
break; break;
case SR_DI_CUR_SAMPLERATE: case SR_DI_CUR_SAMPLERATE:
if (sdi) { if (sdi) {
devc = sdi->priv; devc = sdi->priv;
*data = &devc->cur_samplerate; *data = &devc->cur_samplerate;
sr_spew("la8: %s: Returning samplerate: %" PRIu64 "Hz.", sr_spew("%s: Returning samplerate: %" PRIu64 "Hz.",
__func__, devc->cur_samplerate); __func__, devc->cur_samplerate);
} else } else
return SR_ERR; return SR_ERR;
@ -336,37 +339,37 @@ static int hw_dev_config_set(const struct sr_dev_inst *sdi, int hwcap,
struct dev_context *devc; struct dev_context *devc;
if (!(devc = sdi->priv)) { if (!(devc = sdi->priv)) {
sr_err("la8: %s: sdi->priv was NULL", __func__); sr_err("%s: sdi->priv was NULL.", __func__);
return SR_ERR_BUG; return SR_ERR_BUG;
} }
switch (hwcap) { switch (hwcap) {
case SR_HWCAP_SAMPLERATE: case SR_HWCAP_SAMPLERATE:
if (set_samplerate(sdi, *(const uint64_t *)value) == SR_ERR) { if (set_samplerate(sdi, *(const uint64_t *)value) == SR_ERR) {
sr_err("la8: %s: setting samplerate failed.", __func__); sr_err("%s: setting samplerate failed.", __func__);
return SR_ERR; return SR_ERR;
} }
sr_dbg("la8: SAMPLERATE = %" PRIu64, devc->cur_samplerate); sr_dbg("SAMPLERATE = %" PRIu64, devc->cur_samplerate);
break; break;
case SR_HWCAP_LIMIT_MSEC: case SR_HWCAP_LIMIT_MSEC:
if (*(const uint64_t *)value == 0) { if (*(const uint64_t *)value == 0) {
sr_err("la8: %s: LIMIT_MSEC can't be 0.", __func__); sr_err("%s: LIMIT_MSEC can't be 0.", __func__);
return SR_ERR; return SR_ERR;
} }
devc->limit_msec = *(const uint64_t *)value; devc->limit_msec = *(const uint64_t *)value;
sr_dbg("la8: LIMIT_MSEC = %" PRIu64, devc->limit_msec); sr_dbg("LIMIT_MSEC = %" PRIu64, devc->limit_msec);
break; break;
case SR_HWCAP_LIMIT_SAMPLES: case SR_HWCAP_LIMIT_SAMPLES:
if (*(const uint64_t *)value < MIN_NUM_SAMPLES) { if (*(const uint64_t *)value < MIN_NUM_SAMPLES) {
sr_err("la8: %s: LIMIT_SAMPLES too small.", __func__); sr_err("%s: LIMIT_SAMPLES too small.", __func__);
return SR_ERR; return SR_ERR;
} }
devc->limit_samples = *(const uint64_t *)value; devc->limit_samples = *(const uint64_t *)value;
sr_dbg("la8: LIMIT_SAMPLES = %" PRIu64, devc->limit_samples); sr_dbg("LIMIT_SAMPLES = %" PRIu64, devc->limit_samples);
break; break;
default: default:
/* Unknown capability, return SR_ERR. */ /* Unknown capability, return SR_ERR. */
sr_err("la8: %s: Unknown capability.", __func__); sr_err("%s: Unknown capability: %d.", __func__, hwcap);
return SR_ERR; return SR_ERR;
break; break;
} }
@ -380,28 +383,27 @@ static int receive_data(int fd, int revents, void *cb_data)
struct sr_dev_inst *sdi; struct sr_dev_inst *sdi;
struct dev_context *devc; struct dev_context *devc;
/* Avoid compiler errors. */
(void)fd; (void)fd;
(void)revents; (void)revents;
if (!(sdi = cb_data)) { if (!(sdi = cb_data)) {
sr_err("la8: %s: cb_data was NULL", __func__); sr_err("%s: cb_data was NULL.", __func__);
return FALSE; return FALSE;
} }
if (!(devc = sdi->priv)) { if (!(devc = sdi->priv)) {
sr_err("la8: %s: sdi->priv was NULL", __func__); sr_err("%s: sdi->priv was NULL.", __func__);
return FALSE; return FALSE;
} }
if (!devc->ftdic) { if (!devc->ftdic) {
sr_err("la8: %s: devc->ftdic was NULL", __func__); sr_err("%s: devc->ftdic was NULL.", __func__);
return FALSE; return FALSE;
} }
/* Get one block of data. */ /* Get one block of data. */
if ((ret = la8_read_block(devc)) < 0) { if ((ret = la8_read_block(devc)) < 0) {
sr_err("la8: %s: la8_read_block error: %d", __func__, ret); sr_err("%s: la8_read_block error: %d.", __func__, ret);
hw_dev_acquisition_stop(sdi, sdi); hw_dev_acquisition_stop(sdi, sdi);
return FALSE; return FALSE;
} }
@ -412,7 +414,7 @@ static int receive_data(int fd, int revents, void *cb_data)
return TRUE; return TRUE;
} }
sr_dbg("la8: Sampling finished, sending data to session bus now."); sr_dbg("Sampling finished, sending data to session bus now.");
/* All data was received and demangled, send it to the session bus. */ /* All data was received and demangled, send it to the session bus. */
for (i = 0; i < NUM_BLOCKS; i++) for (i = 0; i < NUM_BLOCKS; i++)
@ -424,7 +426,7 @@ static int receive_data(int fd, int revents, void *cb_data)
} }
static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi, static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
void *cb_data) void *cb_data)
{ {
struct dev_context *devc; struct dev_context *devc;
struct sr_datafeed_packet packet; struct sr_datafeed_packet packet;
@ -434,27 +436,27 @@ static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
int bytes_written; int bytes_written;
if (!(devc = sdi->priv)) { if (!(devc = sdi->priv)) {
sr_err("la8: %s: sdi->priv was NULL", __func__); sr_err("%s: sdi->priv was NULL.", __func__);
return SR_ERR_BUG; return SR_ERR_BUG;
} }
if (!devc->ftdic) { if (!devc->ftdic) {
sr_err("la8: %s: devc->ftdic was NULL", __func__); sr_err("%s: devc->ftdic was NULL.", __func__);
return SR_ERR_BUG; return SR_ERR_BUG;
} }
devc->divcount = samplerate_to_divcount(devc->cur_samplerate); devc->divcount = samplerate_to_divcount(devc->cur_samplerate);
if (devc->divcount == 0xff) { if (devc->divcount == 0xff) {
sr_err("la8: %s: invalid divcount/samplerate", __func__); sr_err("%s: Invalid divcount/samplerate.", __func__);
return SR_ERR; return SR_ERR;
} }
if (configure_probes(sdi) != SR_OK) { if (configure_probes(sdi) != SR_OK) {
sr_err("chronovu-la8: failed to configured probes"); sr_err("Failed to configure probes.");
return SR_ERR; return SR_ERR;
} }
sr_dbg("la8: Starting acquisition."); sr_dbg("Starting acquisition.");
/* Fill acquisition parameters into buf[]. */ /* Fill acquisition parameters into buf[]. */
buf[0] = devc->divcount; buf[0] = devc->divcount;
@ -466,19 +468,19 @@ static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
bytes_written = la8_write(devc, buf, 4); bytes_written = la8_write(devc, buf, 4);
if (bytes_written < 0) { if (bytes_written < 0) {
sr_err("la8: Acquisition failed to start."); sr_err("Acquisition failed to start: %d.", bytes_written);
return SR_ERR; return SR_ERR;
} else if (bytes_written != 4) { } else if (bytes_written != 4) {
sr_err("la8: Acquisition failed to start."); sr_err("Acquisition failed to start: %d.", bytes_written);
return SR_ERR; return SR_ERR;
} }
sr_dbg("la8: Acquisition started successfully."); sr_dbg("Acquisition started successfully.");
devc->session_dev_id = cb_data; devc->session_dev_id = cb_data;
/* Send header packet to the session bus. */ /* Send header packet to the session bus. */
sr_dbg("la8: Sending SR_DF_HEADER."); sr_dbg("Sending SR_DF_HEADER.");
packet.type = SR_DF_HEADER; packet.type = SR_DF_HEADER;
packet.payload = &header; packet.payload = &header;
header.feed_version = 1; header.feed_version = 1;
@ -505,17 +507,17 @@ static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
} }
static int hw_dev_acquisition_stop(const struct sr_dev_inst *sdi, static int hw_dev_acquisition_stop(const struct sr_dev_inst *sdi,
void *cb_data) void *cb_data)
{ {
struct sr_datafeed_packet packet; struct sr_datafeed_packet packet;
(void)sdi; (void)sdi;
sr_dbg("la8: Stopping acquisition."); sr_dbg("Stopping acquisition.");
sr_source_remove(-1); sr_source_remove(-1);
/* Send end packet to the session bus. */ /* Send end packet to the session bus. */
sr_dbg("la8: Sending SR_DF_END."); sr_dbg("Sending SR_DF_END.");
packet.type = SR_DF_END; packet.type = SR_DF_END;
sr_session_send(cb_data, &packet); sr_session_send(cb_data, &packet);

View File

@ -91,8 +91,7 @@ SR_PRIV int is_valid_samplerate(uint64_t samplerate)
return 1; return 1;
} }
sr_err("la8: %s: invalid samplerate (%" PRIu64 "Hz)", sr_err("Invalid samplerate (%" PRIu64 "Hz).", samplerate);
__func__, samplerate);
return 0; return 0;
} }
@ -110,13 +109,12 @@ SR_PRIV int is_valid_samplerate(uint64_t samplerate)
SR_PRIV uint8_t samplerate_to_divcount(uint64_t samplerate) SR_PRIV uint8_t samplerate_to_divcount(uint64_t samplerate)
{ {
if (samplerate == 0) { if (samplerate == 0) {
sr_err("la8: %s: samplerate was 0", __func__); sr_err("%s: samplerate was 0.", __func__);
return 0xff; return 0xff;
} }
if (!is_valid_samplerate(samplerate)) { if (!is_valid_samplerate(samplerate)) {
sr_err("la8: %s: can't get divcount, samplerate invalid", sr_err("%s: Can't get divcount, samplerate invalid.", __func__);
__func__);
return 0xff; return 0xff;
} }
@ -139,23 +137,23 @@ SR_PRIV int la8_write(struct dev_context *devc, uint8_t *buf, int size)
/* Note: Caller checked that devc and devc->ftdic != NULL. */ /* Note: Caller checked that devc and devc->ftdic != NULL. */
if (!buf) { if (!buf) {
sr_err("la8: %s: buf was NULL", __func__); sr_err("%s: buf was NULL.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
if (size < 0) { if (size < 0) {
sr_err("la8: %s: size was < 0", __func__); sr_err("%s: size was < 0.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
bytes_written = ftdi_write_data(devc->ftdic, buf, size); bytes_written = ftdi_write_data(devc->ftdic, buf, size);
if (bytes_written < 0) { if (bytes_written < 0) {
sr_err("la8: %s: ftdi_write_data: (%d) %s", __func__, sr_err("%s: ftdi_write_data: (%d) %s.", __func__,
bytes_written, ftdi_get_error_string(devc->ftdic)); bytes_written, ftdi_get_error_string(devc->ftdic));
(void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */ (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
} else if (bytes_written != size) { } else if (bytes_written != size) {
sr_err("la8: %s: bytes to write: %d, bytes written: %d", sr_err("%s: bytes to write: %d, bytes written: %d.",
__func__, size, bytes_written); __func__, size, bytes_written);
(void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */ (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
} }
@ -180,22 +178,22 @@ SR_PRIV int la8_read(struct dev_context *devc, uint8_t *buf, int size)
/* Note: Caller checked that devc and devc->ftdic != NULL. */ /* Note: Caller checked that devc and devc->ftdic != NULL. */
if (!buf) { if (!buf) {
sr_err("la8: %s: buf was NULL", __func__); sr_err("%s: buf was NULL.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
if (size <= 0) { if (size <= 0) {
sr_err("la8: %s: size was <= 0", __func__); sr_err("%s: size was <= 0.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
bytes_read = ftdi_read_data(devc->ftdic, buf, size); bytes_read = ftdi_read_data(devc->ftdic, buf, size);
if (bytes_read < 0) { if (bytes_read < 0) {
sr_err("la8: %s: ftdi_read_data: (%d) %s", __func__, sr_err("%s: ftdi_read_data: (%d) %s.", __func__,
bytes_read, ftdi_get_error_string(devc->ftdic)); bytes_read, ftdi_get_error_string(devc->ftdic));
} else if (bytes_read != size) { } else if (bytes_read != size) {
// sr_err("la8: %s: bytes to read: %d, bytes read: %d", // sr_err("%s: Bytes to read: %d, bytes read: %d.",
// __func__, size, bytes_read); // __func__, size, bytes_read);
} }
@ -207,17 +205,17 @@ SR_PRIV int la8_close(struct dev_context *devc)
int ret; int ret;
if (!devc) { if (!devc) {
sr_err("la8: %s: devc was NULL", __func__); sr_err("%s: devc was NULL.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
if (!devc->ftdic) { if (!devc->ftdic) {
sr_err("la8: %s: devc->ftdic was NULL", __func__); sr_err("%s: devc->ftdic was NULL.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
if ((ret = ftdi_usb_close(devc->ftdic)) < 0) { if ((ret = ftdi_usb_close(devc->ftdic)) < 0) {
sr_err("la8: %s: ftdi_usb_close: (%d) %s", sr_err("%s: ftdi_usb_close: (%d) %s.",
__func__, ret, ftdi_get_error_string(devc->ftdic)); __func__, ret, ftdi_get_error_string(devc->ftdic));
} }
@ -237,33 +235,33 @@ SR_PRIV int la8_close_usb_reset_sequencer(struct dev_context *devc)
int ret; int ret;
if (!devc) { if (!devc) {
sr_err("la8: %s: devc was NULL", __func__); sr_err("%s: devc was NULL.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
if (!devc->ftdic) { if (!devc->ftdic) {
sr_err("la8: %s: devc->ftdic was NULL", __func__); sr_err("%s: devc->ftdic was NULL.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
if (devc->ftdic->usb_dev) { if (devc->ftdic->usb_dev) {
/* Reset the LA8 sequencer logic, then wait 100ms. */ /* Reset the LA8 sequencer logic, then wait 100ms. */
sr_dbg("la8: Resetting sequencer logic."); sr_dbg("Resetting sequencer logic.");
(void) la8_write(devc, buf, 8); /* Ignore errors. */ (void) la8_write(devc, buf, 8); /* Ignore errors. */
g_usleep(100 * 1000); g_usleep(100 * 1000);
/* Purge FTDI buffers, then reset and close the FTDI device. */ /* Purge FTDI buffers, then reset and close the FTDI device. */
sr_dbg("la8: Purging buffers, resetting+closing FTDI device."); sr_dbg("Purging buffers, resetting+closing FTDI device.");
/* Log errors, but ignore them (i.e., don't abort). */ /* Log errors, but ignore them (i.e., don't abort). */
if ((ret = ftdi_usb_purge_buffers(devc->ftdic)) < 0) if ((ret = ftdi_usb_purge_buffers(devc->ftdic)) < 0)
sr_err("la8: %s: ftdi_usb_purge_buffers: (%d) %s", sr_err("%s: ftdi_usb_purge_buffers: (%d) %s.",
__func__, ret, ftdi_get_error_string(devc->ftdic)); __func__, ret, ftdi_get_error_string(devc->ftdic));
if ((ret = ftdi_usb_reset(devc->ftdic)) < 0) if ((ret = ftdi_usb_reset(devc->ftdic)) < 0)
sr_err("la8: %s: ftdi_usb_reset: (%d) %s", __func__, sr_err("%s: ftdi_usb_reset: (%d) %s.", __func__,
ret, ftdi_get_error_string(devc->ftdic)); ret, ftdi_get_error_string(devc->ftdic));
if ((ret = ftdi_usb_close(devc->ftdic)) < 0) if ((ret = ftdi_usb_close(devc->ftdic)) < 0)
sr_err("la8: %s: ftdi_usb_close: (%d) %s", __func__, sr_err("%s: ftdi_usb_close: (%d) %s.", __func__,
ret, ftdi_get_error_string(devc->ftdic)); ret, ftdi_get_error_string(devc->ftdic));
} }
@ -289,16 +287,16 @@ SR_PRIV int la8_reset(struct dev_context *devc)
int bytes_read; int bytes_read;
if (!devc) { if (!devc) {
sr_err("la8: %s: devc was NULL", __func__); sr_err("%s: devc was NULL.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
if (!devc->ftdic) { if (!devc->ftdic) {
sr_err("la8: %s: devc->ftdic was NULL", __func__); sr_err("%s: devc->ftdic was NULL.", __func__);
return SR_ERR_ARG; return SR_ERR_ARG;
} }
sr_dbg("la8: Resetting the device."); sr_dbg("Resetting the device.");
/* /*
* Purge pending read data from the FTDI hardware FIFO until * Purge pending read data from the FTDI hardware FIFO until
@ -314,7 +312,7 @@ SR_PRIV int la8_reset(struct dev_context *devc)
/* Reset the LA8 sequencer logic and close the USB port. */ /* Reset the LA8 sequencer logic and close the USB port. */
(void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */ (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
sr_dbg("la8: Device reset finished."); sr_dbg("Device reset finished.");
return SR_OK; return SR_OK;
} }
@ -335,7 +333,7 @@ SR_PRIV int configure_probes(const struct sr_dev_inst *sdi)
probe = (struct sr_probe *)l->data; probe = (struct sr_probe *)l->data;
if (!probe) { if (!probe) {
sr_err("la8: %s: probe was NULL", __func__); sr_err("%s: probe was NULL.", __func__);
return SR_ERR; return SR_ERR;
} }
@ -349,8 +347,8 @@ SR_PRIV int configure_probes(const struct sr_dev_inst *sdi)
/* Note: Must only be run if probe->trigger != NULL. */ /* Note: Must only be run if probe->trigger != NULL. */
if (probe->index < 0 || probe->index > 7) { if (probe->index < 0 || probe->index > 7) {
sr_err("la8: %s: invalid probe index %d, must be " sr_err("%s: Invalid probe index %d, must be "
"between 0 and 7", __func__, probe->index); "between 0 and 7.", __func__, probe->index);
return SR_ERR; return SR_ERR;
} }
@ -362,8 +360,8 @@ SR_PRIV int configure_probes(const struct sr_dev_inst *sdi)
/* Sanity check, LA8 only supports low/high trigger. */ /* Sanity check, LA8 only supports low/high trigger. */
if (*tc != '0' && *tc != '1') { if (*tc != '0' && *tc != '1') {
sr_err("la8: %s: invalid trigger '%c', only " sr_err("%s: Invalid trigger '%c', only "
"'0'/'1' supported", __func__, *tc); "'0'/'1' supported.", __func__, *tc);
return SR_ERR; return SR_ERR;
} }
@ -372,7 +370,7 @@ SR_PRIV int configure_probes(const struct sr_dev_inst *sdi)
} }
} }
sr_dbg("la8: trigger_mask = 0x%x, trigger_pattern = 0x%x", sr_dbg("Trigger mask = 0x%x, trigger pattern = 0x%x.",
devc->trigger_mask, devc->trigger_pattern); devc->trigger_mask, devc->trigger_pattern);
return SR_OK; return SR_OK;
@ -386,7 +384,7 @@ SR_PRIV int set_samplerate(const struct sr_dev_inst *sdi, uint64_t samplerate)
devc = sdi->priv; devc = sdi->priv;
sr_spew("la8: Trying to set samplerate to %" PRIu64 "Hz.", samplerate); sr_spew("Trying to set samplerate to %" PRIu64 "Hz.", samplerate);
fill_supported_samplerates_if_needed(); fill_supported_samplerates_if_needed();
@ -397,7 +395,7 @@ SR_PRIV int set_samplerate(const struct sr_dev_inst *sdi, uint64_t samplerate)
/* Set the new samplerate. */ /* Set the new samplerate. */
devc->cur_samplerate = samplerate; devc->cur_samplerate = samplerate;
sr_dbg("la8: Samplerate set to %" PRIu64 "Hz.", devc->cur_samplerate); sr_dbg("Samplerate set to %" PRIu64 "Hz.", devc->cur_samplerate);
return SR_OK; return SR_OK;
} }
@ -416,14 +414,14 @@ SR_PRIV int la8_read_block(struct dev_context *devc)
/* Note: Caller checked that devc and devc->ftdic != NULL. */ /* Note: Caller checked that devc and devc->ftdic != NULL. */
sr_spew("la8: Reading block %d.", devc->block_counter); sr_spew("Reading block %d.", devc->block_counter);
bytes_read = la8_read(devc, devc->mangled_buf, BS); bytes_read = la8_read(devc, devc->mangled_buf, BS);
/* If first block read got 0 bytes, retry until success or timeout. */ /* If first block read got 0 bytes, retry until success or timeout. */
if ((bytes_read == 0) && (devc->block_counter == 0)) { if ((bytes_read == 0) && (devc->block_counter == 0)) {
do { do {
sr_spew("la8: Reading block 0 (again)."); sr_spew("Reading block 0 (again).");
bytes_read = la8_read(devc, devc->mangled_buf, BS); bytes_read = la8_read(devc, devc->mangled_buf, BS);
/* TODO: How to handle read errors here? */ /* TODO: How to handle read errors here? */
now = time(NULL); now = time(NULL);
@ -432,13 +430,13 @@ SR_PRIV int la8_read_block(struct dev_context *devc)
/* Check if block read was successful or a timeout occured. */ /* Check if block read was successful or a timeout occured. */
if (bytes_read != BS) { if (bytes_read != BS) {
sr_err("la8: Trigger timed out. Bytes read: %d.", bytes_read); sr_err("Trigger timed out. Bytes read: %d.", bytes_read);
(void) la8_reset(devc); /* Ignore errors. */ (void) la8_reset(devc); /* Ignore errors. */
return SR_ERR; return SR_ERR;
} }
/* De-mangle the data. */ /* De-mangle the data. */
sr_spew("la8: Demangling block %d.", devc->block_counter); sr_spew("Demangling block %d.", devc->block_counter);
byte_offset = devc->block_counter * BS; byte_offset = devc->block_counter * BS;
m = byte_offset / (1024 * 1024); m = byte_offset / (1024 * 1024);
mi = m * (1024 * 1024); mi = m * (1024 * 1024);
@ -490,8 +488,8 @@ SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
/* If no trigger was found, send one SR_DF_LOGIC packet. */ /* If no trigger was found, send one SR_DF_LOGIC packet. */
if (trigger_point == -1) { if (trigger_point == -1) {
/* Send an SR_DF_LOGIC packet to the session bus. */ /* Send an SR_DF_LOGIC packet to the session bus. */
sr_spew("la8: sending SR_DF_LOGIC packet (%d bytes) for " sr_spew("Sending SR_DF_LOGIC packet (%d bytes) for "
"block %d", BS, block); "block %d.", BS, block);
packet.type = SR_DF_LOGIC; packet.type = SR_DF_LOGIC;
packet.payload = &logic; packet.payload = &logic;
logic.length = BS; logic.length = BS;
@ -513,8 +511,8 @@ SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
/* If at least one sample is located before the trigger... */ /* If at least one sample is located before the trigger... */
if (trigger_point > 0) { if (trigger_point > 0) {
/* Send pre-trigger SR_DF_LOGIC packet to the session bus. */ /* Send pre-trigger SR_DF_LOGIC packet to the session bus. */
sr_spew("la8: sending pre-trigger SR_DF_LOGIC packet, " sr_spew("Sending pre-trigger SR_DF_LOGIC packet, "
"start = %d, length = %d", block * BS, trigger_point); "start = %d, length = %d.", block * BS, trigger_point);
packet.type = SR_DF_LOGIC; packet.type = SR_DF_LOGIC;
packet.payload = &logic; packet.payload = &logic;
logic.length = trigger_point; logic.length = trigger_point;
@ -524,7 +522,7 @@ SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
} }
/* Send the SR_DF_TRIGGER packet to the session bus. */ /* Send the SR_DF_TRIGGER packet to the session bus. */
sr_spew("la8: sending SR_DF_TRIGGER packet, sample = %d", sr_spew("Sending SR_DF_TRIGGER packet, sample = %d.",
(block * BS) + trigger_point); (block * BS) + trigger_point);
packet.type = SR_DF_TRIGGER; packet.type = SR_DF_TRIGGER;
packet.payload = NULL; packet.payload = NULL;
@ -533,8 +531,8 @@ SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
/* If at least one sample is located after the trigger... */ /* If at least one sample is located after the trigger... */
if (trigger_point < (BS - 1)) { if (trigger_point < (BS - 1)) {
/* Send post-trigger SR_DF_LOGIC packet to the session bus. */ /* Send post-trigger SR_DF_LOGIC packet to the session bus. */
sr_spew("la8: sending post-trigger SR_DF_LOGIC packet, " sr_spew("Sending post-trigger SR_DF_LOGIC packet, "
"start = %d, length = %d", "start = %d, length = %d.",
(block * BS) + trigger_point, BS - trigger_point); (block * BS) + trigger_point, BS - trigger_point);
packet.type = SR_DF_LOGIC; packet.type = SR_DF_LOGIC;
packet.payload = &logic; packet.payload = &logic;

View File

@ -27,6 +27,15 @@
#include "libsigrok.h" #include "libsigrok.h"
#include "libsigrok-internal.h" #include "libsigrok-internal.h"
/* Message logging helpers with driver-specific prefix string. */
#define DRIVER_LOG_DOMAIN "la8: "
#define sr_log(l, s, args...) sr_log(l, DRIVER_LOG_DOMAIN s, ## args)
#define sr_spew(s, args...) sr_spew(DRIVER_LOG_DOMAIN s, ## args)
#define sr_dbg(s, args...) sr_dbg(DRIVER_LOG_DOMAIN s, ## args)
#define sr_info(s, args...) sr_info(DRIVER_LOG_DOMAIN s, ## args)
#define sr_warn(s, args...) sr_warn(DRIVER_LOG_DOMAIN s, ## args)
#define sr_err(s, args...) sr_err(DRIVER_LOG_DOMAIN s, ## args)
#define USB_VENDOR_ID 0x0403 #define USB_VENDOR_ID 0x0403
#define USB_DESCRIPTION "ChronoVu LA8" #define USB_DESCRIPTION "ChronoVu LA8"
#define USB_VENDOR_NAME "ChronoVu" #define USB_VENDOR_NAME "ChronoVu"