]> sigrok.org Git - libsigrok.git/blobdiff - hardware/zeroplus-logic-cube/zeroplus.c
Return SR_ERR_MALLOC upon allocation errors.
[libsigrok.git] / hardware / zeroplus-logic-cube / zeroplus.c
index abe6dabf3c29a82aff7260ae8b5bdf60255d7d95..f1b6431b9f8c93a8e7f750305928d99700d73e7a 100644 (file)
@@ -24,7 +24,6 @@
 #include <inttypes.h>
 #include <glib.h>
 #include <libusb.h>
-#include "config.h"
 #include "libsigrok.h"
 #include "libsigrok-internal.h"
 #include "analyzer.h"
@@ -59,9 +58,11 @@ typedef struct {
 static model_t zeroplus_models[] = {
        {0x0c12, 0x7009, "LAP-C(16064)",  16, 64,   100},
        {0x0c12, 0x700A, "LAP-C(16128)",  16, 128,  200},
+       /* TODO: we don't know anything about these
        {0x0c12, 0x700B, "LAP-C(32128)",  32, 128,  200},
        {0x0c12, 0x700C, "LAP-C(321000)", 32, 1024, 200},
        {0x0c12, 0x700D, "LAP-C(322000)", 32, 2048, 200},
+       */
        {0x0c12, 0x700E, "LAP-C(16032)",  16, 32,   100},
        {0x0c12, 0x7016, "LAP-C(162000)", 16, 2048, 200},
        { 0, 0, 0, 0, 0, 0 }
@@ -70,7 +71,6 @@ static model_t zeroplus_models[] = {
 static const int hwcaps[] = {
        SR_HWCAP_LOGIC_ANALYZER,
        SR_HWCAP_SAMPLERATE,
-       SR_HWCAP_PROBECONFIG,
        SR_HWCAP_CAPTURE_RATIO,
 
        /* These are really implemented in the driver, not the hardware. */
@@ -147,7 +147,7 @@ static const struct sr_samplerates samplerates = {
 };
 
 /* Private, per-device-instance driver context. */
-struct context {
+struct dev_context {
        uint64_t cur_samplerate;
        uint64_t limit_samples;
        int num_channels; /* TODO: This isn't initialized before it's needed :( */
@@ -179,37 +179,37 @@ static unsigned int get_memory_size(int type)
                return 0;
 }
 
-static int configure_probes(const struct sr_dev_inst *sdi, const GSList *probes)
+static int configure_probes(const struct sr_dev_inst *sdi)
 {
-       struct context *ctx;
+       struct dev_context *devc;
        const struct sr_probe *probe;
        const GSList *l;
        int probe_bit, stage, i;
        char *tc;
 
        /* Note: sdi and sdi->priv are non-NULL, the caller checked this. */
-       ctx = sdi->priv;
+       devc = sdi->priv;
 
-       ctx->probe_mask = 0;
+       devc->probe_mask = 0;
        for (i = 0; i < NUM_TRIGGER_STAGES; i++) {
-               ctx->trigger_mask[i] = 0;
-               ctx->trigger_value[i] = 0;
+               devc->trigger_mask[i] = 0;
+               devc->trigger_value[i] = 0;
        }
 
        stage = -1;
-       for (l = probes; l; l = l->next) {
+       for (l = sdi->probes; l; l = l->next) {
                probe = (struct sr_probe *)l->data;
                if (probe->enabled == FALSE)
                        continue;
-               probe_bit = 1 << (probe->index - 1);
-               ctx->probe_mask |= probe_bit;
+               probe_bit = 1 << (probe->index);
+               devc->probe_mask |= probe_bit;
 
                if (probe->trigger) {
                        stage = 0;
                        for (tc = probe->trigger; *tc; tc++) {
-                               ctx->trigger_mask[stage] |= probe_bit;
+                               devc->trigger_mask[stage] |= probe_bit;
                                if (*tc == '1')
-                                       ctx->trigger_value[stage] |= probe_bit;
+                                       devc->trigger_value[stage] |= probe_bit;
                                stage++;
                                if (stage > NUM_TRIGGER_STAGES)
                                        return SR_ERR;
@@ -220,21 +220,31 @@ static int configure_probes(const struct sr_dev_inst *sdi, const GSList *probes)
        return SR_OK;
 }
 
-static void clear_instances(void)
+static int clear_instances(void)
 {
        GSList *l;
        struct sr_dev_inst *sdi;
+       struct drv_context *drvc;
+       struct dev_context *devc;
 
-       for (l = zdi->instances; l; l = l->next) {
+       drvc = zdi->priv;
+       for (l = drvc->instances; l; l = l->next) {
                sdi = l->data;
+               if (!(devc = sdi->priv)) {
+                       /* Log error, but continue cleaning up the rest. */
+                       sr_err("zeroplus: %s: sdi->priv was NULL, continuing", __func__);
+                       continue;
+               }
+               sr_usb_dev_inst_free(devc->usb);
                /* Properly close all devices... */
                hw_dev_close(sdi);
                /* ...and free all their memory. */
                sr_dev_inst_free(sdi);
        }
-       g_slist_free(zdi->instances);
-       zdi->instances = NULL;
+       g_slist_free(drvc->instances);
+       drvc->instances = NULL;
 
+       return SR_OK;
 }
 
 /*
@@ -243,6 +253,13 @@ static void clear_instances(void)
 
 static int hw_init(void)
 {
+       struct drv_context *drvc;
+
+       if (!(drvc = g_try_malloc0(sizeof(struct drv_context)))) {
+               sr_err("zeroplus: driver context malloc failed.");
+               return SR_ERR_MALLOC;
+       }
+       zdi->priv = drvc;
 
        if (libusb_init(&usb_context) != 0) {
                sr_err("zp: Failed to initialize USB.");
@@ -256,7 +273,8 @@ static GSList *hw_scan(GSList *options)
 {
        struct sr_dev_inst *sdi;
        struct sr_probe *probe;
-       struct context *ctx;
+       struct drv_context *drvc;
+       struct dev_context *devc;
        model_t *prof;
        struct libusb_device_descriptor des;
        libusb_device **devlist;
@@ -264,6 +282,7 @@ static GSList *hw_scan(GSList *options)
        int ret, devcnt, i, j;
 
        (void)options;
+       drvc = zdi->priv;
        devices = NULL;
 
        clear_instances();
@@ -300,17 +319,17 @@ static GSList *hw_scan(GSList *options)
                sdi->driver = zdi;
 
                /* Allocate memory for our private driver context. */
-               if (!(ctx = g_try_malloc0(sizeof(struct context)))) {
-                       sr_err("zp: %s: ctx malloc failed", __func__);
-                       return 0;
+               if (!(devc = g_try_malloc0(sizeof(struct dev_context)))) {
+                       sr_err("zp: %s: devc malloc failed", __func__);
+                       return NULL;
                }
-               sdi->priv = ctx;
-               ctx->num_channels = prof->channels;
-               ctx->memory_size = prof->sample_depth * 1024;
-               // memset(ctx->trigger_buffer, 0, NUM_TRIGGER_STAGES);
+               sdi->priv = devc;
+               devc->num_channels = prof->channels;
+               devc->memory_size = prof->sample_depth * 1024;
+               // memset(devc->trigger_buffer, 0, NUM_TRIGGER_STAGES);
 
                /* Fill in probelist according to this device's profile. */
-               for (j = 0; j < ctx->num_channels; j++) {
+               for (j = 0; j < devc->num_channels; j++) {
                        if (!(probe = sr_probe_new(j, SR_PROBE_LOGIC, TRUE,
                                        probe_names[j])))
                                return NULL;
@@ -318,8 +337,8 @@ static GSList *hw_scan(GSList *options)
                }
 
                devices = g_slist_append(devices, sdi);
-               zdi->instances = g_slist_append(zdi->instances, sdi);
-               ctx->usb = sr_usb_dev_inst_new(
+               drvc->instances = g_slist_append(drvc->instances, sdi);
+               devc->usb = sr_usb_dev_inst_new(
                        libusb_get_bus_number(devlist[i]),
                        libusb_get_device_address(devlist[i]), NULL);
                devcnt++;
@@ -330,14 +349,23 @@ static GSList *hw_scan(GSList *options)
        return devices;
 }
 
+static GSList *hw_dev_list(void)
+{
+       struct drv_context *drvc;
+
+       drvc = zdi->priv;
+
+       return drvc->instances;
+}
+
 static int hw_dev_open(struct sr_dev_inst *sdi)
 {
-       struct context *ctx;
+       struct dev_context *devc;
        libusb_device **devlist, *dev;
        struct libusb_device_descriptor des;
        int device_count, ret, i;
 
-       if (!(ctx = sdi->priv)) {
+       if (!(devc = sdi->priv)) {
                sr_err("zp: %s: sdi->priv was NULL", __func__);
                return SR_ERR_ARG;
        }
@@ -355,43 +383,43 @@ static int hw_dev_open(struct sr_dev_inst *sdi)
                               ret);
                        continue;
                }
-               if (libusb_get_bus_number(devlist[i]) == ctx->usb->bus
-                   && libusb_get_device_address(devlist[i]) == ctx->usb->address) {
+               if (libusb_get_bus_number(devlist[i]) == devc->usb->bus
+                   && libusb_get_device_address(devlist[i]) == devc->usb->address) {
                        dev = devlist[i];
                        break;
                }
        }
        if (!dev) {
                sr_err("device on bus %d address %d disappeared!",
-                               ctx->usb->bus, ctx->usb->address);
+                               devc->usb->bus, devc->usb->address);
                return SR_ERR;
        }
 
-       if (!(ret = libusb_open(dev, &(ctx->usb->devhdl)))) {
+       if (!(ret = libusb_open(dev, &(devc->usb->devhdl)))) {
                sdi->status = SR_ST_ACTIVE;
                sr_info("zp: opened device %d on %d.%d interface %d",
-                       sdi->index, ctx->usb->bus,
-                       ctx->usb->address, USB_INTERFACE);
+                       sdi->index, devc->usb->bus,
+                       devc->usb->address, USB_INTERFACE);
        } else {
                sr_err("zp: failed to open device: %d", ret);
                return SR_ERR;
        }
 
-       ret = libusb_set_configuration(ctx->usb->devhdl, USB_CONFIGURATION);
+       ret = libusb_set_configuration(devc->usb->devhdl, USB_CONFIGURATION);
        if (ret < 0) {
                sr_err("zp: Unable to set USB configuration %d: %d",
                       USB_CONFIGURATION, ret);
                return SR_ERR;
        }
 
-       ret = libusb_claim_interface(ctx->usb->devhdl, USB_INTERFACE);
+       ret = libusb_claim_interface(devc->usb->devhdl, USB_INTERFACE);
        if (ret != 0) {
                sr_err("zp: Unable to claim interface: %d", ret);
                return SR_ERR;
        }
 
-       analyzer_reset(ctx->usb->devhdl);
-       analyzer_initialize(ctx->usb->devhdl);
+       analyzer_reset(devc->usb->devhdl);
+       analyzer_initialize(devc->usb->devhdl);
 
        analyzer_set_memory_size(MEMORY_SIZE_512K);
        // analyzer_set_freq(g_freq, g_freq_scale);
@@ -410,7 +438,7 @@ static int hw_dev_open(struct sr_dev_inst *sdi)
 #endif
        analyzer_set_compression(COMPRESSION_NONE);
 
-       if (ctx->cur_samplerate == 0) {
+       if (devc->cur_samplerate == 0) {
                /* Samplerate hasn't been set. Default to the slowest one. */
                if (hw_dev_config_set(sdi, SR_HWCAP_SAMPLERATE,
                     &samplerates.list[0]) == SR_ERR)
@@ -422,22 +450,22 @@ static int hw_dev_open(struct sr_dev_inst *sdi)
 
 static int hw_dev_close(struct sr_dev_inst *sdi)
 {
-       struct context *ctx;
+       struct dev_context *devc;
 
-       if (!(ctx = sdi->priv)) {
+       if (!(devc = sdi->priv)) {
                sr_err("zp: %s: sdi->priv was NULL", __func__);
                return SR_ERR;
        }
 
-       if (!ctx->usb->devhdl)
+       if (!devc->usb->devhdl)
                return SR_ERR;
 
        sr_info("zp: closing device %d on %d.%d interface %d", sdi->index,
-               ctx->usb->bus, ctx->usb->address, USB_INTERFACE);
-       libusb_release_interface(ctx->usb->devhdl, USB_INTERFACE);
-       libusb_reset_device(ctx->usb->devhdl);
-       libusb_close(ctx->usb->devhdl);
-       ctx->usb->devhdl = NULL;
+               devc->usb->bus, devc->usb->address, USB_INTERFACE);
+       libusb_release_interface(devc->usb->devhdl, USB_INTERFACE);
+       libusb_reset_device(devc->usb->devhdl);
+       libusb_close(devc->usb->devhdl);
+       devc->usb->devhdl = NULL;
        sdi->status = SR_ST_INACTIVE;
 
        return SR_OK;
@@ -445,6 +473,10 @@ static int hw_dev_close(struct sr_dev_inst *sdi)
 
 static int hw_cleanup(void)
 {
+       struct drv_context *drvc;
+
+       if (!(drvc = zdi->priv))
+               return SR_OK;
 
        clear_instances();
 
@@ -458,22 +490,18 @@ static int hw_cleanup(void)
 static int hw_info_get(int info_id, const void **data,
        const struct sr_dev_inst *sdi)
 {
-       struct context *ctx;
+       struct dev_context *devc;
 
        switch (info_id) {
-       case SR_DI_INST:
-               *data = sdi;
-               sr_spew("zp: %s: Returning sdi.", __func__);
-               break;
        case SR_DI_HWCAPS:
                *data = hwcaps;
                break;
        case SR_DI_NUM_PROBES:
                if (sdi) {
-                       ctx = sdi->priv;
-                       *data = GINT_TO_POINTER(ctx->num_channels);
+                       devc = sdi->priv;
+                       *data = GINT_TO_POINTER(devc->num_channels);
                        sr_spew("zp: %s: Returning number of channels: %d.",
-                                       __func__, ctx->num_channels);
+                                       __func__, devc->num_channels);
                } else
                        return SR_ERR;
                break;
@@ -491,10 +519,10 @@ static int hw_info_get(int info_id, const void **data,
                break;
        case SR_DI_CUR_SAMPLERATE:
                if (sdi) {
-                       ctx = sdi->priv;
-                       *data = &ctx->cur_samplerate;
+                       devc = sdi->priv;
+                       *data = &devc->cur_samplerate;
                        sr_spew("zp: %s: Returning samplerate: %" PRIu64 "Hz.",
-                               __func__, ctx->cur_samplerate);
+                               __func__, devc->cur_samplerate);
                } else
                        return SR_ERR;
                break;
@@ -505,27 +533,16 @@ static int hw_info_get(int info_id, const void **data,
        return SR_OK;
 }
 
-static int hw_dev_status_get(int dev_index)
-{
-       struct sr_dev_inst *sdi;
-
-       sdi = sr_dev_inst_get(zdi->instances, dev_index);
-       if (sdi)
-               return sdi->status;
-       else
-               return SR_ST_NOT_FOUND;
-}
-
 static int set_samplerate(const struct sr_dev_inst *sdi, uint64_t samplerate)
 {
-       struct context *ctx;
+       struct dev_context *devc;
 
        if (!sdi) {
                sr_err("zp: %s: sdi was NULL", __func__);
                return SR_ERR_ARG;
        }
 
-       if (!(ctx = sdi->priv)) {
+       if (!(devc = sdi->priv)) {
                sr_err("zp: %s: sdi->priv was NULL", __func__);
                return SR_ERR_ARG;
        }
@@ -539,7 +556,7 @@ static int set_samplerate(const struct sr_dev_inst *sdi, uint64_t samplerate)
        else
                analyzer_set_freq(samplerate, FREQ_SCALE_HZ);
 
-       ctx->cur_samplerate = samplerate;
+       devc->cur_samplerate = samplerate;
 
        return SR_OK;
 }
@@ -547,9 +564,9 @@ static int set_samplerate(const struct sr_dev_inst *sdi, uint64_t samplerate)
 static int hw_dev_config_set(const struct sr_dev_inst *sdi, int hwcap,
                const void *value)
 {
-       struct context *ctx;
+       struct dev_context *devc;
 
-       if (!(ctx = sdi->priv)) {
+       if (!(devc = sdi->priv)) {
                sr_err("zp: %s: sdi->priv was NULL", __func__);
                return SR_ERR_ARG;
        }
@@ -557,10 +574,8 @@ static int hw_dev_config_set(const struct sr_dev_inst *sdi, int hwcap,
        switch (hwcap) {
        case SR_HWCAP_SAMPLERATE:
                return set_samplerate(sdi, *(const uint64_t *)value);
-       case SR_HWCAP_PROBECONFIG:
-               return configure_probes(sdi, (const GSList *)value);
        case SR_HWCAP_LIMIT_SAMPLES:
-               ctx->limit_samples = *(const uint64_t *)value;
+               devc->limit_samples = *(const uint64_t *)value;
                return SR_OK;
        default:
                return SR_ERR;
@@ -578,26 +593,31 @@ static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
        int res;
        unsigned int packet_num;
        unsigned char *buf;
-       struct context *ctx;
+       struct dev_context *devc;
 
-       if (!(ctx = sdi->priv)) {
+       if (!(devc = sdi->priv)) {
                sr_err("zp: %s: sdi->priv was NULL", __func__);
                return SR_ERR_ARG;
        }
 
+       if (configure_probes(sdi) != SR_OK) {
+               sr_err("zp: failed to configured probes");
+               return SR_ERR;
+       }
+
        /* push configured settings to device */
-       analyzer_configure(ctx->usb->devhdl);
+       analyzer_configure(devc->usb->devhdl);
 
-       analyzer_start(ctx->usb->devhdl);
+       analyzer_start(devc->usb->devhdl);
        sr_info("zp: Waiting for data");
-       analyzer_wait_data(ctx->usb->devhdl);
+       analyzer_wait_data(devc->usb->devhdl);
 
        sr_info("zp: Stop address    = 0x%x",
-               analyzer_get_stop_address(ctx->usb->devhdl));
+               analyzer_get_stop_address(devc->usb->devhdl));
        sr_info("zp: Now address     = 0x%x",
-               analyzer_get_now_address(ctx->usb->devhdl));
+               analyzer_get_now_address(devc->usb->devhdl));
        sr_info("zp: Trigger address = 0x%x",
-               analyzer_get_trigger_address(ctx->usb->devhdl));
+               analyzer_get_trigger_address(devc->usb->devhdl));
 
        packet.type = SR_DF_HEADER;
        packet.payload = &header;
@@ -608,8 +628,8 @@ static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
        /* Send metadata about the SR_DF_LOGIC packets to come. */
        packet.type = SR_DF_META_LOGIC;
        packet.payload = &meta;
-       meta.samplerate = ctx->cur_samplerate;
-       meta.num_probes = ctx->num_channels;
+       meta.samplerate = devc->cur_samplerate;
+       meta.num_probes = devc->num_channels;
        sr_session_send(cb_data, &packet);
 
        if (!(buf = g_try_malloc(PACKET_SIZE))) {
@@ -618,11 +638,11 @@ static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
        }
 
        samples_read = 0;
-       analyzer_read_start(ctx->usb->devhdl);
+       analyzer_read_start(devc->usb->devhdl);
        /* Send the incoming transfer to the session bus. */
-       for (packet_num = 0; packet_num < (ctx->memory_size * 4 / PACKET_SIZE);
+       for (packet_num = 0; packet_num < (devc->memory_size * 4 / PACKET_SIZE);
             packet_num++) {
-               res = analyzer_read_data(ctx->usb->devhdl, buf, PACKET_SIZE);
+               res = analyzer_read_data(devc->usb->devhdl, buf, PACKET_SIZE);
                sr_info("zp: Tried to read %llx bytes, actually read %x bytes",
                        PACKET_SIZE, res);
 
@@ -634,7 +654,7 @@ static int hw_dev_acquisition_start(const struct sr_dev_inst *sdi,
                sr_session_send(cb_data, &packet);
                samples_read += res / 4;
        }
-       analyzer_read_stop(ctx->usb->devhdl);
+       analyzer_read_stop(devc->usb->devhdl);
        g_free(buf);
 
        packet.type = SR_DF_END;
@@ -648,17 +668,17 @@ static int hw_dev_acquisition_stop(const struct sr_dev_inst *sdi,
                void *cb_data)
 {
        struct sr_datafeed_packet packet;
-       struct context *ctx;
+       struct dev_context *devc;
 
        packet.type = SR_DF_END;
        sr_session_send(cb_data, &packet);
 
-       if (!(ctx = sdi->priv)) {
+       if (!(devc = sdi->priv)) {
                sr_err("zp: %s: sdi->priv was NULL", __func__);
                return SR_ERR_BUG;
        }
 
-       analyzer_reset(ctx->usb->devhdl);
+       analyzer_reset(devc->usb->devhdl);
        /* TODO: Need to cancel and free any queued up transfers. */
 
        return SR_OK;
@@ -671,12 +691,13 @@ SR_PRIV struct sr_dev_driver zeroplus_logic_cube_driver_info = {
        .init = hw_init,
        .cleanup = hw_cleanup,
        .scan = hw_scan,
+       .dev_list = hw_dev_list,
+       .dev_clear = hw_cleanup,
        .dev_open = hw_dev_open,
        .dev_close = hw_dev_close,
        .info_get = hw_info_get,
-       .dev_status_get = hw_dev_status_get,
        .dev_config_set = hw_dev_config_set,
        .dev_acquisition_start = hw_dev_acquisition_start,
        .dev_acquisition_stop = hw_dev_acquisition_stop,
-       .instances = NULL,
+       .priv = NULL,
 };