Demo: Obery samplerate and fix race condition.

This commit is contained in:
Håvard Espeland 2011-01-19 23:14:17 +01:00
parent 576790ff7b
commit 1924f59f4b
1 changed files with 62 additions and 44 deletions

View File

@ -49,7 +49,6 @@ struct databag {
uint8_t thread_running; uint8_t thread_running;
uint64_t samples_counter; uint64_t samples_counter;
int device_index; int device_index;
int loop_sleep;
gpointer session_device_id; gpointer session_device_id;
GTimer *timer; GTimer *timer;
}; };
@ -81,7 +80,7 @@ static uint8_t genmode_default[] = {
/* List of struct sigrok_device_instance, maintained by opendev()/closedev(). */ /* List of struct sigrok_device_instance, maintained by opendev()/closedev(). */
static GSList *device_instances = NULL; static GSList *device_instances = NULL;
static uint64_t cur_samplerate = 0; static uint64_t cur_samplerate = KHZ(200);
static uint64_t limit_samples = 0; static uint64_t limit_samples = 0;
static uint64_t limit_msec = 0; static uint64_t limit_msec = 0;
static int default_genmode = GENMODE_DEFAULT; static int default_genmode = GENMODE_DEFAULT;
@ -239,60 +238,83 @@ 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;
unsigned int msec_elapsed;
double time_cur, time_last, time_diff;
time_last = g_timer_elapsed(mydata->timer, NULL);
while (thread_running) { while (thread_running) {
if (limit_samples) /* Rate control */
nb_to_send = limit_samples - mydata->samples_counter; time_cur = g_timer_elapsed(mydata->timer, NULL);
else
nb_to_send = BUFSIZE; /* Continuous mode */
if (limit_msec) { time_diff = time_cur - time_last;
msec_elapsed = g_timer_elapsed(mydata->timer, NULL) * 1000; time_last = time_cur;
if (msec_elapsed > limit_msec)
nb_to_send = 0; nb_to_send = cur_samplerate * time_diff;
if (limit_samples)
nb_to_send = MIN(nb_to_send,
limit_samples - mydata->samples_counter);
/* Make sure we don't overflow. */
nb_to_send = MIN(nb_to_send, BUFSIZE);
if (nb_to_send) {
samples_generator(buf, nb_to_send, data);
mydata->samples_counter += nb_to_send;
g_io_channel_write_chars(channels[1], (gchar *)&buf,
nb_to_send, (gsize *)&bytes_written, NULL);
} }
if (nb_to_send == 0) { /* Check if we're done. */
if ((limit_msec && time_cur * 1000 > limit_msec) ||
(limit_samples && mydata->samples_counter >= limit_samples))
{
close(mydata->pipe_fds[1]); close(mydata->pipe_fds[1]);
thread_running = 0; thread_running = 0;
hw_stop_acquisition(mydata->device_index,
mydata->session_device_id);
} else if (nb_to_send > BUFSIZE) {
nb_to_send = BUFSIZE;
} }
samples_generator(buf, nb_to_send, data); g_usleep(10);
mydata->samples_counter += nb_to_send;
g_io_channel_write_chars(channels[1], (gchar *)&buf,
nb_to_send, (gsize *)&bytes_written, NULL);
g_usleep(mydata->loop_sleep);
} }
} }
/* Callback handling data */ /* Callback handling data */
static int receive_data(int fd, int revents, void *user_data) static int receive_data(int fd, int revents, void *user_data)
{ {
struct datafeed_packet packet; struct datafeed_packet packet;
char c[BUFSIZE]; char c[BUFSIZE];
uint64_t z; uint64_t z;
/* Avoid compiler warnings. */ /* Avoid compiler warnings. */
fd = fd; fd = fd;
revents = revents; revents = revents;
g_io_channel_read_chars(channels[0], (gchar *)&c, BUFSIZE, do {
(gsize *)&z, NULL); g_io_channel_read_chars(channels[0],
(gchar *)&c, BUFSIZE, &z, NULL);
if (z > 0) { if (z > 0) {
packet.type = DF_LOGIC; packet.type = DF_LOGIC;
packet.length = z; packet.length = z;
packet.unitsize = 1; packet.unitsize = 1;
packet.payload = c; packet.payload = c;
session_bus(user_data, &packet);
}
} while (z > 0);
if (!thread_running && z <= 0)
{
/* Make sure we don't receive more packets */
g_io_channel_close(channels[0]);
/* Send last packet. */
packet.type = DF_END;
session_bus(user_data, &packet); session_bus(user_data, &packet);
return FALSE;
} }
return TRUE; return TRUE;
} }
@ -310,7 +332,6 @@ static int hw_start_acquisition(int device_index, gpointer session_device_id)
mydata->session_device_id = session_device_id; mydata->session_device_id = session_device_id;
mydata->device_index = device_index; mydata->device_index = device_index;
mydata->samples_counter = 0; mydata->samples_counter = 0;
mydata->loop_sleep = 100000;
if (pipe(mydata->pipe_fds)) if (pipe(mydata->pipe_fds))
return SIGROK_ERR; return SIGROK_ERR;
@ -331,8 +352,7 @@ 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);
if (limit_msec) 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);
@ -362,14 +382,12 @@ static int hw_start_acquisition(int device_index, gpointer session_device_id)
static void hw_stop_acquisition(int device_index, gpointer session_device_id) static void hw_stop_acquisition(int device_index, gpointer session_device_id)
{ {
struct datafeed_packet packet;
/* Avoid compiler warnings. */ /* Avoid compiler warnings. */
device_index = device_index; device_index = device_index;
session_device_id = session_device_id;
/* Send last packet. */ /* Stop generate thread. */
packet.type = DF_END; thread_running = 0;
session_bus(session_device_id, &packet);
} }
struct device_plugin demo_plugin_info = { struct device_plugin demo_plugin_info = {