]> sigrok.org Git - libsigrok.git/blame - src/session.c
transform: Add a basic set of API calls.
[libsigrok.git] / src / session.c
CommitLineData
a1bb33af 1/*
50985c20 2 * This file is part of the libsigrok project.
a1bb33af 3 *
c73d2ea4 4 * Copyright (C) 2010-2012 Bert Vermeulen <bert@biot.com>
a1bb33af
UH
5 *
6 * This program is free software: you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, either version 3 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
18 */
19
20#include <stdio.h>
21#include <stdlib.h>
22#include <unistd.h>
23#include <string.h>
544a4582 24#include <glib.h>
45c59c8b
BV
25#include "libsigrok.h"
26#include "libsigrok-internal.h"
aa4b1107 27
2ad1deb8 28/** @cond PRIVATE */
3544f848 29#define LOG_PREFIX "session"
2ad1deb8 30/** @endcond */
a421dc1d 31
393fb9cb
UH
32/**
33 * @file
34 *
35 * Creating, using, or destroying libsigrok sessions.
36 */
37
7b870c38
UH
38/**
39 * @defgroup grp_session Session handling
40 *
41 * Creating, using, or destroying libsigrok sessions.
42 *
43 * @{
44 */
45
544a4582 46struct source {
544a4582 47 int timeout;
144f6660 48 sr_receive_data_callback cb;
1f9813eb 49 void *cb_data;
aac0ea25
LPC
50
51 /* This is used to keep track of the object (fd, pollfd or channel) which is
52 * being polled and will be used to match the source when removing it again.
53 */
54 gintptr poll_object;
544a4582
BV
55};
56
2726474a 57struct datafeed_callback {
144f6660 58 sr_datafeed_callback cb;
2726474a
ML
59 void *cb_data;
60};
61
9f45fb3a
UH
62/**
63 * Create a new session.
7efe889e
UH
64 *
65 * @param new_session This will contain a pointer to the newly created
66 * session if the return value is SR_OK, otherwise the value
67 * is undefined and should not be used. Must not be NULL.
9f45fb3a 68 *
0812c40e 69 * @retval SR_OK Success.
41de54ff 70 * @retval SR_ERR_ARG Invalid argument.
47117241 71 *
0812c40e 72 * @since 0.4.0
9f45fb3a 73 */
3337e9a1 74SR_API int sr_session_new(struct sr_session **new_session)
a1bb33af 75{
3337e9a1 76 struct sr_session *session;
a1bb33af 77
41de54ff
UH
78 if (!new_session)
79 return SR_ERR_ARG;
80
3337e9a1 81 session = g_malloc0(sizeof(struct sr_session));
b7e94111 82
3337e9a1
BV
83 session->source_timeout = -1;
84 session->running = FALSE;
85 session->abort_session = FALSE;
86 g_mutex_init(&session->stop_mutex);
0812c40e 87
3337e9a1 88 *new_session = session;
0812c40e
ML
89
90 return SR_OK;
a1bb33af
UH
91}
92
9f45fb3a 93/**
0812c40e 94 * Destroy a session.
9f45fb3a
UH
95 * This frees up all memory used by the session.
96 *
7efe889e
UH
97 * @param session The session to destroy. Must not be NULL.
98 *
04cb9157 99 * @retval SR_OK Success.
0812c40e 100 * @retval SR_ERR_ARG Invalid session passed.
47117241 101 *
0812c40e 102 * @since 0.4.0
9f45fb3a 103 */
0812c40e 104SR_API int sr_session_destroy(struct sr_session *session)
a1bb33af 105{
9f45fb3a 106 if (!session) {
a421dc1d 107 sr_err("%s: session was NULL", __func__);
0812c40e 108 return SR_ERR_ARG;
9f45fb3a
UH
109 }
110
0812c40e 111 sr_session_dev_remove_all(session);
33c6e4c5 112 g_mutex_clear(&session->stop_mutex);
3d68b612
BV
113 if (session->trigger)
114 sr_trigger_free(session->trigger);
33c6e4c5 115
1de3cced
ML
116 g_slist_free_full(session->owned_devs, (GDestroyNotify)sr_dev_inst_free);
117
a1bb33af 118 g_free(session);
0812c40e 119
e0508e67 120 return SR_OK;
a1bb33af
UH
121}
122
9f45fb3a 123/**
0812c40e 124 * Remove all the devices from a session.
9f45fb3a
UH
125 *
126 * The session itself (i.e., the struct sr_session) is not free'd and still
127 * exists after this function returns.
128 *
7efe889e
UH
129 * @param session The session to use. Must not be NULL.
130 *
04cb9157 131 * @retval SR_OK Success.
0812c40e 132 * @retval SR_ERR_BUG Invalid session passed.
47117241 133 *
0812c40e 134 * @since 0.4.0
9f45fb3a 135 */
0812c40e 136SR_API int sr_session_dev_remove_all(struct sr_session *session)
a1bb33af 137{
0812c40e
ML
138 struct sr_dev_inst *sdi;
139 GSList *l;
140
9f45fb3a 141 if (!session) {
a421dc1d 142 sr_err("%s: session was NULL", __func__);
0812c40e
ML
143 return SR_ERR_ARG;
144 }
145
146 for (l = session->devs; l; l = l->next) {
147 sdi = (struct sr_dev_inst *) l->data;
148 sdi->session = NULL;
9f45fb3a
UH
149 }
150
681803df 151 g_slist_free(session->devs);
bb7ef793 152 session->devs = NULL;
e0508e67
UH
153
154 return SR_OK;
a1bb33af
UH
155}
156
9f45fb3a 157/**
0812c40e 158 * Add a device instance to a session.
9f45fb3a 159 *
7efe889e 160 * @param session The session to add to. Must not be NULL.
0812c40e 161 * @param sdi The device instance to add to a session. Must not
de4d3f99
BV
162 * be NULL. Also, sdi->driver and sdi->driver->dev_open must
163 * not be NULL.
9f45fb3a 164 *
04cb9157
MH
165 * @retval SR_OK Success.
166 * @retval SR_ERR_ARG Invalid argument.
47117241 167 *
0812c40e 168 * @since 0.4.0
9f45fb3a 169 */
0812c40e
ML
170SR_API int sr_session_dev_add(struct sr_session *session,
171 struct sr_dev_inst *sdi)
a1bb33af 172{
5451816f 173 int ret;
a1bb33af 174
de4d3f99 175 if (!sdi) {
a421dc1d 176 sr_err("%s: sdi was NULL", __func__);
9f45fb3a
UH
177 return SR_ERR_ARG;
178 }
179
d6eb0c33 180 if (!session) {
a421dc1d 181 sr_err("%s: session was NULL", __func__);
0812c40e
ML
182 return SR_ERR_ARG;
183 }
184
185 /* If sdi->session is not NULL, the device is already in this or
186 * another session. */
187 if (sdi->session) {
188 sr_err("%s: already assigned to session", __func__);
189 return SR_ERR_ARG;
d6eb0c33
UH
190 }
191
de4d3f99
BV
192 /* If sdi->driver is NULL, this is a virtual device. */
193 if (!sdi->driver) {
d6eb0c33 194 /* Just add the device, don't run dev_open(). */
de4d3f99 195 session->devs = g_slist_append(session->devs, (gpointer)sdi);
0812c40e 196 sdi->session = session;
d6eb0c33 197 return SR_OK;
9f45fb3a
UH
198 }
199
de4d3f99
BV
200 /* sdi->driver is non-NULL (i.e. we have a real device). */
201 if (!sdi->driver->dev_open) {
a421dc1d 202 sr_err("%s: sdi->driver->dev_open was NULL", __func__);
8ec95d22 203 return SR_ERR_BUG;
9f45fb3a
UH
204 }
205
de4d3f99 206 session->devs = g_slist_append(session->devs, (gpointer)sdi);
0812c40e 207 sdi->session = session;
aa4b1107 208
5451816f 209 if (session->running) {
32b7cd4f
DE
210 /* Adding a device to a running session. Commit settings
211 * and start acquisition on that device now. */
212 if ((ret = sr_config_commit(sdi)) != SR_OK) {
213 sr_err("Failed to commit device settings before "
214 "starting acquisition in running session (%s)",
215 sr_strerror(ret));
216 return ret;
217 }
5451816f 218 if ((ret = sdi->driver->dev_acquisition_start(sdi,
32b7cd4f 219 (void *)sdi)) != SR_OK) {
5451816f 220 sr_err("Failed to start acquisition of device in "
32b7cd4f
DE
221 "running session (%s)", sr_strerror(ret));
222 return ret;
223 }
5451816f
BV
224 }
225
e46b8fb1 226 return SR_OK;
a1bb33af
UH
227}
228
2bb311b4 229/**
0812c40e 230 * List all device instances attached to a session.
2bb311b4 231 *
7efe889e 232 * @param session The session to use. Must not be NULL.
2bb311b4
BV
233 * @param devlist A pointer where the device instance list will be
234 * stored on return. If no devices are in the session,
235 * this will be NULL. Each element in the list points
236 * to a struct sr_dev_inst *.
237 * The list must be freed by the caller, but not the
238 * elements pointed to.
239 *
04cb9157 240 * @retval SR_OK Success.
0812c40e 241 * @retval SR_ERR_ARG Invalid argument.
47117241 242 *
0812c40e 243 * @since 0.4.0
2bb311b4 244 */
0812c40e 245SR_API int sr_session_dev_list(struct sr_session *session, GSList **devlist)
2bb311b4 246{
2bb311b4 247 if (!session)
0812c40e
ML
248 return SR_ERR_ARG;
249
250 if (!devlist)
251 return SR_ERR_ARG;
2bb311b4
BV
252
253 *devlist = g_slist_copy(session->devs);
254
255 return SR_OK;
256}
257
9f45fb3a 258/**
0812c40e 259 * Remove all datafeed callbacks in a session.
9f45fb3a 260 *
7efe889e
UH
261 * @param session The session to use. Must not be NULL.
262 *
04cb9157 263 * @retval SR_OK Success.
0812c40e 264 * @retval SR_ERR_ARG Invalid session passed.
47117241 265 *
0812c40e 266 * @since 0.4.0
9f45fb3a 267 */
0812c40e 268SR_API int sr_session_datafeed_callback_remove_all(struct sr_session *session)
a1bb33af 269{
9f45fb3a 270 if (!session) {
a421dc1d 271 sr_err("%s: session was NULL", __func__);
0812c40e 272 return SR_ERR_ARG;
9f45fb3a
UH
273 }
274
2726474a 275 g_slist_free_full(session->datafeed_callbacks, g_free);
a1bb33af 276 session->datafeed_callbacks = NULL;
e0508e67
UH
277
278 return SR_OK;
a1bb33af
UH
279}
280
9f45fb3a 281/**
0812c40e 282 * Add a datafeed callback to a session.
9f45fb3a 283 *
7efe889e 284 * @param session The session to use. Must not be NULL.
d08490aa 285 * @param cb Function to call when a chunk of data is received.
0abee507 286 * Must not be NULL.
85222791 287 * @param cb_data Opaque pointer passed in by the caller.
a1645fcd 288 *
04cb9157
MH
289 * @retval SR_OK Success.
290 * @retval SR_ERR_BUG No session exists.
47117241
UH
291 *
292 * @since 0.3.0
9f45fb3a 293 */
0812c40e
ML
294SR_API int sr_session_datafeed_callback_add(struct sr_session *session,
295 sr_datafeed_callback cb, void *cb_data)
a1bb33af 296{
2726474a
ML
297 struct datafeed_callback *cb_struct;
298
9f45fb3a 299 if (!session) {
a421dc1d 300 sr_err("%s: session was NULL", __func__);
e0508e67 301 return SR_ERR_BUG;
9f45fb3a
UH
302 }
303
0abee507 304 if (!cb) {
a421dc1d 305 sr_err("%s: cb was NULL", __func__);
0abee507
UH
306 return SR_ERR_ARG;
307 }
9f45fb3a 308
91219afc 309 cb_struct = g_malloc0(sizeof(struct datafeed_callback));
2726474a
ML
310 cb_struct->cb = cb;
311 cb_struct->cb_data = cb_data;
312
62c82025 313 session->datafeed_callbacks =
2726474a 314 g_slist_append(session->datafeed_callbacks, cb_struct);
e0508e67
UH
315
316 return SR_OK;
a1bb33af
UH
317}
318
9f42e2e6
UH
319/**
320 * Get the trigger assigned to this session.
321 *
322 * @param session The session to use.
323 *
324 * @retval NULL Invalid (NULL) session was passed to the function.
325 * @retval other The trigger assigned to this session (can be NULL).
326 *
327 * @since 0.4.0
328 */
0812c40e 329SR_API struct sr_trigger *sr_session_trigger_get(struct sr_session *session)
7b5e6d29 330{
9f42e2e6
UH
331 if (!session)
332 return NULL;
333
7b5e6d29
BV
334 return session->trigger;
335}
336
9f42e2e6
UH
337/**
338 * Set the trigger of this session.
339 *
340 * @param session The session to use. Must not be NULL.
341 * @param trig The trigger to assign to this session. Can be NULL.
342 *
343 * @retval SR_OK Success.
344 * @retval SR_ERR_ARG Invalid argument.
345 *
346 * @since 0.4.0
347 */
0812c40e 348SR_API int sr_session_trigger_set(struct sr_session *session, struct sr_trigger *trig)
7b5e6d29 349{
9f42e2e6
UH
350 if (!session)
351 return SR_ERR_ARG;
352
7b5e6d29
BV
353 session->trigger = trig;
354
355 return SR_OK;
356}
357
b483be74 358/**
0812c40e 359 * Call every device in the current session's callback.
b483be74
BV
360 *
361 * For sessions not driven by select loops such as sr_session_run(),
362 * but driven by another scheduler, this can be used to poll the devices
363 * from within that scheduler.
364 *
7efe889e 365 * @param session The session to use. Must not be NULL.
f6eb2cb5
BV
366 * @param block If TRUE, this call will wait for any of the session's
367 * sources to fire an event on the file descriptors, or
368 * any of their timeouts to activate. In other words, this
369 * can be used as a select loop.
370 * If FALSE, all sources have their callback run, regardless
371 * of file descriptor or timeout status.
372 *
04cb9157
MH
373 * @retval SR_OK Success.
374 * @retval SR_ERR Error occured.
b483be74 375 */
3337e9a1 376static int sr_session_iteration(struct sr_session *session, gboolean block)
544a4582 377{
b7e94111
LPC
378 unsigned int i;
379 int ret;
544a4582 380
b483be74
BV
381 ret = g_poll(session->pollfds, session->num_sources,
382 block ? session->source_timeout : 0);
383 for (i = 0; i < session->num_sources; i++) {
384 if (session->pollfds[i].revents > 0 || (ret == 0
385 && session->source_timeout == session->sources[i].timeout)) {
33c6e4c5 386 /*
b483be74
BV
387 * Invoke the source's callback on an event,
388 * or if the poll timed out and this source
389 * asked for that timeout.
33c6e4c5 390 */
b483be74
BV
391 if (!session->sources[i].cb(session->pollfds[i].fd,
392 session->pollfds[i].revents,
393 session->sources[i].cb_data))
0812c40e
ML
394 sr_session_source_remove(session,
395 session->sources[i].poll_object);
b483be74
BV
396 }
397 /*
398 * We want to take as little time as possible to stop
399 * the session if we have been told to do so. Therefore,
400 * we check the flag after processing every source, not
401 * just once per main event loop.
402 */
403 g_mutex_lock(&session->stop_mutex);
404 if (session->abort_session) {
0812c40e 405 sr_session_stop_sync(session);
b483be74
BV
406 /* But once is enough. */
407 session->abort_session = FALSE;
544a4582 408 }
b483be74 409 g_mutex_unlock(&session->stop_mutex);
544a4582 410 }
e0508e67
UH
411
412 return SR_OK;
544a4582
BV
413}
414
7b5e6d29
BV
415static int verify_trigger(struct sr_trigger *trigger)
416{
417 struct sr_trigger_stage *stage;
418 struct sr_trigger_match *match;
419 GSList *l, *m;
420
421 if (!trigger->stages) {
422 sr_err("No trigger stages defined.");
423 return SR_ERR;
424 }
425
426 sr_spew("Checking trigger:");
427 for (l = trigger->stages; l; l = l->next) {
428 stage = l->data;
429 if (!stage->matches) {
430 sr_err("Stage %d has no matches defined.", stage->stage);
431 return SR_ERR;
432 }
433 for (m = stage->matches; m; m = m->next) {
434 match = m->data;
435 if (!match->channel) {
436 sr_err("Stage %d match has no channel.", stage->stage);
437 return SR_ERR;
438 }
439 if (!match->match) {
440 sr_err("Stage %d match is not defined.", stage->stage);
441 return SR_ERR;
442 }
443 sr_spew("Stage %d match on channel %s, match %d", stage->stage,
444 match->channel->name, match->match);
445 }
446 }
447
448 return SR_OK;
449}
9f45fb3a
UH
450/**
451 * Start a session.
452 *
7efe889e
UH
453 * @param session The session to use. Must not be NULL.
454 *
04cb9157 455 * @retval SR_OK Success.
0812c40e 456 * @retval SR_ERR_ARG Invalid session passed.
47117241 457 *
0812c40e 458 * @since 0.4.0
9f45fb3a 459 */
0812c40e 460SR_API int sr_session_start(struct sr_session *session)
7d658874 461{
de4d3f99 462 struct sr_dev_inst *sdi;
013ec84b
BV
463 struct sr_channel *ch;
464 GSList *l, *c;
465 int enabled_channels, ret;
7d658874 466
9f45fb3a 467 if (!session) {
0812c40e
ML
468 sr_err("%s: session was NULL", __func__);
469 return SR_ERR_ARG;
9f45fb3a
UH
470 }
471
bb7ef793 472 if (!session->devs) {
a421dc1d 473 sr_err("%s: session->devs was NULL; a session "
9f45fb3a 474 "cannot be started without devices.", __func__);
0812c40e 475 return SR_ERR_ARG;
9f45fb3a
UH
476 }
477
7b5e6d29
BV
478 if (session->trigger && verify_trigger(session->trigger) != SR_OK)
479 return SR_ERR;
480
c7142604 481 sr_info("Starting.");
9f45fb3a 482
b7c3e849 483 ret = SR_OK;
bb7ef793 484 for (l = session->devs; l; l = l->next) {
de4d3f99 485 sdi = l->data;
013ec84b
BV
486 enabled_channels = 0;
487 for (c = sdi->channels; c; c = c->next) {
488 ch = c->data;
489 if (ch->enabled) {
490 enabled_channels++;
491 break;
492 }
493 }
494 if (enabled_channels == 0) {
495 ret = SR_ERR;
1b9e567b
SA
496 sr_err("%s using connection %s has no enabled channels!",
497 sdi->driver->name, sdi->connection_id);
013ec84b
BV
498 break;
499 }
500
32b7cd4f
DE
501 if ((ret = sr_config_commit(sdi)) != SR_OK) {
502 sr_err("Failed to commit device settings before "
503 "starting acquisition (%s)", sr_strerror(ret));
504 break;
505 }
de4d3f99 506 if ((ret = sdi->driver->dev_acquisition_start(sdi, sdi)) != SR_OK) {
a421dc1d 507 sr_err("%s: could not start an acquisition "
568dcacc 508 "(%s)", __func__, sr_strerror(ret));
7d658874 509 break;
9f45fb3a 510 }
7d658874
BV
511 }
512
9f45fb3a
UH
513 /* TODO: What if there are multiple devices? Which return code? */
514
7d658874
BV
515 return ret;
516}
517
9f45fb3a 518/**
0812c40e 519 * Run a session.
9f45fb3a 520 *
7efe889e
UH
521 * @param session The session to use. Must not be NULL.
522 *
04cb9157 523 * @retval SR_OK Success.
0812c40e 524 * @retval SR_ERR_ARG Invalid session passed.
47117241 525 *
0812c40e 526 * @since 0.4.0
9f45fb3a 527 */
0812c40e 528SR_API int sr_session_run(struct sr_session *session)
7d658874 529{
9f45fb3a 530 if (!session) {
0812c40e
ML
531 sr_err("%s: session was NULL", __func__);
532 return SR_ERR_ARG;
9f45fb3a
UH
533 }
534
bb7ef793 535 if (!session->devs) {
9f45fb3a 536 /* TODO: Actually the case? */
a421dc1d 537 sr_err("%s: session->devs was NULL; a session "
9f45fb3a 538 "cannot be run without devices.", __func__);
0812c40e 539 return SR_ERR_ARG;
9f45fb3a 540 }
5451816f 541 session->running = TRUE;
9f45fb3a 542
a421dc1d 543 sr_info("Running.");
7d658874 544
9f45fb3a 545 /* Do we have real sources? */
b7e94111 546 if (session->num_sources == 1 && session->pollfds[0].fd == -1) {
9f45fb3a 547 /* Dummy source, freewheel over it. */
2cbeb2b7 548 while (session->num_sources)
b7e94111 549 session->sources[0].cb(-1, 0, session->sources[0].cb_data);
9f45fb3a
UH
550 } else {
551 /* Real sources, use g_poll() main loop. */
b483be74 552 while (session->num_sources)
3337e9a1 553 sr_session_iteration(session, TRUE);
9f45fb3a
UH
554 }
555
e0508e67 556 return SR_OK;
7d658874
BV
557}
558
9f45fb3a 559/**
0812c40e 560 * Stop a session.
9f45fb3a 561 *
0812c40e
ML
562 * The session is stopped immediately, with all acquisition sessions stopped
563 * and hardware drivers cleaned up.
9f45fb3a 564 *
33c6e4c5
AG
565 * This must be called from within the session thread, to prevent freeing
566 * resources that the session thread will try to use.
567 *
7efe889e
UH
568 * @param session The session to use. Must not be NULL.
569 *
04cb9157 570 * @retval SR_OK Success.
0812c40e 571 * @retval SR_ERR_ARG Invalid session passed.
72a08bcc
BV
572 *
573 * @private
9f45fb3a 574 */
0812c40e 575SR_PRIV int sr_session_stop_sync(struct sr_session *session)
a1bb33af 576{
de4d3f99 577 struct sr_dev_inst *sdi;
a1bb33af
UH
578 GSList *l;
579
9f45fb3a 580 if (!session) {
a421dc1d 581 sr_err("%s: session was NULL", __func__);
0812c40e 582 return SR_ERR_ARG;
9f45fb3a
UH
583 }
584
a421dc1d 585 sr_info("Stopping.");
e0508e67 586
bb7ef793 587 for (l = session->devs; l; l = l->next) {
de4d3f99
BV
588 sdi = l->data;
589 if (sdi->driver) {
590 if (sdi->driver->dev_acquisition_stop)
591 sdi->driver->dev_acquisition_stop(sdi, sdi);
8c76be53 592 }
a1bb33af 593 }
5451816f 594 session->running = FALSE;
9f45fb3a 595
e0508e67 596 return SR_OK;
a1bb33af
UH
597}
598
33c6e4c5 599/**
0812c40e 600 * Stop a session.
33c6e4c5 601 *
0812c40e
ML
602 * The session is stopped immediately, with all acquisition sessions being
603 * stopped and hardware drivers cleaned up.
33c6e4c5
AG
604 *
605 * If the session is run in a separate thread, this function will not block
606 * until the session is finished executing. It is the caller's responsibility
607 * to wait for the session thread to return before assuming that the session is
608 * completely decommissioned.
609 *
7efe889e
UH
610 * @param session The session to use. Must not be NULL.
611 *
04cb9157 612 * @retval SR_OK Success.
0812c40e 613 * @retval SR_ERR_ARG Invalid session passed.
47117241 614 *
0812c40e 615 * @since 0.4.0
33c6e4c5 616 */
0812c40e 617SR_API int sr_session_stop(struct sr_session *session)
33c6e4c5
AG
618{
619 if (!session) {
620 sr_err("%s: session was NULL", __func__);
621 return SR_ERR_BUG;
622 }
623
624 g_mutex_lock(&session->stop_mutex);
625 session->abort_session = TRUE;
626 g_mutex_unlock(&session->stop_mutex);
627
628 return SR_OK;
629}
630
9f45fb3a 631/**
a1645fcd 632 * Debug helper.
9f45fb3a 633 *
996b0c72 634 * @param packet The packet to show debugging information for.
9f45fb3a 635 */
bf53457d 636static void datafeed_dump(const struct sr_datafeed_packet *packet)
7d2afd6c 637{
bf53457d
JH
638 const struct sr_datafeed_logic *logic;
639 const struct sr_datafeed_analog *analog;
1954dfa9 640 const struct sr_datafeed_analog2 *analog2;
7d2afd6c
BV
641
642 switch (packet->type) {
643 case SR_DF_HEADER:
a421dc1d 644 sr_dbg("bus: Received SR_DF_HEADER packet.");
7d2afd6c
BV
645 break;
646 case SR_DF_TRIGGER:
a421dc1d 647 sr_dbg("bus: Received SR_DF_TRIGGER packet.");
7d2afd6c 648 break;
c71bac3b 649 case SR_DF_META:
a421dc1d 650 sr_dbg("bus: Received SR_DF_META packet.");
ee7489d2 651 break;
7d2afd6c
BV
652 case SR_DF_LOGIC:
653 logic = packet->payload;
7ea45862
UH
654 sr_dbg("bus: Received SR_DF_LOGIC packet (%" PRIu64 " bytes, "
655 "unitsize = %d).", logic->length, logic->unitsize);
7d2afd6c 656 break;
ee7489d2
BV
657 case SR_DF_ANALOG:
658 analog = packet->payload;
a421dc1d
UH
659 sr_dbg("bus: Received SR_DF_ANALOG packet (%d samples).",
660 analog->num_samples);
ee7489d2 661 break;
1954dfa9
BV
662 case SR_DF_ANALOG2:
663 analog2 = packet->payload;
664 sr_dbg("bus: Received SR_DF_ANALOG2 packet (%d samples).",
665 analog2->num_samples);
666 break;
7d2afd6c 667 case SR_DF_END:
a421dc1d 668 sr_dbg("bus: Received SR_DF_END packet.");
7d2afd6c 669 break;
6ea7669c 670 case SR_DF_FRAME_BEGIN:
a421dc1d 671 sr_dbg("bus: Received SR_DF_FRAME_BEGIN packet.");
6ea7669c
BV
672 break;
673 case SR_DF_FRAME_END:
a421dc1d 674 sr_dbg("bus: Received SR_DF_FRAME_END packet.");
6ea7669c 675 break;
7d2afd6c 676 default:
a421dc1d 677 sr_dbg("bus: Received unknown packet type: %d.", packet->type);
9f45fb3a 678 break;
7d2afd6c 679 }
7d2afd6c
BV
680}
681
9f45fb3a 682/**
a1645fcd
BV
683 * Send a packet to whatever is listening on the datafeed bus.
684 *
685 * Hardware drivers use this to send a data packet to the frontend.
9f45fb3a 686 *
6b2d8d3e 687 * @param sdi TODO.
31ccebc4 688 * @param packet The datafeed packet to send to the session bus.
44dae539 689 *
04cb9157
MH
690 * @retval SR_OK Success.
691 * @retval SR_ERR_ARG Invalid argument.
b4bd7088
UH
692 *
693 * @private
9f45fb3a 694 */
de4d3f99 695SR_PRIV int sr_session_send(const struct sr_dev_inst *sdi,
8143cfdc 696 const struct sr_datafeed_packet *packet)
a1bb33af
UH
697{
698 GSList *l;
2726474a 699 struct datafeed_callback *cb_struct;
a1bb33af 700
de4d3f99 701 if (!sdi) {
a421dc1d 702 sr_err("%s: sdi was NULL", __func__);
e0508e67 703 return SR_ERR_ARG;
9f45fb3a
UH
704 }
705
e0508e67 706 if (!packet) {
a421dc1d 707 sr_err("%s: packet was NULL", __func__);
e0508e67 708 return SR_ERR_ARG;
9f45fb3a
UH
709 }
710
79f92686
BV
711 if (!sdi->session) {
712 sr_err("%s: session was NULL", __func__);
713 return SR_ERR_BUG;
714 }
715
3337e9a1 716 for (l = sdi->session->datafeed_callbacks; l; l = l->next) {
18beaeff
BV
717 if (sr_log_loglevel_get() >= SR_LOG_DBG)
718 datafeed_dump(packet);
2726474a
ML
719 cb_struct = l->data;
720 cb_struct->cb(sdi, packet, cb_struct->cb_data);
a1bb33af 721 }
9f45fb3a 722
e0508e67 723 return SR_OK;
a1bb33af
UH
724}
725
6b2d8d3e
UH
726/**
727 * Add an event source for a file descriptor.
728 *
7efe889e 729 * @param session The session to use. Must not be NULL.
6b2d8d3e 730 * @param pollfd The GPollFD.
04cb9157
MH
731 * @param[in] timeout Max time to wait before the callback is called,
732 * ignored if 0.
6b2d8d3e
UH
733 * @param cb Callback function to add. Must not be NULL.
734 * @param cb_data Data for the callback function. Can be NULL.
735 * @param poll_object TODO.
736 *
04cb9157
MH
737 * @retval SR_OK Success.
738 * @retval SR_ERR_ARG Invalid argument.
6b2d8d3e 739 */
102f1239
BV
740static int _sr_session_source_add(struct sr_session *session, GPollFD *pollfd,
741 int timeout, sr_receive_data_callback cb, void *cb_data, gintptr poll_object)
544a4582
BV
742{
743 struct source *new_sources, *s;
aac0ea25 744 GPollFD *new_pollfds;
544a4582 745
d08490aa 746 if (!cb) {
a421dc1d 747 sr_err("%s: cb was NULL", __func__);
e0508e67 748 return SR_ERR_ARG;
9f45fb3a
UH
749 }
750
1f9813eb 751 /* Note: cb_data can be NULL, that's not a bug. */
9f45fb3a 752
91219afc 753 new_pollfds = g_realloc(session->pollfds,
2ac2e629 754 sizeof(GPollFD) * (session->num_sources + 1));
91219afc 755 new_sources = g_realloc(session->sources, sizeof(struct source) *
2ac2e629 756 (session->num_sources + 1));
544a4582 757
b7e94111
LPC
758 new_pollfds[session->num_sources] = *pollfd;
759 s = &new_sources[session->num_sources++];
544a4582 760 s->timeout = timeout;
d08490aa 761 s->cb = cb;
1f9813eb 762 s->cb_data = cb_data;
aac0ea25 763 s->poll_object = poll_object;
b7e94111
LPC
764 session->pollfds = new_pollfds;
765 session->sources = new_sources;
544a4582 766
b7e94111
LPC
767 if (timeout != session->source_timeout && timeout > 0
768 && (session->source_timeout == -1 || timeout < session->source_timeout))
769 session->source_timeout = timeout;
9f45fb3a 770
e0508e67 771 return SR_OK;
544a4582
BV
772}
773
9f45fb3a 774/**
6b2d8d3e 775 * Add an event source for a file descriptor.
9f45fb3a 776 *
7efe889e 777 * @param session The session to use. Must not be NULL.
aac0ea25
LPC
778 * @param fd The file descriptor.
779 * @param events Events to check for.
780 * @param timeout Max time to wait before the callback is called, ignored if 0.
781 * @param cb Callback function to add. Must not be NULL.
782 * @param cb_data Data for the callback function. Can be NULL.
9f45fb3a 783 *
04cb9157
MH
784 * @retval SR_OK Success.
785 * @retval SR_ERR_ARG Invalid argument.
47117241
UH
786 *
787 * @since 0.3.0
aac0ea25 788 */
0812c40e
ML
789SR_API int sr_session_source_add(struct sr_session *session, int fd,
790 int events, int timeout, sr_receive_data_callback cb, void *cb_data)
aac0ea25
LPC
791{
792 GPollFD p;
793
aac0ea25
LPC
794 p.fd = fd;
795 p.events = events;
aac0ea25 796
102f1239 797 return _sr_session_source_add(session, &p, timeout, cb, cb_data, (gintptr)fd);
aac0ea25
LPC
798}
799
800/**
1a895c61 801 * Add an event source for a GPollFD.
aac0ea25 802 *
7efe889e 803 * @param session The session to use. Must not be NULL.
aac0ea25
LPC
804 * @param pollfd The GPollFD.
805 * @param timeout Max time to wait before the callback is called, ignored if 0.
806 * @param cb Callback function to add. Must not be NULL.
807 * @param cb_data Data for the callback function. Can be NULL.
44dae539 808 *
04cb9157
MH
809 * @retval SR_OK Success.
810 * @retval SR_ERR_ARG Invalid argument.
47117241
UH
811 *
812 * @since 0.3.0
9f45fb3a 813 */
0812c40e
ML
814SR_API int sr_session_source_add_pollfd(struct sr_session *session,
815 GPollFD *pollfd, int timeout, sr_receive_data_callback cb,
816 void *cb_data)
aac0ea25 817{
102f1239 818 return _sr_session_source_add(session, pollfd, timeout, cb,
8143cfdc 819 cb_data, (gintptr)pollfd);
aac0ea25
LPC
820}
821
822/**
1a895c61 823 * Add an event source for a GIOChannel.
aac0ea25 824 *
7efe889e 825 * @param session The session to use. Must not be NULL.
aac0ea25
LPC
826 * @param channel The GIOChannel.
827 * @param events Events to poll on.
828 * @param timeout Max time to wait before the callback is called, ignored if 0.
829 * @param cb Callback function to add. Must not be NULL.
830 * @param cb_data Data for the callback function. Can be NULL.
831 *
04cb9157
MH
832 * @retval SR_OK Success.
833 * @retval SR_ERR_ARG Invalid argument.
47117241
UH
834 *
835 * @since 0.3.0
aac0ea25 836 */
0812c40e
ML
837SR_API int sr_session_source_add_channel(struct sr_session *session,
838 GIOChannel *channel, int events, int timeout,
839 sr_receive_data_callback cb, void *cb_data)
aac0ea25
LPC
840{
841 GPollFD p;
842
843#ifdef _WIN32
6b2d8d3e 844 g_io_channel_win32_make_pollfd(channel, events, &p);
aac0ea25
LPC
845#else
846 p.fd = g_io_channel_unix_get_fd(channel);
847 p.events = events;
848#endif
849
102f1239 850 return _sr_session_source_add(session, &p, timeout, cb, cb_data, (gintptr)channel);
aac0ea25
LPC
851}
852
6b2d8d3e
UH
853/**
854 * Remove the source belonging to the specified channel.
855 *
7efe889e 856 * @param session The session to use. Must not be NULL.
04cb9157 857 * @param poll_object The channel for which the source should be removed.
6b2d8d3e 858 *
04cb9157
MH
859 * @retval SR_OK Success
860 * @retval SR_ERR_ARG Invalid arguments
04cb9157 861 * @retval SR_ERR_BUG Internal error
6b2d8d3e 862 */
102f1239 863static int _sr_session_source_remove(struct sr_session *session, gintptr poll_object)
544a4582 864{
b7e94111 865 unsigned int old;
544a4582 866
b7e94111 867 if (!session->sources || !session->num_sources) {
a421dc1d 868 sr_err("%s: sources was NULL", __func__);
0abee507 869 return SR_ERR_BUG;
e0508e67
UH
870 }
871
b7e94111
LPC
872 for (old = 0; old < session->num_sources; old++) {
873 if (session->sources[old].poll_object == poll_object)
2bccd322 874 break;
9f45fb3a
UH
875 }
876
2bccd322 877 /* fd not found, nothing to do */
b7e94111 878 if (old == session->num_sources)
2bccd322
LPC
879 return SR_OK;
880
91219afc 881 session->num_sources--;
2bccd322 882
b7e94111 883 if (old != session->num_sources) {
91219afc 884 memmove(&session->pollfds[old], &session->pollfds[old + 1],
b7e94111 885 (session->num_sources - old) * sizeof(GPollFD));
91219afc 886 memmove(&session->sources[old], &session->sources[old + 1],
b7e94111 887 (session->num_sources - old) * sizeof(struct source));
9f45fb3a 888 }
544a4582 889
91219afc
UH
890 session->pollfds = g_realloc(session->pollfds, sizeof(GPollFD) * session->num_sources);
891 session->sources = g_realloc(session->sources, sizeof(struct source) * session->num_sources);
2bccd322 892
e0508e67 893 return SR_OK;
544a4582 894}
aac0ea25 895
6b2d8d3e 896/**
aac0ea25
LPC
897 * Remove the source belonging to the specified file descriptor.
898 *
7efe889e 899 * @param session The session to use. Must not be NULL.
1a895c61 900 * @param fd The file descriptor for which the source should be removed.
aac0ea25 901 *
04cb9157
MH
902 * @retval SR_OK Success
903 * @retval SR_ERR_ARG Invalid argument
04cb9157 904 * @retval SR_ERR_BUG Internal error.
47117241
UH
905 *
906 * @since 0.3.0
aac0ea25 907 */
0812c40e 908SR_API int sr_session_source_remove(struct sr_session *session, int fd)
aac0ea25 909{
102f1239 910 return _sr_session_source_remove(session, (gintptr)fd);
aac0ea25
LPC
911}
912
913/**
914 * Remove the source belonging to the specified poll descriptor.
915 *
7efe889e 916 * @param session The session to use. Must not be NULL.
aac0ea25
LPC
917 * @param pollfd The poll descriptor for which the source should be removed.
918 *
919 * @return SR_OK upon success, SR_ERR_ARG upon invalid arguments, or
920 * SR_ERR_MALLOC upon memory allocation errors, SR_ERR_BUG upon
921 * internal errors.
47117241
UH
922 *
923 * @since 0.2.0
aac0ea25 924 */
0812c40e
ML
925SR_API int sr_session_source_remove_pollfd(struct sr_session *session,
926 GPollFD *pollfd)
aac0ea25 927{
102f1239 928 return _sr_session_source_remove(session, (gintptr)pollfd);
aac0ea25
LPC
929}
930
6b2d8d3e 931/**
aac0ea25
LPC
932 * Remove the source belonging to the specified channel.
933 *
7efe889e 934 * @param session The session to use. Must not be NULL.
1a895c61 935 * @param channel The channel for which the source should be removed.
aac0ea25 936 *
04cb9157
MH
937 * @retval SR_OK Success.
938 * @retval SR_ERR_ARG Invalid argument.
04cb9157 939 * @return SR_ERR_BUG Internal error.
47117241
UH
940 *
941 * @since 0.2.0
aac0ea25 942 */
0812c40e
ML
943SR_API int sr_session_source_remove_channel(struct sr_session *session,
944 GIOChannel *channel)
aac0ea25 945{
102f1239 946 return _sr_session_source_remove(session, (gintptr)channel);
aac0ea25 947}
7b870c38 948
8143cfdc
BV
949static void *copy_src(struct sr_config *src)
950{
951 struct sr_config *new_src;
952
953 new_src = g_malloc(sizeof(struct sr_config));
954 memcpy(new_src, src, sizeof(struct sr_config));
955 g_variant_ref(src->data);
956
957 return new_src;
958}
959
960SR_PRIV int sr_packet_copy(const struct sr_datafeed_packet *packet,
961 struct sr_datafeed_packet **copy)
962{
963 const struct sr_datafeed_meta *meta;
964 struct sr_datafeed_meta *meta_copy;
965 const struct sr_datafeed_logic *logic;
966 struct sr_datafeed_logic *logic_copy;
967 const struct sr_datafeed_analog *analog;
968 struct sr_datafeed_analog *analog_copy;
969 uint8_t *payload;
970
971 *copy = g_malloc0(sizeof(struct sr_datafeed_packet));
972 (*copy)->type = packet->type;
973
974 switch (packet->type) {
975 case SR_DF_TRIGGER:
976 case SR_DF_END:
977 /* No payload. */
978 break;
979 case SR_DF_HEADER:
980 payload = g_malloc(sizeof(struct sr_datafeed_header));
981 memcpy(payload, packet->payload, sizeof(struct sr_datafeed_header));
982 (*copy)->payload = payload;
983 break;
984 case SR_DF_META:
985 meta = packet->payload;
986 meta_copy = g_malloc(sizeof(struct sr_datafeed_meta));
5801d558
UH
987 meta_copy->config = g_slist_copy(meta->config);
988 g_slist_foreach(meta_copy->config, (GCopyFunc)copy_src, NULL);
8143cfdc
BV
989 (*copy)->payload = meta_copy;
990 break;
991 case SR_DF_LOGIC:
992 logic = packet->payload;
993 logic_copy = g_malloc(sizeof(logic));
994 logic_copy->length = logic->length;
995 logic_copy->unitsize = logic->unitsize;
996 memcpy(logic_copy->data, logic->data, logic->length * logic->unitsize);
997 (*copy)->payload = logic_copy;
998 break;
999 case SR_DF_ANALOG:
1000 analog = packet->payload;
1001 analog_copy = g_malloc(sizeof(analog));
1002 analog_copy->channels = g_slist_copy(analog->channels);
1003 analog_copy->num_samples = analog->num_samples;
1004 analog_copy->mq = analog->mq;
1005 analog_copy->unit = analog->unit;
1006 analog_copy->mqflags = analog->mqflags;
1007 memcpy(analog_copy->data, analog->data,
1008 analog->num_samples * sizeof(float));
1009 (*copy)->payload = analog_copy;
1010 break;
1011 default:
1012 sr_err("Unknown packet type %d", packet->type);
1013 return SR_ERR;
1014 }
1015
1016 return SR_OK;
1017}
1018
1019void sr_packet_free(struct sr_datafeed_packet *packet)
1020{
1021 const struct sr_datafeed_meta *meta;
1022 const struct sr_datafeed_logic *logic;
1023 const struct sr_datafeed_analog *analog;
1024 struct sr_config *src;
1025 GSList *l;
1026
1027 switch (packet->type) {
1028 case SR_DF_TRIGGER:
1029 case SR_DF_END:
1030 /* No payload. */
1031 break;
1032 case SR_DF_HEADER:
1033 /* Payload is a simple struct. */
1034 g_free((void *)packet->payload);
1035 break;
1036 case SR_DF_META:
1037 meta = packet->payload;
1038 for (l = meta->config; l; l = l->next) {
1039 src = l->data;
1040 g_variant_unref(src->data);
1041 g_free(src);
1042 }
1043 g_slist_free(meta->config);
1044 g_free((void *)packet->payload);
1045 break;
1046 case SR_DF_LOGIC:
1047 logic = packet->payload;
1048 g_free(logic->data);
1049 g_free((void *)packet->payload);
1050 break;
1051 case SR_DF_ANALOG:
1052 analog = packet->payload;
1053 g_slist_free(analog->channels);
1054 g_free(analog->data);
1055 g_free((void *)packet->payload);
1056 break;
1057 default:
1058 sr_err("Unknown packet type %d", packet->type);
1059 }
1060 g_free(packet);
1061
1062}
1063
7b870c38 1064/** @} */