]> sigrok.org Git - libsigrok.git/blobdiff - hardware/chronovu-la8/protocol.c
la8: Add support for the ChronoVu LA16.
[libsigrok.git] / hardware / chronovu-la8 / protocol.c
index 6f8738bca6dd9d84eb8e599591ee9b2ea93ab320..28ac15bee0853f2e3f581ff4caf89b374914f324 100644 (file)
@@ -1,7 +1,7 @@
 /*
  * This file is part of the libsigrok project.
  *
- * Copyright (C) 2011-2012 Uwe Hermann <uwe@hermann-uwe.de>
+ * Copyright (C) 2011-2014 Uwe Hermann <uwe@hermann-uwe.de>
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  */
 
-#include <ftdi.h>
-#include <glib.h>
-#include "libsigrok.h"
-#include "libsigrok-internal.h"
 #include "protocol.h"
 
-/* Channels are numbered 0-7. */
-SR_PRIV const char *chronovu_la8_channel_names[NUM_CHANNELS + 1] = {
+SR_PRIV const struct cv_profile cv_profiles[] = {
+       { CHRONOVU_LA8,  "LA8",  "ChronoVu LA8",  8,  SR_MHZ(100), "01",
+         0.8388608 },
+       { CHRONOVU_LA16, "LA16", "ChronoVu LA16", 16, SR_MHZ(200), "01rf",
+         0.042 },
+       { 0, NULL, NULL, 0, 0, NULL, 0.0 },
+};
+
+/* LA8: channels are numbered 0-7. LA16: channels are numbered 0-15. */
+SR_PRIV const char *cv_channel_names[] = {
        "0", "1", "2", "3", "4", "5", "6", "7",
-       NULL,
+       "8", "9", "10", "11", "12", "13", "14", "15",
 };
 
-SR_PRIV void fill_supported_samplerates_if_needed(void)
+static int close_usb_reset_sequencer(struct dev_context *devc);
+
+SR_PRIV void cv_fill_samplerates_if_needed(const struct sr_dev_inst *sdi)
 {
        int i;
+       struct dev_context *devc;
 
-       if (chronovu_la8_samplerates[0] != 0)
+       devc = sdi->priv;
+
+       if (devc->samplerates[0] != 0)
                return;
 
        for (i = 0; i < 255; i++)
-               chronovu_la8_samplerates[254 - i] = SR_MHZ(100) / (i + 1);
+               devc->samplerates[254 - i] = devc->prof->max_samplerate / (i + 1);
 }
 
 /**
- * Check if the given samplerate is supported by the LA8 hardware.
+ * Check if the given samplerate is supported by the hardware.
  *
+ * @param sdi Device instance.
  * @param samplerate The samplerate (in Hz) to check.
+ *
  * @return 1 if the samplerate is supported/valid, 0 otherwise.
  */
-SR_PRIV int is_valid_samplerate(uint64_t samplerate)
+static int is_valid_samplerate(const struct sr_dev_inst *sdi,
+                              uint64_t samplerate)
 {
        int i;
+       struct dev_context *devc;
 
-       fill_supported_samplerates_if_needed();
+       devc = sdi->priv;
+
+       cv_fill_samplerates_if_needed(sdi);
 
        for (i = 0; i < 255; i++) {
-               if (chronovu_la8_samplerates[i] == samplerate)
+               if (devc->samplerates[i] == samplerate)
                        return 1;
        }
 
@@ -64,157 +79,125 @@ SR_PRIV int is_valid_samplerate(uint64_t samplerate)
 }
 
 /**
- * Convert a samplerate (in Hz) to the 'divcount' value the LA8 wants.
+ * Convert a samplerate (in Hz) to the 'divcount' value the device wants.
+ *
+ * The divcount value can be 0x00 - 0xfe (0xff is not valid).
+ *
+ * LA8:
+ * sample period = (divcount + 1) * 10ns.
+ * divcount = 0x00: 10ns period, 100MHz samplerate.
+ * divcount = 0xfe: 2550ns period, 392.15kHz samplerate.
  *
- * LA8 hardware: sample period = (divcount + 1) * 10ns.
- * Min. value for divcount: 0x00 (10ns sample period, 100MHz samplerate).
- * Max. value for divcount: 0xfe (2550ns sample period, 392.15kHz samplerate).
+ * LA16:
+ * sample period = (divcount + 1) * 5ns.
+ * divcount = 0x00: 5ns period, 200MHz samplerate.
+ * divcount = 0xfe: 1275ns period, ~784.31kHz samplerate.
  *
+ * @param sdi Device instance.
  * @param samplerate The samplerate in Hz.
+ *
  * @return The divcount value as needed by the hardware, or 0xff upon errors.
  */
-SR_PRIV uint8_t samplerate_to_divcount(uint64_t samplerate)
+SR_PRIV uint8_t cv_samplerate_to_divcount(const struct sr_dev_inst *sdi,
+                                         uint64_t samplerate)
 {
+       struct dev_context *devc;
+
+       devc = sdi->priv;
+
        if (samplerate == 0) {
-               sr_err("%s: samplerate was 0.", __func__);
+               sr_err("Can't convert invalid samplerate of 0 Hz.");
                return 0xff;
        }
 
-       if (!is_valid_samplerate(samplerate)) {
-               sr_err("%s: Can't get divcount, samplerate invalid.", __func__);
+       if (!is_valid_samplerate(sdi, samplerate)) {
+               sr_err("Can't get divcount, samplerate invalid.");
                return 0xff;
        }
 
-       return (SR_MHZ(100) / samplerate) - 1;
+       return (devc->prof->max_samplerate / samplerate) - 1;
 }
 
 /**
- * Write data of a certain length to the LA8's FTDI device.
+ * Write data of a certain length to the FTDI device.
  *
  * @param devc The struct containing private per-device-instance data. Must not
- *            be NULL. devc->ftdic must not be NULL either.
+ *             be NULL. devc->ftdic must not be NULL either.
  * @param buf The buffer containing the data to write. Must not be NULL.
- * @param size The number of bytes to write. Must be >= 0.
+ * @param size The number of bytes to write. Must be > 0.
+ *
  * @return The number of bytes written, or a negative value upon errors.
  */
-SR_PRIV int la8_write(struct dev_context *devc, uint8_t *buf, int size)
+SR_PRIV int cv_write(struct dev_context *devc, uint8_t *buf, int size)
 {
        int bytes_written;
 
-       /* Note: Caller checked that devc and devc->ftdic != NULL. */
-
-       if (!buf) {
-               sr_err("%s: buf was NULL.", __func__);
-               return SR_ERR_ARG;
-       }
-
-       if (size < 0) {
-               sr_err("%s: size was < 0.", __func__);
-               return SR_ERR_ARG;
-       }
+       /* Note: Caller ensures devc/devc->ftdic/buf != NULL and size > 0. */
 
        bytes_written = ftdi_write_data(devc->ftdic, buf, size);
 
        if (bytes_written < 0) {
-               sr_err("%s: ftdi_write_data: (%d) %s.", __func__,
+               sr_err("Failed to write data (%d): %s.",
                       bytes_written, ftdi_get_error_string(devc->ftdic));
-               (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
+               (void) close_usb_reset_sequencer(devc); /* Ignore errors. */
        } else if (bytes_written != size) {
-               sr_err("%s: bytes to write: %d, bytes written: %d.",
-                      __func__, size, bytes_written);
-               (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
+               sr_err("Failed to write data, only %d/%d bytes written.",
+                      size, bytes_written);
+               (void) close_usb_reset_sequencer(devc); /* Ignore errors. */
        }
 
        return bytes_written;
 }
 
 /**
- * Read a certain amount of bytes from the LA8's FTDI device.
+ * Read a certain amount of bytes from the FTDI device.
  *
  * @param devc The struct containing private per-device-instance data. Must not
- *            be NULL. devc->ftdic must not be NULL either.
+ *             be NULL. devc->ftdic must not be NULL either.
  * @param buf The buffer where the received data will be stored. Must not
  *            be NULL.
  * @param size The number of bytes to read. Must be >= 1.
+ *
  * @return The number of bytes read, or a negative value upon errors.
  */
-SR_PRIV int la8_read(struct dev_context *devc, uint8_t *buf, int size)
+static int cv_read(struct dev_context *devc, uint8_t *buf, int size)
 {
        int bytes_read;
 
-       /* Note: Caller checked that devc and devc->ftdic != NULL. */
-
-       if (!buf) {
-               sr_err("%s: buf was NULL.", __func__);
-               return SR_ERR_ARG;
-       }
-
-       if (size <= 0) {
-               sr_err("%s: size was <= 0.", __func__);
-               return SR_ERR_ARG;
-       }
+       /* Note: Caller ensures devc/devc->ftdic/buf != NULL and size > 0. */
 
        bytes_read = ftdi_read_data(devc->ftdic, buf, size);
 
        if (bytes_read < 0) {
-               sr_err("%s: ftdi_read_data: (%d) %s.", __func__,
+               sr_err("Failed to read data (%d): %s.",
                       bytes_read, ftdi_get_error_string(devc->ftdic));
        } else if (bytes_read != size) {
-               // sr_err("%s: Bytes to read: %d, bytes read: %d.",
-               //        __func__, size, bytes_read);
+               // sr_err("Failed to read data, only %d/%d bytes read.",
+               //        bytes_read, size);
        }
 
        return bytes_read;
 }
 
-SR_PRIV int la8_close(struct dev_context *devc)
-{
-       int ret;
-
-       if (!devc) {
-               sr_err("%s: devc was NULL.", __func__);
-               return SR_ERR_ARG;
-       }
-
-       if (!devc->ftdic) {
-               sr_err("%s: devc->ftdic was NULL.", __func__);
-               return SR_ERR_ARG;
-       }
-
-       if ((ret = ftdi_usb_close(devc->ftdic)) < 0) {
-               sr_err("%s: ftdi_usb_close: (%d) %s.",
-                      __func__, ret, ftdi_get_error_string(devc->ftdic));
-       }
-
-       return ret;
-}
-
 /**
- * Close the ChronoVu LA8 USB port and reset the LA8 sequencer logic.
+ * Close the USB port and reset the sequencer logic.
  *
  * @param devc The struct containing private per-device-instance data.
+ *
  * @return SR_OK upon success, SR_ERR_ARG upon invalid arguments.
  */
-SR_PRIV int la8_close_usb_reset_sequencer(struct dev_context *devc)
+static int close_usb_reset_sequencer(struct dev_context *devc)
 {
-       /* Magic sequence of bytes for resetting the LA8 sequencer logic. */
+       /* Magic sequence of bytes for resetting the sequencer logic. */
        uint8_t buf[8] = {0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01};
        int ret;
 
-       if (!devc) {
-               sr_err("%s: devc was NULL.", __func__);
-               return SR_ERR_ARG;
-       }
-
-       if (!devc->ftdic) {
-               sr_err("%s: devc->ftdic was NULL.", __func__);
-               return SR_ERR_ARG;
-       }
+       /* Note: Caller checked that devc and devc->ftdic != NULL. */
 
        if (devc->ftdic->usb_dev) {
-               /* Reset the LA8 sequencer logic, then wait 100ms. */
+               /* Reset the sequencer logic, then wait 100ms. */
                sr_dbg("Resetting sequencer logic.");
-               (void) la8_write(devc, buf, 8); /* Ignore errors. */
+               (void) cv_write(devc, buf, 8); /* Ignore errors. */
                g_usleep(100 * 1000);
 
                /* Purge FTDI buffers, then reset and close the FTDI device. */
@@ -222,46 +205,39 @@ SR_PRIV int la8_close_usb_reset_sequencer(struct dev_context *devc)
 
                /* Log errors, but ignore them (i.e., don't abort). */
                if ((ret = ftdi_usb_purge_buffers(devc->ftdic)) < 0)
-                       sr_err("%s: ftdi_usb_purge_buffers: (%d) %s.",
-                           __func__, ret, ftdi_get_error_string(devc->ftdic));
+                       sr_err("Failed to purge FTDI buffers (%d): %s.",
+                              ret, ftdi_get_error_string(devc->ftdic));
                if ((ret = ftdi_usb_reset(devc->ftdic)) < 0)
-                       sr_err("%s: ftdi_usb_reset: (%d) %s.", __func__,
+                       sr_err("Failed to reset FTDI device (%d): %s.",
                               ret, ftdi_get_error_string(devc->ftdic));
                if ((ret = ftdi_usb_close(devc->ftdic)) < 0)
-                       sr_err("%s: ftdi_usb_close: (%d) %s.", __func__,
+                       sr_err("Failed to close FTDI device (%d): %s.",
                               ret, ftdi_get_error_string(devc->ftdic));
        }
 
        /* Close USB device, deinitialize and free the FTDI context. */
-       ftdi_free(devc->ftdic); /* Returns void. */
+       ftdi_free(devc->ftdic);
        devc->ftdic = NULL;
 
        return SR_OK;
 }
 
 /**
- * Reset the ChronoVu LA8.
+ * Reset the ChronoVu device.
  *
- * The LA8 must be reset after a failed read/write operation or upon timeouts.
+ * A reset is required after a failed read/write operation or upon timeouts.
  *
  * @param devc The struct containing private per-device-instance data.
+ *
  * @return SR_OK upon success, SR_ERR upon failure.
  */
-SR_PRIV int la8_reset(struct dev_context *devc)
+static int reset_device(struct dev_context *devc)
 {
        uint8_t buf[BS];
-       time_t done, now;
+       gint64 done, now;
        int bytes_read;
 
-       if (!devc) {
-               sr_err("%s: devc was NULL.", __func__);
-               return SR_ERR_ARG;
-       }
-
-       if (!devc->ftdic) {
-               sr_err("%s: devc->ftdic was NULL.", __func__);
-               return SR_ERR_ARG;
-       }
+       /* Note: Caller checked that devc and devc->ftdic != NULL. */
 
        sr_dbg("Resetting the device.");
 
@@ -269,32 +245,33 @@ SR_PRIV int la8_reset(struct dev_context *devc)
         * Purge pending read data from the FTDI hardware FIFO until
         * no more data is left, or a timeout occurs (after 20s).
         */
-       done = 20 + time(NULL);
+       done = (20 * G_TIME_SPAN_SECOND) + g_get_monotonic_time();
        do {
-               /* TODO: Ignore errors? Check for < 0 at least! */
-               bytes_read = la8_read(devc, (uint8_t *)&buf, BS);
-               now = time(NULL);
+               /* Try to read bytes until none are left (or errors occur). */
+               bytes_read = cv_read(devc, (uint8_t *)&buf, BS);
+               now = g_get_monotonic_time();
        } while ((done > now) && (bytes_read > 0));
 
-       /* Reset the LA8 sequencer logic and close the USB port. */
-       (void) la8_close_usb_reset_sequencer(devc); /* Ignore errors. */
+       /* Reset the sequencer logic and close the USB port. */
+       (void) close_usb_reset_sequencer(devc); /* Ignore errors. */
 
        sr_dbg("Device reset finished.");
 
        return SR_OK;
 }
 
-SR_PRIV int configure_channels(const struct sr_dev_inst *sdi)
+SR_PRIV int cv_configure_channels(const struct sr_dev_inst *sdi)
 {
        struct dev_context *devc;
        const struct sr_channel *ch;
        const GSList *l;
-       uint8_t channel_bit;
+       uint16_t channel_bit;
        char *tc;
 
        devc = sdi->priv;
-       devc->trigger_pattern = 0;
-       devc->trigger_mask = 0; /* Default to "don't care" for all channels. */
+       devc->trigger_pattern = 0x0000; /* Default to "low" trigger. */
+       devc->trigger_mask = 0x0000; /* Default to "don't care". */
+       devc->trigger_edgemask = 0x0000; /* Default to "state triggered". */
 
        for (l = sdi->channels; l; l = l->next) {
                ch = (struct sr_channel *)l->data;
@@ -313,37 +290,48 @@ SR_PRIV int configure_channels(const struct sr_dev_inst *sdi)
                        continue;
 
                /* Note: Must only be run if ch->trigger != NULL. */
-               if (ch->index < 0 || ch->index > 7) {
-                       sr_err("%s: Invalid channel index %d, must be "
-                              "between 0 and 7.", __func__, ch->index);
+               if (ch->index < 0 || ch->index > (int)devc->prof->num_channels - 1) {
+                       sr_err("Invalid channel index %d, must be "
+                              "between 0 and %d.", ch->index,
+                              devc->prof->num_channels - 1);
                        return SR_ERR;
                }
 
                channel_bit = (1 << (ch->index));
 
-               /* Configure the channel's trigger mask and trigger pattern. */
+               /* Configure the channel's trigger pattern/mask/edgemask. */
                for (tc = ch->trigger; tc && *tc; tc++) {
                        devc->trigger_mask |= channel_bit;
 
                        /* Sanity check, LA8 only supports low/high trigger. */
-                       if (*tc != '0' && *tc != '1') {
-                               sr_err("%s: Invalid trigger '%c', only "
-                                      "'0'/'1' supported.", __func__, *tc);
+                       if ((devc->prof->model == CHRONOVU_LA8) &&
+                           (*tc != '0' && *tc != '1')) {
+                               sr_err("Invalid trigger '%c', only "
+                                      "'0'/'1' supported.", *tc);
                                return SR_ERR;
                        }
 
-                       if (*tc == '1')
+                       /* state: 1 == high, edge: 1 == rising edge. */
+                       if (*tc == '1' || *tc == 'r')
                                devc->trigger_pattern |= channel_bit;
+
+                       /* LA16 (but not LA8) supports edge triggering. */
+                       if ((devc->prof->model == CHRONOVU_LA16)) {
+                               if (*tc == 'r' || *tc == 'f')
+                                       devc->trigger_edgemask |= channel_bit;
+                       }
+
                }
        }
 
-       sr_dbg("Trigger mask = 0x%x, trigger pattern = 0x%x.",
-              devc->trigger_mask, devc->trigger_pattern);
+       sr_dbg("Trigger pattern/mask/edgemask = 0x%04x / 0x%04x / 0x%04x.",
+              devc->trigger_pattern, devc->trigger_mask,
+              devc->trigger_edgemask);
 
        return SR_OK;
 }
 
-SR_PRIV int set_samplerate(const struct sr_dev_inst *sdi, uint64_t samplerate)
+SR_PRIV int cv_set_samplerate(const struct sr_dev_inst *sdi, uint64_t samplerate)
 {
        struct dev_context *devc;
 
@@ -353,13 +341,15 @@ SR_PRIV int set_samplerate(const struct sr_dev_inst *sdi, uint64_t samplerate)
 
        sr_spew("Trying to set samplerate to %" PRIu64 "Hz.", samplerate);
 
-       fill_supported_samplerates_if_needed();
+       cv_fill_samplerates_if_needed(sdi);
 
        /* Check if this is a samplerate supported by the hardware. */
-       if (!is_valid_samplerate(samplerate))
+       if (!is_valid_samplerate(sdi, samplerate)) {
+               sr_dbg("Failed to set invalid samplerate (%" PRIu64 "Hz).",
+                      samplerate);
                return SR_ERR;
+       }
 
-       /* Set the new samplerate. */
        devc->cur_samplerate = samplerate;
 
        sr_dbg("Samplerate set to %" PRIu64 "Hz.", devc->cur_samplerate);
@@ -368,37 +358,38 @@ SR_PRIV int set_samplerate(const struct sr_dev_inst *sdi, uint64_t samplerate)
 }
 
 /**
- * Get a block of data from the LA8.
+ * Get a block of data from the device.
  *
  * @param devc The struct containing private per-device-instance data. Must not
- *            be NULL. devc->ftdic must not be NULL either.
+ *             be NULL. devc->ftdic must not be NULL either.
+ *
  * @return SR_OK upon success, or SR_ERR upon errors.
  */
-SR_PRIV int la8_read_block(struct dev_context *devc)
+SR_PRIV int cv_read_block(struct dev_context *devc)
 {
-       int i, byte_offset, m, mi, p, index, bytes_read;
-       time_t now;
+       int i, byte_offset, m, mi, p, q, index, bytes_read;
+       gint64 now;
 
        /* Note: Caller checked that devc and devc->ftdic != NULL. */
 
        sr_spew("Reading block %d.", devc->block_counter);
 
-       bytes_read = la8_read(devc, devc->mangled_buf, BS);
+       bytes_read = cv_read(devc, devc->mangled_buf, BS);
 
        /* If first block read got 0 bytes, retry until success or timeout. */
        if ((bytes_read == 0) && (devc->block_counter == 0)) {
                do {
                        sr_spew("Reading block 0 (again).");
-                       bytes_read = la8_read(devc, devc->mangled_buf, BS);
-                       /* TODO: How to handle read errors here? */
-                       now = time(NULL);
+                       /* Note: If bytes_read < 0 cv_read() will log errors. */
+                       bytes_read = cv_read(devc, devc->mangled_buf, BS);
+                       now = g_get_monotonic_time();
                } while ((devc->done > now) && (bytes_read == 0));
        }
 
        /* Check if block read was successful or a timeout occured. */
        if (bytes_read != BS) {
                sr_err("Trigger timed out. Bytes read: %d.", bytes_read);
-               (void) la8_reset(devc); /* Ignore errors. */
+               (void) reset_device(devc); /* Ignore errors. */
                return SR_ERR;
        }
 
@@ -408,16 +399,23 @@ SR_PRIV int la8_read_block(struct dev_context *devc)
        m = byte_offset / (1024 * 1024);
        mi = m * (1024 * 1024);
        for (i = 0; i < BS; i++) {
-               p = i & (1 << 0);
-               index = m * 2 + (((byte_offset + i) - mi) / 2) * 16;
-               index += (devc->divcount == 0) ? p : (1 - p);
+               if (devc->prof->model == CHRONOVU_LA8) {
+                       p = i & (1 << 0);
+                       index = m * 2 + (((byte_offset + i) - mi) / 2) * 16;
+                       index += (devc->divcount == 0) ? p : (1 - p);
+               } else {
+                       p = i & (1 << 0);
+                       q = i & (1 << 1);
+                       index = m * 4 + (((byte_offset + i) - mi) / 4) * 32;
+                       index += q + (1 - p);
+               }
                devc->final_buf[index] = devc->mangled_buf[i];
        }
 
        return SR_OK;
 }
 
-SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
+SR_PRIV void cv_send_block_to_session_bus(struct dev_context *devc, int block)
 {
        int i;
        uint8_t sample, expected_sample;
@@ -425,7 +423,9 @@ SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
        struct sr_datafeed_logic logic;
        int trigger_point; /* Relative trigger point (in this block). */
 
-       /* Note: No sanity checks on devc/block, caller is responsible. */
+       /* Note: Caller ensures devc/devc->ftdic != NULL and block > 0. */
+
+       /* TODO: Implement/test proper trigger support for the LA16. */
 
        /* Check if we can find the trigger condition in this block. */
        trigger_point = -1;
@@ -440,7 +440,7 @@ SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
                 * no trigger conditions were specified by the user. In that
                 * case we don't want to send an SR_DF_TRIGGER packet at all.
                 */
-               if (devc->trigger_mask == 0x00)
+               if (devc->trigger_mask == 0x0000)
                        break;
 
                sample = *(devc->final_buf + (block * BS) + i);
@@ -460,7 +460,7 @@ SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
                packet.type = SR_DF_LOGIC;
                packet.payload = &logic;
                logic.length = BS;
-               logic.unitsize = 1;
+               logic.unitsize = devc->prof->num_channels / 8;
                logic.data = devc->final_buf + (block * BS);
                sr_session_send(devc->cb_data, &packet);
                return;
@@ -483,7 +483,7 @@ SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
                packet.type = SR_DF_LOGIC;
                packet.payload = &logic;
                logic.length = trigger_point;
-               logic.unitsize = 1;
+               logic.unitsize = devc->prof->num_channels / 8;
                logic.data = devc->final_buf + (block * BS);
                sr_session_send(devc->cb_data, &packet);
        }
@@ -504,7 +504,7 @@ SR_PRIV void send_block_to_session_bus(struct dev_context *devc, int block)
                packet.type = SR_DF_LOGIC;
                packet.payload = &logic;
                logic.length = BS - trigger_point;
-               logic.unitsize = 1;
+               logic.unitsize = devc->prof->num_channels / 8;
                logic.data = devc->final_buf + (block * BS) + trigger_point;
                sr_session_send(devc->cb_data, &packet);
        }