saleae-logic16: Fix acquisition with fewer than nine channels enabled.

This commit is contained in:
Bert Vermeulen 2014-05-29 22:55:52 +02:00
parent 863357fb10
commit a989cdbe03
3 changed files with 11 additions and 76 deletions

View File

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

View File

@ -632,9 +632,8 @@ static void resubmit_transfer(struct libusb_transfer *transfer)
sr_err("%s: %s", __func__, libusb_error_name(ret)); sr_err("%s: %s", __func__, libusb_error_name(ret));
} }
static size_t convert_sample_data_16(struct dev_context *devc, static size_t convert_sample_data(struct dev_context *devc,
uint8_t *dest, size_t destcnt, uint8_t *dest, size_t destcnt, const uint8_t *src, size_t srccnt)
const uint8_t *src, size_t srccnt)
{ {
uint16_t *channel_data; uint16_t *channel_data;
int i, cur_channel; int i, cur_channel;
@ -675,60 +674,6 @@ static size_t convert_sample_data_16(struct dev_context *devc,
return ret; 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) SR_PRIV void logic16_receive_transfer(struct libusb_transfer *transfer)
{ {
gboolean packet_has_error = FALSE; 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, new_samples = convert_sample_data(devc, devc->convbuffer,
devc->convbuffer_size, transfer->buffer, devc->convbuffer_size, transfer->buffer, transfer->actual_length);
transfer->actual_length, devc->unitsize);
if (new_samples > 0) { if (new_samples > 0) {
if (devc->trigger_fired) { if (devc->trigger_fired) {
@ -802,14 +746,14 @@ SR_PRIV void logic16_receive_transfer(struct libusb_transfer *transfer)
if (devc->limit_samples && if (devc->limit_samples &&
new_samples > devc->limit_samples - devc->sent_samples) new_samples > devc->limit_samples - devc->sent_samples)
new_samples = devc->limit_samples - devc->sent_samples; new_samples = devc->limit_samples - devc->sent_samples;
logic.length = new_samples * devc->unitsize; logic.length = new_samples * 2;
logic.unitsize = devc->unitsize; logic.unitsize = 2;
logic.data = devc->convbuffer; logic.data = devc->convbuffer;
sr_session_send(devc->cb_data, &packet); sr_session_send(devc->cb_data, &packet);
devc->sent_samples += new_samples; devc->sent_samples += new_samples;
} else { } else {
trigger_offset = soft_trigger_logic_check(devc->stl, trigger_offset = soft_trigger_logic_check(devc->stl,
devc->convbuffer, new_samples * devc->unitsize); devc->convbuffer, new_samples * 2);
if (trigger_offset > -1) { if (trigger_offset > -1) {
packet.type = SR_DF_LOGIC; packet.type = SR_DF_LOGIC;
packet.payload = &logic; packet.payload = &logic;
@ -817,9 +761,9 @@ SR_PRIV void logic16_receive_transfer(struct libusb_transfer *transfer)
if (devc->limit_samples && if (devc->limit_samples &&
num_samples > devc->limit_samples - devc->sent_samples) num_samples > devc->limit_samples - devc->sent_samples)
num_samples = devc->limit_samples - devc->sent_samples; num_samples = devc->limit_samples - devc->sent_samples;
logic.length = num_samples * devc->unitsize; logic.length = num_samples * 2;
logic.unitsize = devc->unitsize; logic.unitsize = 2;
logic.data = devc->convbuffer + trigger_offset * devc->unitsize; logic.data = devc->convbuffer + trigger_offset * 2;
sr_session_send(devc->cb_data, &packet); sr_session_send(devc->cb_data, &packet);
devc->sent_samples += num_samples; devc->sent_samples += num_samples;

View File

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