demo: Add all-low/all-high pattern support.
Also, improve error handling a bit.
This commit is contained in:
parent
c8f4624d9b
commit
c03ed39733
|
@ -31,9 +31,13 @@
|
||||||
#endif
|
#endif
|
||||||
#include "config.h"
|
#include "config.h"
|
||||||
|
|
||||||
|
/* TODO: Number of probes should be configurable. */
|
||||||
#define NUM_PROBES 8
|
#define NUM_PROBES 8
|
||||||
|
|
||||||
#define DEMONAME "Demo device"
|
#define DEMONAME "Demo device"
|
||||||
/* size of chunks to send through the session bus */
|
|
||||||
|
/* The size of chunks to send through the session bus. */
|
||||||
|
/* TODO: Should be configurable. */
|
||||||
#define BUFSIZE 4096
|
#define BUFSIZE 4096
|
||||||
|
|
||||||
/* Supported patterns which we can generate */
|
/* Supported patterns which we can generate */
|
||||||
|
@ -44,9 +48,7 @@ enum {
|
||||||
*/
|
*/
|
||||||
PATTERN_SIGROK,
|
PATTERN_SIGROK,
|
||||||
|
|
||||||
/**
|
/** Pattern which consists of (pseudo-)random values on all probes. */
|
||||||
* Pattern which consists of (pseudo-)random values on all probes.
|
|
||||||
*/
|
|
||||||
PATTERN_RANDOM,
|
PATTERN_RANDOM,
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -54,6 +56,12 @@ enum {
|
||||||
* TODO: Better description.
|
* TODO: Better description.
|
||||||
*/
|
*/
|
||||||
PATTERN_INC,
|
PATTERN_INC,
|
||||||
|
|
||||||
|
/** Pattern where all probes have a low logic state. */
|
||||||
|
PATTERN_ALL_LOW,
|
||||||
|
|
||||||
|
/** Pattern where all probes have a high logic state. */
|
||||||
|
PATTERN_ALL_HIGH,
|
||||||
};
|
};
|
||||||
|
|
||||||
/* FIXME: Should not be global. */
|
/* FIXME: Should not be global. */
|
||||||
|
@ -86,8 +94,11 @@ static struct sr_samplerates samplerates = {
|
||||||
};
|
};
|
||||||
|
|
||||||
static const char *pattern_strings[] = {
|
static const char *pattern_strings[] = {
|
||||||
|
"sigrok",
|
||||||
"random",
|
"random",
|
||||||
"incremental",
|
"incremental",
|
||||||
|
"all-low",
|
||||||
|
"all-high",
|
||||||
NULL,
|
NULL,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
@ -121,8 +132,10 @@ static int hw_init(const char *deviceinfo)
|
||||||
deviceinfo = deviceinfo;
|
deviceinfo = deviceinfo;
|
||||||
|
|
||||||
sdi = sr_device_instance_new(0, SR_ST_ACTIVE, DEMONAME, NULL, NULL);
|
sdi = sr_device_instance_new(0, SR_ST_ACTIVE, DEMONAME, NULL, NULL);
|
||||||
if (!sdi)
|
if (!sdi) {
|
||||||
|
sr_err("demo: %s: sr_device_instance_new failed", __func__);
|
||||||
return 0;
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
device_instances = g_slist_append(device_instances, sdi);
|
device_instances = g_slist_append(device_instances, sdi);
|
||||||
|
|
||||||
|
@ -159,8 +172,10 @@ static void *hw_get_device_info(int device_index, int device_info_id)
|
||||||
struct sr_device_instance *sdi;
|
struct sr_device_instance *sdi;
|
||||||
void *info = NULL;
|
void *info = NULL;
|
||||||
|
|
||||||
if (!(sdi = sr_get_device_instance(device_instances, device_index)))
|
if (!(sdi = sr_get_device_instance(device_instances, device_index))) {
|
||||||
|
sr_err("demo: %s: sdi was NULL", __func__);
|
||||||
return NULL;
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
switch (device_info_id) {
|
switch (device_info_id) {
|
||||||
case SR_DI_INSTANCE:
|
case SR_DI_INSTANCE:
|
||||||
|
@ -224,12 +239,17 @@ static int hw_set_configuration(int device_index, int capability, void *value)
|
||||||
ret = SR_OK;
|
ret = SR_OK;
|
||||||
} else if (capability == SR_HWCAP_PATTERN_MODE) {
|
} else if (capability == SR_HWCAP_PATTERN_MODE) {
|
||||||
stropt = value;
|
stropt = value;
|
||||||
if (!strcmp(stropt, "random")) {
|
|
||||||
default_pattern = PATTERN_RANDOM;
|
|
||||||
ret = SR_OK;
|
ret = SR_OK;
|
||||||
|
if (!strcmp(stropt, "sigrok")) {
|
||||||
|
default_pattern = PATTERN_SIGROK;
|
||||||
|
} else if (!strcmp(stropt, "random")) {
|
||||||
|
default_pattern = PATTERN_RANDOM;
|
||||||
} else if (!strcmp(stropt, "incremental")) {
|
} else if (!strcmp(stropt, "incremental")) {
|
||||||
default_pattern = PATTERN_INC;
|
default_pattern = PATTERN_INC;
|
||||||
ret = SR_OK;
|
} else if (!strcmp(stropt, "all-low")) {
|
||||||
|
default_pattern = PATTERN_ALL_LOW;
|
||||||
|
} else if (!strcmp(stropt, "all-high")) {
|
||||||
|
default_pattern = PATTERN_ALL_HIGH;
|
||||||
} else {
|
} else {
|
||||||
ret = SR_ERR;
|
ret = SR_ERR;
|
||||||
}
|
}
|
||||||
|
@ -248,10 +268,11 @@ static void samples_generator(uint8_t *buf, uint64_t size, void *data)
|
||||||
struct databag *mydata = data;
|
struct databag *mydata = data;
|
||||||
uint64_t i;
|
uint64_t i;
|
||||||
|
|
||||||
|
/* TODO: Needed? */
|
||||||
memset(buf, 0, size);
|
memset(buf, 0, size);
|
||||||
|
|
||||||
switch (mydata->sample_generator) {
|
switch (mydata->sample_generator) {
|
||||||
case PATTERN_SIGROK:
|
case PATTERN_SIGROK: /* sigrok pattern */
|
||||||
for (i = 0; i < size; i++) {
|
for (i = 0; i < size; i++) {
|
||||||
*(buf + i) = ~(pattern_sigrok[p] >> 1);
|
*(buf + i) = ~(pattern_sigrok[p] >> 1);
|
||||||
if (++p == 64)
|
if (++p == 64)
|
||||||
|
@ -266,6 +287,17 @@ static void samples_generator(uint8_t *buf, uint64_t size, void *data)
|
||||||
for (i = 0; i < size; i++)
|
for (i = 0; i < size; i++)
|
||||||
*(buf + i) = i;
|
*(buf + i) = i;
|
||||||
break;
|
break;
|
||||||
|
case PATTERN_ALL_LOW: /* All probes are low */
|
||||||
|
for (i = 0; i < size; i++)
|
||||||
|
*(buf + i) = 0x00;
|
||||||
|
break;
|
||||||
|
case PATTERN_ALL_HIGH: /* All probes are high */
|
||||||
|
for (i = 0; i < size; i++)
|
||||||
|
*(buf + i) = 0xff;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
/* TODO: Error handling. */
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -276,7 +308,6 @@ static void thread_func(void *data)
|
||||||
uint8_t buf[BUFSIZE];
|
uint8_t buf[BUFSIZE];
|
||||||
uint64_t nb_to_send = 0;
|
uint64_t nb_to_send = 0;
|
||||||
int bytes_written;
|
int bytes_written;
|
||||||
|
|
||||||
double time_cur, time_last, time_diff;
|
double time_cur, time_last, time_diff;
|
||||||
|
|
||||||
time_last = g_timer_elapsed(mydata->timer, NULL);
|
time_last = g_timer_elapsed(mydata->timer, NULL);
|
||||||
|
@ -290,9 +321,10 @@ static void thread_func(void *data)
|
||||||
|
|
||||||
nb_to_send = cur_samplerate * time_diff;
|
nb_to_send = cur_samplerate * time_diff;
|
||||||
|
|
||||||
if (limit_samples)
|
if (limit_samples) {
|
||||||
nb_to_send = MIN(nb_to_send,
|
nb_to_send = MIN(nb_to_send,
|
||||||
limit_samples - mydata->samples_counter);
|
limit_samples - mydata->samples_counter);
|
||||||
|
}
|
||||||
|
|
||||||
/* Make sure we don't overflow. */
|
/* Make sure we don't overflow. */
|
||||||
nb_to_send = MIN(nb_to_send, BUFSIZE);
|
nb_to_send = MIN(nb_to_send, BUFSIZE);
|
||||||
|
@ -341,9 +373,8 @@ static int receive_data(int fd, int revents, void *user_data)
|
||||||
}
|
}
|
||||||
} while (z > 0);
|
} while (z > 0);
|
||||||
|
|
||||||
if (!thread_running && z <= 0)
|
if (!thread_running && z <= 0) {
|
||||||
{
|
/* Make sure we don't receive more packets. */
|
||||||
/* Make sure we don't receive more packets */
|
|
||||||
g_io_channel_close(channels[0]);
|
g_io_channel_close(channels[0]);
|
||||||
|
|
||||||
/* Send last packet. */
|
/* Send last packet. */
|
||||||
|
@ -373,8 +404,11 @@ static int hw_start_acquisition(int device_index, gpointer session_device_id)
|
||||||
mydata->device_index = device_index;
|
mydata->device_index = device_index;
|
||||||
mydata->samples_counter = 0;
|
mydata->samples_counter = 0;
|
||||||
|
|
||||||
if (pipe(mydata->pipe_fds))
|
if (pipe(mydata->pipe_fds)) {
|
||||||
|
/* TODO: Better error message. */
|
||||||
|
sr_err("demo: %s: pipe() failed", __func__);
|
||||||
return SR_ERR;
|
return SR_ERR;
|
||||||
|
}
|
||||||
|
|
||||||
channels[0] = g_io_channel_unix_new(mydata->pipe_fds[0]);
|
channels[0] = g_io_channel_unix_new(mydata->pipe_fds[0]);
|
||||||
channels[1] = g_io_channel_unix_new(mydata->pipe_fds[1]);
|
channels[1] = g_io_channel_unix_new(mydata->pipe_fds[1]);
|
||||||
|
@ -392,13 +426,15 @@ static int hw_start_acquisition(int device_index, gpointer session_device_id)
|
||||||
|
|
||||||
/* Run the demo thread. */
|
/* Run the demo thread. */
|
||||||
g_thread_init(NULL);
|
g_thread_init(NULL);
|
||||||
/* this needs to be done between g_thread_init() and g_thread_create() */
|
/* This must to be done between g_thread_init() & g_thread_create(). */
|
||||||
mydata->timer = g_timer_new();
|
mydata->timer = g_timer_new();
|
||||||
thread_running = 1;
|
thread_running = 1;
|
||||||
my_thread =
|
my_thread =
|
||||||
g_thread_create((GThreadFunc)thread_func, mydata, TRUE, NULL);
|
g_thread_create((GThreadFunc)thread_func, mydata, TRUE, NULL);
|
||||||
if (!my_thread)
|
if (!my_thread) {
|
||||||
return SR_ERR;
|
sr_err("demo: %s: g_thread_create failed", __func__);
|
||||||
|
return SR_ERR; /* TODO */
|
||||||
|
}
|
||||||
|
|
||||||
if (!(packet = g_try_malloc(sizeof(struct sr_datafeed_packet)))) {
|
if (!(packet = g_try_malloc(sizeof(struct sr_datafeed_packet)))) {
|
||||||
sr_err("demo: %s: packet malloc failed", __func__);
|
sr_err("demo: %s: packet malloc failed", __func__);
|
||||||
|
|
Loading…
Reference in New Issue