ols: Code cleanup and more debug output.
This commit is contained in:
parent
016e72f30e
commit
625763e2c2
|
@ -537,11 +537,12 @@ static int dev_acquisition_start(const struct sr_dev_inst *sdi,
|
||||||
return SR_ERR;
|
return SR_ERR;
|
||||||
|
|
||||||
/* Flag register. */
|
/* Flag register. */
|
||||||
sr_dbg("Setting demux %s, noise_filter %s, extpat %s, intpat %s",
|
sr_dbg("Setting intpat %s, extpat %s, RLE %s, noise_filter %s, demux %s",
|
||||||
devc->flag_reg & FLAG_DEMUX ? "on" : "off",
|
devc->flag_reg & FLAG_INTERNAL_TEST_MODE ? "on": "off",
|
||||||
devc->flag_reg & FLAG_FILTER ? "on": "off",
|
|
||||||
devc->flag_reg & FLAG_EXTERNAL_TEST_MODE ? "on": "off",
|
devc->flag_reg & FLAG_EXTERNAL_TEST_MODE ? "on": "off",
|
||||||
devc->flag_reg & FLAG_INTERNAL_TEST_MODE ? "on": "off");
|
devc->flag_reg & FLAG_RLE ? "on" : "off",
|
||||||
|
devc->flag_reg & FLAG_FILTER ? "on": "off",
|
||||||
|
devc->flag_reg & FLAG_DEMUX ? "on" : "off");
|
||||||
/* 1 means "disable channel". */
|
/* 1 means "disable channel". */
|
||||||
devc->flag_reg |= ~(changrp_mask << 2) & 0x3c;
|
devc->flag_reg |= ~(changrp_mask << 2) & 0x3c;
|
||||||
arg[0] = devc->flag_reg & 0xff;
|
arg[0] = devc->flag_reg & 0xff;
|
||||||
|
@ -557,6 +558,7 @@ static int dev_acquisition_start(const struct sr_dev_inst *sdi,
|
||||||
/* Reset all operational states. */
|
/* Reset all operational states. */
|
||||||
devc->rle_count = devc->num_transfers = 0;
|
devc->rle_count = devc->num_transfers = 0;
|
||||||
devc->num_samples = devc->num_bytes = 0;
|
devc->num_samples = devc->num_bytes = 0;
|
||||||
|
devc->cnt_bytes = devc->cnt_samples = devc->cnt_samples_rle = 0;
|
||||||
memset(devc->sample, 0, 4);
|
memset(devc->sample, 0, 4);
|
||||||
|
|
||||||
/* Send header packet to the session bus. */
|
/* Send header packet to the session bus. */
|
||||||
|
|
|
@ -150,8 +150,12 @@ SR_PRIV struct sr_dev_inst *get_metadata(struct sr_serial_dev_inst *serial)
|
||||||
|
|
||||||
key = 0xff;
|
key = 0xff;
|
||||||
while (key) {
|
while (key) {
|
||||||
if (serial_read_blocking(serial, &key, 1) != 1 || key == 0x00)
|
if (serial_read_blocking(serial, &key, 1) != 1)
|
||||||
break;
|
break;
|
||||||
|
if (key == 0x00) {
|
||||||
|
sr_dbg("Got metadata key 0x00, metadata ends.");
|
||||||
|
break;
|
||||||
|
}
|
||||||
type = key >> 5;
|
type = key >> 5;
|
||||||
token = key & 0x1f;
|
token = key & 0x1f;
|
||||||
switch (type) {
|
switch (type) {
|
||||||
|
@ -318,35 +322,21 @@ SR_PRIV void abort_acquisition(const struct sr_dev_inst *sdi)
|
||||||
|
|
||||||
SR_PRIV int ols_receive_data(int fd, int revents, void *cb_data)
|
SR_PRIV int ols_receive_data(int fd, int revents, void *cb_data)
|
||||||
{
|
{
|
||||||
struct drv_context *drvc;
|
|
||||||
struct dev_context *devc;
|
struct dev_context *devc;
|
||||||
|
struct sr_dev_inst *sdi;
|
||||||
struct sr_serial_dev_inst *serial;
|
struct sr_serial_dev_inst *serial;
|
||||||
struct sr_datafeed_packet packet;
|
struct sr_datafeed_packet packet;
|
||||||
struct sr_datafeed_logic logic;
|
struct sr_datafeed_logic logic;
|
||||||
struct sr_dev_inst *sdi;
|
|
||||||
GSList *l;
|
|
||||||
uint32_t sample;
|
uint32_t sample;
|
||||||
int num_channels, offset, j;
|
int num_channels, offset, j;
|
||||||
unsigned int i;
|
unsigned int i;
|
||||||
unsigned char byte;
|
unsigned char byte;
|
||||||
int serial_fd;
|
|
||||||
|
|
||||||
drvc = di->priv;
|
(void)fd;
|
||||||
|
|
||||||
/* Find this device's devc struct by its fd. */
|
sdi = cb_data;
|
||||||
devc = NULL;
|
|
||||||
for (l = drvc->instances; l; l = l->next) {
|
|
||||||
sdi = l->data;
|
|
||||||
devc = sdi->priv;
|
|
||||||
serial = sdi->conn;
|
serial = sdi->conn;
|
||||||
sp_get_port_handle(serial->data, &serial_fd);
|
devc = sdi->priv;
|
||||||
if (serial_fd == fd)
|
|
||||||
break;
|
|
||||||
devc = NULL;
|
|
||||||
}
|
|
||||||
if (!devc)
|
|
||||||
/* Shouldn't happen. */
|
|
||||||
return TRUE;
|
|
||||||
|
|
||||||
if (devc->num_transfers++ == 0) {
|
if (devc->num_transfers++ == 0) {
|
||||||
/*
|
/*
|
||||||
|
@ -367,7 +357,6 @@ SR_PRIV int ols_receive_data(int fd, int revents, void *cb_data)
|
||||||
}
|
}
|
||||||
|
|
||||||
num_channels = 0;
|
num_channels = 0;
|
||||||
|
|
||||||
for (i = NUM_PROBES; i > 0x02; i /= 2) {
|
for (i = NUM_PROBES; i > 0x02; i /= 2) {
|
||||||
if ((devc->flag_reg & i) == 0) {
|
if ((devc->flag_reg & i) == 0) {
|
||||||
num_channels++;
|
num_channels++;
|
||||||
|
@ -377,6 +366,7 @@ SR_PRIV int ols_receive_data(int fd, int revents, void *cb_data)
|
||||||
if (revents == G_IO_IN && devc->num_samples < devc->limit_samples) {
|
if (revents == G_IO_IN && devc->num_samples < devc->limit_samples) {
|
||||||
if (serial_read_nonblocking(serial, &byte, 1) != 1)
|
if (serial_read_nonblocking(serial, &byte, 1) != 1)
|
||||||
return FALSE;
|
return FALSE;
|
||||||
|
devc->cnt_bytes++;
|
||||||
|
|
||||||
/* Ignore it if we've read enough. */
|
/* Ignore it if we've read enough. */
|
||||||
if (devc->num_samples >= devc->limit_samples)
|
if (devc->num_samples >= devc->limit_samples)
|
||||||
|
@ -385,11 +375,15 @@ SR_PRIV int ols_receive_data(int fd, int revents, void *cb_data)
|
||||||
devc->sample[devc->num_bytes++] = byte;
|
devc->sample[devc->num_bytes++] = byte;
|
||||||
sr_spew("Received byte 0x%.2x.", byte);
|
sr_spew("Received byte 0x%.2x.", byte);
|
||||||
if (devc->num_bytes == num_channels) {
|
if (devc->num_bytes == num_channels) {
|
||||||
/* Got a full sample. Convert from the OLS's little-endian
|
devc->cnt_samples++;
|
||||||
* sample to the local format. */
|
devc->cnt_samples_rle++;
|
||||||
|
/*
|
||||||
|
* Got a full sample. Convert from the OLS's little-endian
|
||||||
|
* sample to the local format.
|
||||||
|
*/
|
||||||
sample = devc->sample[0] | (devc->sample[1] << 8) \
|
sample = devc->sample[0] | (devc->sample[1] << 8) \
|
||||||
| (devc->sample[2] << 16) | (devc->sample[3] << 24);
|
| (devc->sample[2] << 16) | (devc->sample[3] << 24);
|
||||||
sr_spew("Received sample 0x%.*x.", devc->num_bytes * 2, sample);
|
sr_dbg("Received sample 0x%.*x.", devc->num_bytes * 2, sample);
|
||||||
if (devc->flag_reg & FLAG_RLE) {
|
if (devc->flag_reg & FLAG_RLE) {
|
||||||
/*
|
/*
|
||||||
* In RLE mode the high bit of the sample is the
|
* In RLE mode the high bit of the sample is the
|
||||||
|
@ -400,6 +394,7 @@ SR_PRIV int ols_receive_data(int fd, int revents, void *cb_data)
|
||||||
/* Clear the high bit. */
|
/* Clear the high bit. */
|
||||||
sample &= ~(0x80 << (devc->num_bytes - 1) * 8);
|
sample &= ~(0x80 << (devc->num_bytes - 1) * 8);
|
||||||
devc->rle_count = sample;
|
devc->rle_count = sample;
|
||||||
|
devc->cnt_samples_rle += devc->rle_count;
|
||||||
sr_dbg("RLE count: %u.", devc->rle_count);
|
sr_dbg("RLE count: %u.", devc->rle_count);
|
||||||
devc->num_bytes = 0;
|
devc->num_bytes = 0;
|
||||||
return TRUE;
|
return TRUE;
|
||||||
|
@ -438,10 +433,11 @@ SR_PRIV int ols_receive_data(int fd, int revents, void *cb_data)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
memcpy(devc->sample, devc->tmp_sample, 4);
|
memcpy(devc->sample, devc->tmp_sample, 4);
|
||||||
sr_dbg("Full sample: 0x%.8x.", sample);
|
sr_spew("Expanded sample: 0x%.8x.", sample);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* the OLS sends its sample buffer backwards.
|
/*
|
||||||
|
* the OLS sends its sample buffer backwards.
|
||||||
* store it in reverse order here, so we can dump
|
* store it in reverse order here, so we can dump
|
||||||
* this on the session bus later.
|
* this on the session bus later.
|
||||||
*/
|
*/
|
||||||
|
@ -460,12 +456,16 @@ SR_PRIV int ols_receive_data(int fd, int revents, void *cb_data)
|
||||||
* we've acquired all the samples we asked for -- we're done.
|
* we've acquired all the samples we asked for -- we're done.
|
||||||
* Send the (properly-ordered) buffer to the frontend.
|
* Send the (properly-ordered) buffer to the frontend.
|
||||||
*/
|
*/
|
||||||
|
sr_dbg("Received %d bytes, %d samples, %d decompressed samples.",
|
||||||
|
devc->cnt_bytes, devc->cnt_samples,
|
||||||
|
devc->cnt_samples_rle);
|
||||||
if (devc->trigger_at != -1) {
|
if (devc->trigger_at != -1) {
|
||||||
/* a trigger was set up, so we need to tell the frontend
|
/*
|
||||||
|
* A trigger was set up, so we need to tell the frontend
|
||||||
* about it.
|
* about it.
|
||||||
*/
|
*/
|
||||||
if (devc->trigger_at > 0) {
|
if (devc->trigger_at > 0) {
|
||||||
/* there are pre-trigger samples, send those first */
|
/* There are pre-trigger samples, send those first. */
|
||||||
packet.type = SR_DF_LOGIC;
|
packet.type = SR_DF_LOGIC;
|
||||||
packet.payload = &logic;
|
packet.payload = &logic;
|
||||||
logic.length = devc->trigger_at * 4;
|
logic.length = devc->trigger_at * 4;
|
||||||
|
@ -475,11 +475,11 @@ SR_PRIV int ols_receive_data(int fd, int revents, void *cb_data)
|
||||||
sr_session_send(cb_data, &packet);
|
sr_session_send(cb_data, &packet);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* send the trigger */
|
/* Send the trigger. */
|
||||||
packet.type = SR_DF_TRIGGER;
|
packet.type = SR_DF_TRIGGER;
|
||||||
sr_session_send(cb_data, &packet);
|
sr_session_send(cb_data, &packet);
|
||||||
|
|
||||||
/* send post-trigger samples */
|
/* Send post-trigger samples. */
|
||||||
packet.type = SR_DF_LOGIC;
|
packet.type = SR_DF_LOGIC;
|
||||||
packet.payload = &logic;
|
packet.payload = &logic;
|
||||||
logic.length = (devc->num_samples * 4) - (devc->trigger_at * 4);
|
logic.length = (devc->num_samples * 4) - (devc->trigger_at * 4);
|
||||||
|
|
|
@ -91,6 +91,9 @@ struct dev_context {
|
||||||
unsigned int num_transfers;
|
unsigned int num_transfers;
|
||||||
unsigned int num_samples;
|
unsigned int num_samples;
|
||||||
int num_bytes;
|
int num_bytes;
|
||||||
|
int cnt_bytes;
|
||||||
|
int cnt_samples;
|
||||||
|
int cnt_samples_rle;
|
||||||
|
|
||||||
/* Temporary variables */
|
/* Temporary variables */
|
||||||
unsigned int rle_count;
|
unsigned int rle_count;
|
||||||
|
|
Loading…
Reference in New Issue