]> sigrok.org Git - libsigrok.git/blobdiff - hardware/saleae-logic16/protocol.c
norma-dmm: Added request timeout mechanism; docs.
[libsigrok.git] / hardware / saleae-logic16 / protocol.c
index 288c7de5d2f5217640d310149152e4555fdc764d..8b430d90c01e91e5d62ce2c87af853faaa19376f 100644 (file)
@@ -632,9 +632,8 @@ static void resubmit_transfer(struct libusb_transfer *transfer)
        sr_err("%s: %s", __func__, libusb_error_name(ret));
 }
 
-static size_t convert_sample_data_16(struct dev_context *devc,
-                                    uint8_t *dest, size_t destcnt,
-                                    const uint8_t *src, size_t srccnt)
+static size_t convert_sample_data(struct dev_context *devc,
+               uint8_t *dest, size_t destcnt, const uint8_t *src, size_t srccnt)
 {
        uint16_t *channel_data;
        int i, cur_channel;
@@ -675,60 +674,6 @@ static size_t convert_sample_data_16(struct dev_context *devc,
        return ret;
 }
 
-static size_t convert_sample_data_8(struct dev_context *devc,
-                                   uint8_t *dest, size_t destcnt,
-                                   const uint8_t *src, size_t srccnt)
-{
-       uint8_t *channel_data;
-       int i, cur_channel;
-       size_t ret = 0;
-       uint16_t sample;
-       uint8_t channel_mask;
-
-       srccnt /= 2;
-
-       channel_data = (uint8_t *)devc->channel_data;
-       cur_channel = devc->cur_channel;
-
-       while (srccnt--) {
-               sample = src[0] | (src[1] << 8);
-               src += 2;
-
-               channel_mask = devc->channel_masks[cur_channel];
-
-               for (i = 15; i >= 0; --i, sample >>= 1)
-                       if (sample & 1)
-                               channel_data[i] |= channel_mask;
-
-               if (++cur_channel == devc->num_channels) {
-                       cur_channel = 0;
-                       if (destcnt < 16) {
-                               sr_err("Conversion buffer too small!");
-                               break;
-                       }
-                       memcpy(dest, channel_data, 16);
-                       memset(channel_data, 0, 16);
-                       dest += 16;
-                       ret += 16;
-                       destcnt -= 16;
-               }
-       }
-
-       devc->cur_channel = cur_channel;
-
-       return ret;
-}
-
-static size_t convert_sample_data(struct dev_context *devc,
-                                 uint8_t *dest, size_t destcnt,
-                                 const uint8_t *src, size_t srccnt,
-                                 int unitsize)
-{
-       return (unitsize == 2 ?
-               convert_sample_data_16(devc, dest, destcnt, src, srccnt) :
-               convert_sample_data_8(devc, dest, destcnt, src, srccnt));
-}
-
 SR_PRIV void logic16_receive_transfer(struct libusb_transfer *transfer)
 {
        gboolean packet_has_error = FALSE;
@@ -791,8 +736,7 @@ SR_PRIV void logic16_receive_transfer(struct libusb_transfer *transfer)
        }
 
        new_samples = convert_sample_data(devc, devc->convbuffer,
-                       devc->convbuffer_size, transfer->buffer,
-                       transfer->actual_length, devc->unitsize);
+                       devc->convbuffer_size, transfer->buffer, transfer->actual_length);
 
        if (new_samples > 0) {
                if (devc->trigger_fired) {
@@ -802,14 +746,14 @@ SR_PRIV void logic16_receive_transfer(struct libusb_transfer *transfer)
                        if (devc->limit_samples &&
                                        new_samples > devc->limit_samples - devc->sent_samples)
                                new_samples = devc->limit_samples - devc->sent_samples;
-                       logic.length = new_samples * devc->unitsize;
-                       logic.unitsize = devc->unitsize;
+                       logic.length = new_samples * 2;
+                       logic.unitsize = 2;
                        logic.data = devc->convbuffer;
                        sr_session_send(devc->cb_data, &packet);
                        devc->sent_samples += new_samples;
                } else {
                        trigger_offset = soft_trigger_logic_check(devc->stl,
-                                       devc->convbuffer, new_samples * devc->unitsize);
+                                       devc->convbuffer, new_samples * 2);
                        if (trigger_offset > -1) {
                                packet.type = SR_DF_LOGIC;
                                packet.payload = &logic;
@@ -817,9 +761,9 @@ SR_PRIV void logic16_receive_transfer(struct libusb_transfer *transfer)
                                if (devc->limit_samples &&
                                                num_samples > devc->limit_samples - devc->sent_samples)
                                        num_samples = devc->limit_samples - devc->sent_samples;
-                               logic.length = num_samples * devc->unitsize;
-                               logic.unitsize = devc->unitsize;
-                               logic.data = devc->convbuffer + trigger_offset * devc->unitsize;
+                               logic.length = num_samples * 2;
+                               logic.unitsize = 2;
+                               logic.data = devc->convbuffer + trigger_offset * 2;
                                sr_session_send(devc->cb_data, &packet);
                                devc->sent_samples += num_samples;