saleae-logic16: Use unitsize 1 if none of channels 8-15 are used.

This commit is contained in:
Marcus Comstedt 2014-04-25 21:27:49 +02:00 committed by Uwe Hermann
parent 2db959063b
commit 1b822521f7
3 changed files with 76 additions and 11 deletions

View File

@ -653,6 +653,17 @@ static int configure_channels(const struct sr_dev_inst *sdi)
devc->channel_masks[devc->num_channels++] = channel_bit;
}
if (devc->cur_channels & ~0xff) {
devc->unitsize = 2;
} else {
#ifdef WORDS_BIGENDIAN
int i;
for (i=0; i<devc->num_channels; i++)
devc->channel_masks[i] >>= 8;
#endif
devc->unitsize = 1;
}
return SR_OK;
}

View File

@ -628,9 +628,9 @@ static void resubmit_transfer(struct libusb_transfer *transfer)
sr_err("%s: %s", __func__, libusb_error_name(ret));
}
static size_t convert_sample_data(struct dev_context *devc,
uint8_t *dest, size_t destcnt,
const uint8_t *src, size_t srccnt)
static size_t convert_sample_data_16(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;
@ -661,7 +661,7 @@ static size_t convert_sample_data(struct dev_context *devc,
memcpy(dest, channel_data, 16 * 2);
memset(channel_data, 0, 16 * 2);
dest += 16 * 2;
ret += 16 * 2;
ret += 16;
destcnt -= 16 * 2;
}
}
@ -671,6 +671,60 @@ static size_t convert_sample_data(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;
@ -733,26 +787,26 @@ SR_PRIV void logic16_receive_transfer(struct libusb_transfer *transfer)
converted_length = convert_sample_data(devc, devc->convbuffer,
devc->convbuffer_size, transfer->buffer,
transfer->actual_length);
transfer->actual_length, devc->unitsize);
if (converted_length > 0) {
/* Cap sample count if needed */
if (devc->limit_samples &&
(uint64_t)devc->num_samples + converted_length / 2
(uint64_t)devc->num_samples + converted_length
> devc->limit_samples) {
converted_length =
(devc->limit_samples - devc->num_samples) * 2;
devc->limit_samples - devc->num_samples;
}
/* Send the incoming transfer to the session bus. */
packet.type = SR_DF_LOGIC;
packet.payload = &logic;
logic.length = converted_length;
logic.unitsize = 2;
logic.length = converted_length * devc->unitsize;
logic.unitsize = devc->unitsize;
logic.data = devc->convbuffer;
sr_session_send(devc->cb_data, &packet);
devc->num_samples += converted_length / 2;
devc->num_samples += converted_length;
if (devc->limit_samples &&
(uint64_t)devc->num_samples >= devc->limit_samples) {
devc->num_samples = -2;

View File

@ -66,7 +66,7 @@ struct dev_context {
int64_t num_samples;
int submitted_transfers;
int empty_transfer_count;
int num_channels, cur_channel;
int num_channels, cur_channel, unitsize;
uint16_t channel_masks[16];
uint16_t channel_data[16];
uint8_t *convbuffer;