LA8: probeconfig/trigger support.

[libsigrok.git] / hardware / chronovu-la8 / chronovu-la8.c

diff --git a/hardware/chronovu-la8/chronovu-la8.c b/hardware/chronovu-la8/chronovu-la8.c
index 13f07b063a0fced7b42d814f8447f853c87365d5..42eea79dae49f674b045bf7e70079f2b62c140a6 100644 (file)
--- a/hardware/chronovu-la8/chronovu-la8.c
+++ b/hardware/chronovu-la8/chronovu-la8.c
@@ -19,6 +19,7 @@
  */
 
 #include <ftdi.h>
+#include <glib.h>
 #include <sigrok.h>
 #include <sigrok-internal.h>
 
@@ -396,6 +397,63 @@ static int la8_reset(struct la8 *la8)
        return SR_OK;
 }
 
+static int configure_probes(struct la8 *la8, GSList *probes)
+{
+       struct sr_probe *probe;
+       GSList *l;
+       uint8_t probe_bit;
+       char *tc;
+
+       la8->trigger_pattern = 0;
+       la8->trigger_mask = 0; /* Default to "don't care" for all probes. */
+
+       for (l = probes; l; l = l->next) {
+               probe = (struct sr_probe *)l->data;
+
+               if (!probe) {
+                       sr_err("la8: %s: probe was NULL", __func__);
+                       return SR_ERR;
+               }
+
+               /* Skip disabled probes. */
+               if (!probe->enabled)
+                       continue;
+
+               /* Skip (enabled) probes with no configured trigger. */
+               if (!probe->trigger)
+                       continue;
+
+               /* Note: Must only be run if probe->trigger != NULL. */
+               if (probe->index < 0 || probe->index > 7) {
+                       sr_err("la8: %s: invalid probe index %d, must be "
+                              "between 0 and 7", __func__, probe->index);
+                       return SR_ERR;
+               }
+
+               probe_bit = (1 << (probe->index - 1));
+
+               /* Configure the probe's trigger mask and trigger pattern. */
+               for (tc = probe->trigger; tc && *tc; tc++) {
+                       la8->trigger_mask |= probe_bit;
+
+                       /* Sanity check, LA8 only supports low/high trigger. */
+                       if (*tc != '0' && *tc != '1') {
+                               sr_err("la8: %s: invalid trigger '%c', only "
+                                      "'0'/'1' supported", __func__, *tc);
+                               return SR_ERR;
+                       }
+
+                       if (*tc == '1')
+                               la8->trigger_pattern |= probe_bit;
+               }
+       }
+
+       sr_dbg("la8: %s: trigger_mask = 0x%x, trigger_pattern = 0x%x",
+              __func__, la8->trigger_mask, la8->trigger_pattern);
+
+       return SR_OK;
+}
+
 static int hw_init(const char *deviceinfo)
 {
        int ret;
@@ -408,7 +466,7 @@ static int hw_init(const char *deviceinfo)
        deviceinfo = deviceinfo;
 
        /* Allocate memory for our private driver context. */
-       if (!(la8 = malloc(sizeof(struct la8)))) {
+       if (!(la8 = g_try_malloc(sizeof(struct la8)))) {
                sr_warn("la8: %s: struct la8 malloc failed", __func__);
                ret = SR_ERR_MALLOC;
                goto err_free_nothing;
@@ -431,14 +489,14 @@ static int hw_init(const char *deviceinfo)
        la8->divcount = 0; /* 10ns sample period == 100MHz samplerate */
 
        /* Allocate memory for the raw (mangled) data from the LA8. */
-       if (!(la8->mangled_buf = malloc(SDRAM_SIZE))) {
+       if (!(la8->mangled_buf = g_try_malloc(SDRAM_SIZE))) {
                sr_warn("la8: %s: mangled_buf malloc failed", __func__);
                ret = SR_ERR_MALLOC;
                goto err_free_la8;
        }
 
        /* Allocate memory where we'll store the de-mangled data. */
-       if (!(la8->final_buf = malloc(SDRAM_SIZE))) {
+       if (!(la8->final_buf = g_try_malloc(SDRAM_SIZE))) {
                sr_warn("la8: %s: final_buf malloc failed", __func__);
                ret = SR_ERR_MALLOC;
                goto err_free_mangled_buf;
@@ -486,13 +544,13 @@ static int hw_init(const char *deviceinfo)
 err_close_ftdic:
        (void) la8_close(la8); /* Log, but ignore errors. */
 err_free_ftdic:
-       free(la8->ftdic);
+       free(la8->ftdic); /* NOT g_free()! */
 err_free_final_buf:
-       free(la8->final_buf);
+       g_free(la8->final_buf);
 err_free_mangled_buf:
-       free(la8->mangled_buf);
+       g_free(la8->mangled_buf);
 err_free_la8:
-       free(la8);
+       g_free(la8);
 err_free_nothing:
        // return ret; /* TODO */
        return 0;
@@ -730,10 +788,10 @@ static int hw_set_configuration(int device_index, int capability, void *value)
                sr_dbg("la8: SAMPLERATE = %" PRIu64, la8->cur_samplerate);
                break;
        case SR_HWCAP_PROBECONFIG:
-               /* Nothing to do, but this entry must exist. Fix this. */
-               /* TODO? */
-               sr_dbg("la8: %s: SR_HWCAP_PROBECONFIG called", __func__);
-               return SR_OK;
+               if (configure_probes(la8, (GSList *)value) != SR_OK) {
+                       sr_err("la8: %s: probe config failed", __func__);
+                       return SR_ERR;
+               }
                break;
        case SR_HWCAP_LIMIT_MSEC:
                if (*(uint64_t *)value == 0) {
@@ -842,6 +900,7 @@ static int receive_data(int fd, int revents, void *user_data)
        /* Get one block of data (4096 bytes). */
        if ((ret = la8_read_block(la8)) < 0) {
                sr_warn("la8: %s: la8_read_block error: %d", __func__, ret);
+               hw_stop_acquisition(sdi->index, user_data);
                return FALSE;
        }