]> sigrok.org Git - libsigrok.git/blame - src/session.c
Use g_malloc0() consistently, simplify error handling.
[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
0812c40e 319SR_API struct sr_trigger *sr_session_trigger_get(struct sr_session *session)
7b5e6d29
BV
320{
321 return session->trigger;
322}
323
0812c40e 324SR_API int sr_session_trigger_set(struct sr_session *session, struct sr_trigger *trig)
7b5e6d29
BV
325{
326 session->trigger = trig;
327
328 return SR_OK;
329}
330
b483be74 331/**
0812c40e 332 * Call every device in the current session's callback.
b483be74
BV
333 *
334 * For sessions not driven by select loops such as sr_session_run(),
335 * but driven by another scheduler, this can be used to poll the devices
336 * from within that scheduler.
337 *
7efe889e 338 * @param session The session to use. Must not be NULL.
f6eb2cb5
BV
339 * @param block If TRUE, this call will wait for any of the session's
340 * sources to fire an event on the file descriptors, or
341 * any of their timeouts to activate. In other words, this
342 * can be used as a select loop.
343 * If FALSE, all sources have their callback run, regardless
344 * of file descriptor or timeout status.
345 *
04cb9157
MH
346 * @retval SR_OK Success.
347 * @retval SR_ERR Error occured.
b483be74 348 */
3337e9a1 349static int sr_session_iteration(struct sr_session *session, gboolean block)
544a4582 350{
b7e94111
LPC
351 unsigned int i;
352 int ret;
544a4582 353
b483be74
BV
354 ret = g_poll(session->pollfds, session->num_sources,
355 block ? session->source_timeout : 0);
356 for (i = 0; i < session->num_sources; i++) {
357 if (session->pollfds[i].revents > 0 || (ret == 0
358 && session->source_timeout == session->sources[i].timeout)) {
33c6e4c5 359 /*
b483be74
BV
360 * Invoke the source's callback on an event,
361 * or if the poll timed out and this source
362 * asked for that timeout.
33c6e4c5 363 */
b483be74
BV
364 if (!session->sources[i].cb(session->pollfds[i].fd,
365 session->pollfds[i].revents,
366 session->sources[i].cb_data))
0812c40e
ML
367 sr_session_source_remove(session,
368 session->sources[i].poll_object);
b483be74
BV
369 }
370 /*
371 * We want to take as little time as possible to stop
372 * the session if we have been told to do so. Therefore,
373 * we check the flag after processing every source, not
374 * just once per main event loop.
375 */
376 g_mutex_lock(&session->stop_mutex);
377 if (session->abort_session) {
0812c40e 378 sr_session_stop_sync(session);
b483be74
BV
379 /* But once is enough. */
380 session->abort_session = FALSE;
544a4582 381 }
b483be74 382 g_mutex_unlock(&session->stop_mutex);
544a4582 383 }
e0508e67
UH
384
385 return SR_OK;
544a4582
BV
386}
387
7b5e6d29
BV
388
389static int verify_trigger(struct sr_trigger *trigger)
390{
391 struct sr_trigger_stage *stage;
392 struct sr_trigger_match *match;
393 GSList *l, *m;
394
395 if (!trigger->stages) {
396 sr_err("No trigger stages defined.");
397 return SR_ERR;
398 }
399
400 sr_spew("Checking trigger:");
401 for (l = trigger->stages; l; l = l->next) {
402 stage = l->data;
403 if (!stage->matches) {
404 sr_err("Stage %d has no matches defined.", stage->stage);
405 return SR_ERR;
406 }
407 for (m = stage->matches; m; m = m->next) {
408 match = m->data;
409 if (!match->channel) {
410 sr_err("Stage %d match has no channel.", stage->stage);
411 return SR_ERR;
412 }
413 if (!match->match) {
414 sr_err("Stage %d match is not defined.", stage->stage);
415 return SR_ERR;
416 }
417 sr_spew("Stage %d match on channel %s, match %d", stage->stage,
418 match->channel->name, match->match);
419 }
420 }
421
422 return SR_OK;
423}
9f45fb3a
UH
424/**
425 * Start a session.
426 *
7efe889e
UH
427 * @param session The session to use. Must not be NULL.
428 *
04cb9157 429 * @retval SR_OK Success.
0812c40e 430 * @retval SR_ERR_ARG Invalid session passed.
47117241 431 *
0812c40e 432 * @since 0.4.0
9f45fb3a 433 */
0812c40e 434SR_API int sr_session_start(struct sr_session *session)
7d658874 435{
de4d3f99 436 struct sr_dev_inst *sdi;
013ec84b
BV
437 struct sr_channel *ch;
438 GSList *l, *c;
439 int enabled_channels, ret;
7d658874 440
9f45fb3a 441 if (!session) {
0812c40e
ML
442 sr_err("%s: session was NULL", __func__);
443 return SR_ERR_ARG;
9f45fb3a
UH
444 }
445
bb7ef793 446 if (!session->devs) {
a421dc1d 447 sr_err("%s: session->devs was NULL; a session "
9f45fb3a 448 "cannot be started without devices.", __func__);
0812c40e 449 return SR_ERR_ARG;
9f45fb3a
UH
450 }
451
7b5e6d29
BV
452 if (session->trigger && verify_trigger(session->trigger) != SR_OK)
453 return SR_ERR;
454
c7142604 455 sr_info("Starting.");
9f45fb3a 456
b7c3e849 457 ret = SR_OK;
bb7ef793 458 for (l = session->devs; l; l = l->next) {
de4d3f99 459 sdi = l->data;
013ec84b
BV
460 enabled_channels = 0;
461 for (c = sdi->channels; c; c = c->next) {
462 ch = c->data;
463 if (ch->enabled) {
464 enabled_channels++;
465 break;
466 }
467 }
468 if (enabled_channels == 0) {
469 ret = SR_ERR;
1b9e567b
SA
470 sr_err("%s using connection %s has no enabled channels!",
471 sdi->driver->name, sdi->connection_id);
013ec84b
BV
472 break;
473 }
474
32b7cd4f
DE
475 if ((ret = sr_config_commit(sdi)) != SR_OK) {
476 sr_err("Failed to commit device settings before "
477 "starting acquisition (%s)", sr_strerror(ret));
478 break;
479 }
de4d3f99 480 if ((ret = sdi->driver->dev_acquisition_start(sdi, sdi)) != SR_OK) {
a421dc1d 481 sr_err("%s: could not start an acquisition "
568dcacc 482 "(%s)", __func__, sr_strerror(ret));
7d658874 483 break;
9f45fb3a 484 }
7d658874
BV
485 }
486
9f45fb3a
UH
487 /* TODO: What if there are multiple devices? Which return code? */
488
7d658874
BV
489 return ret;
490}
491
9f45fb3a 492/**
0812c40e 493 * Run a session.
9f45fb3a 494 *
7efe889e
UH
495 * @param session The session to use. Must not be NULL.
496 *
04cb9157 497 * @retval SR_OK Success.
0812c40e 498 * @retval SR_ERR_ARG Invalid session passed.
47117241 499 *
0812c40e 500 * @since 0.4.0
9f45fb3a 501 */
0812c40e 502SR_API int sr_session_run(struct sr_session *session)
7d658874 503{
9f45fb3a 504 if (!session) {
0812c40e
ML
505 sr_err("%s: session was NULL", __func__);
506 return SR_ERR_ARG;
9f45fb3a
UH
507 }
508
bb7ef793 509 if (!session->devs) {
9f45fb3a 510 /* TODO: Actually the case? */
a421dc1d 511 sr_err("%s: session->devs was NULL; a session "
9f45fb3a 512 "cannot be run without devices.", __func__);
0812c40e 513 return SR_ERR_ARG;
9f45fb3a 514 }
5451816f 515 session->running = TRUE;
9f45fb3a 516
a421dc1d 517 sr_info("Running.");
7d658874 518
9f45fb3a 519 /* Do we have real sources? */
b7e94111 520 if (session->num_sources == 1 && session->pollfds[0].fd == -1) {
9f45fb3a 521 /* Dummy source, freewheel over it. */
2cbeb2b7 522 while (session->num_sources)
b7e94111 523 session->sources[0].cb(-1, 0, session->sources[0].cb_data);
9f45fb3a
UH
524 } else {
525 /* Real sources, use g_poll() main loop. */
b483be74 526 while (session->num_sources)
3337e9a1 527 sr_session_iteration(session, TRUE);
9f45fb3a
UH
528 }
529
e0508e67 530 return SR_OK;
7d658874
BV
531}
532
9f45fb3a 533/**
0812c40e 534 * Stop a session.
9f45fb3a 535 *
0812c40e
ML
536 * The session is stopped immediately, with all acquisition sessions stopped
537 * and hardware drivers cleaned up.
9f45fb3a 538 *
33c6e4c5
AG
539 * This must be called from within the session thread, to prevent freeing
540 * resources that the session thread will try to use.
541 *
7efe889e
UH
542 * @param session The session to use. Must not be NULL.
543 *
04cb9157 544 * @retval SR_OK Success.
0812c40e 545 * @retval SR_ERR_ARG Invalid session passed.
72a08bcc
BV
546 *
547 * @private
9f45fb3a 548 */
0812c40e 549SR_PRIV int sr_session_stop_sync(struct sr_session *session)
a1bb33af 550{
de4d3f99 551 struct sr_dev_inst *sdi;
a1bb33af
UH
552 GSList *l;
553
9f45fb3a 554 if (!session) {
a421dc1d 555 sr_err("%s: session was NULL", __func__);
0812c40e 556 return SR_ERR_ARG;
9f45fb3a
UH
557 }
558
a421dc1d 559 sr_info("Stopping.");
e0508e67 560
bb7ef793 561 for (l = session->devs; l; l = l->next) {
de4d3f99
BV
562 sdi = l->data;
563 if (sdi->driver) {
564 if (sdi->driver->dev_acquisition_stop)
565 sdi->driver->dev_acquisition_stop(sdi, sdi);
8c76be53 566 }
a1bb33af 567 }
5451816f 568 session->running = FALSE;
9f45fb3a 569
e0508e67 570 return SR_OK;
a1bb33af
UH
571}
572
33c6e4c5 573/**
0812c40e 574 * Stop a session.
33c6e4c5 575 *
0812c40e
ML
576 * The session is stopped immediately, with all acquisition sessions being
577 * stopped and hardware drivers cleaned up.
33c6e4c5
AG
578 *
579 * If the session is run in a separate thread, this function will not block
580 * until the session is finished executing. It is the caller's responsibility
581 * to wait for the session thread to return before assuming that the session is
582 * completely decommissioned.
583 *
7efe889e
UH
584 * @param session The session to use. Must not be NULL.
585 *
04cb9157 586 * @retval SR_OK Success.
0812c40e 587 * @retval SR_ERR_ARG Invalid session passed.
47117241 588 *
0812c40e 589 * @since 0.4.0
33c6e4c5 590 */
0812c40e 591SR_API int sr_session_stop(struct sr_session *session)
33c6e4c5
AG
592{
593 if (!session) {
594 sr_err("%s: session was NULL", __func__);
595 return SR_ERR_BUG;
596 }
597
598 g_mutex_lock(&session->stop_mutex);
599 session->abort_session = TRUE;
600 g_mutex_unlock(&session->stop_mutex);
601
602 return SR_OK;
603}
604
9f45fb3a 605/**
a1645fcd 606 * Debug helper.
9f45fb3a 607 *
996b0c72 608 * @param packet The packet to show debugging information for.
9f45fb3a 609 */
bf53457d 610static void datafeed_dump(const struct sr_datafeed_packet *packet)
7d2afd6c 611{
bf53457d
JH
612 const struct sr_datafeed_logic *logic;
613 const struct sr_datafeed_analog *analog;
1954dfa9 614 const struct sr_datafeed_analog2 *analog2;
7d2afd6c
BV
615
616 switch (packet->type) {
617 case SR_DF_HEADER:
a421dc1d 618 sr_dbg("bus: Received SR_DF_HEADER packet.");
7d2afd6c
BV
619 break;
620 case SR_DF_TRIGGER:
a421dc1d 621 sr_dbg("bus: Received SR_DF_TRIGGER packet.");
7d2afd6c 622 break;
c71bac3b 623 case SR_DF_META:
a421dc1d 624 sr_dbg("bus: Received SR_DF_META packet.");
ee7489d2 625 break;
7d2afd6c
BV
626 case SR_DF_LOGIC:
627 logic = packet->payload;
7ea45862
UH
628 sr_dbg("bus: Received SR_DF_LOGIC packet (%" PRIu64 " bytes, "
629 "unitsize = %d).", logic->length, logic->unitsize);
7d2afd6c 630 break;
ee7489d2
BV
631 case SR_DF_ANALOG:
632 analog = packet->payload;
a421dc1d
UH
633 sr_dbg("bus: Received SR_DF_ANALOG packet (%d samples).",
634 analog->num_samples);
ee7489d2 635 break;
1954dfa9
BV
636 case SR_DF_ANALOG2:
637 analog2 = packet->payload;
638 sr_dbg("bus: Received SR_DF_ANALOG2 packet (%d samples).",
639 analog2->num_samples);
640 break;
7d2afd6c 641 case SR_DF_END:
a421dc1d 642 sr_dbg("bus: Received SR_DF_END packet.");
7d2afd6c 643 break;
6ea7669c 644 case SR_DF_FRAME_BEGIN:
a421dc1d 645 sr_dbg("bus: Received SR_DF_FRAME_BEGIN packet.");
6ea7669c
BV
646 break;
647 case SR_DF_FRAME_END:
a421dc1d 648 sr_dbg("bus: Received SR_DF_FRAME_END packet.");
6ea7669c 649 break;
7d2afd6c 650 default:
a421dc1d 651 sr_dbg("bus: Received unknown packet type: %d.", packet->type);
9f45fb3a 652 break;
7d2afd6c 653 }
7d2afd6c
BV
654}
655
9f45fb3a 656/**
a1645fcd
BV
657 * Send a packet to whatever is listening on the datafeed bus.
658 *
659 * Hardware drivers use this to send a data packet to the frontend.
9f45fb3a 660 *
6b2d8d3e 661 * @param sdi TODO.
31ccebc4 662 * @param packet The datafeed packet to send to the session bus.
44dae539 663 *
04cb9157
MH
664 * @retval SR_OK Success.
665 * @retval SR_ERR_ARG Invalid argument.
b4bd7088
UH
666 *
667 * @private
9f45fb3a 668 */
de4d3f99 669SR_PRIV int sr_session_send(const struct sr_dev_inst *sdi,
8143cfdc 670 const struct sr_datafeed_packet *packet)
a1bb33af
UH
671{
672 GSList *l;
2726474a 673 struct datafeed_callback *cb_struct;
a1bb33af 674
de4d3f99 675 if (!sdi) {
a421dc1d 676 sr_err("%s: sdi was NULL", __func__);
e0508e67 677 return SR_ERR_ARG;
9f45fb3a
UH
678 }
679
e0508e67 680 if (!packet) {
a421dc1d 681 sr_err("%s: packet was NULL", __func__);
e0508e67 682 return SR_ERR_ARG;
9f45fb3a
UH
683 }
684
79f92686
BV
685 if (!sdi->session) {
686 sr_err("%s: session was NULL", __func__);
687 return SR_ERR_BUG;
688 }
689
3337e9a1 690 for (l = sdi->session->datafeed_callbacks; l; l = l->next) {
18beaeff
BV
691 if (sr_log_loglevel_get() >= SR_LOG_DBG)
692 datafeed_dump(packet);
2726474a
ML
693 cb_struct = l->data;
694 cb_struct->cb(sdi, packet, cb_struct->cb_data);
a1bb33af 695 }
9f45fb3a 696
e0508e67 697 return SR_OK;
a1bb33af
UH
698}
699
6b2d8d3e
UH
700/**
701 * Add an event source for a file descriptor.
702 *
7efe889e 703 * @param session The session to use. Must not be NULL.
6b2d8d3e 704 * @param pollfd The GPollFD.
04cb9157
MH
705 * @param[in] timeout Max time to wait before the callback is called,
706 * ignored if 0.
6b2d8d3e
UH
707 * @param cb Callback function to add. Must not be NULL.
708 * @param cb_data Data for the callback function. Can be NULL.
709 * @param poll_object TODO.
710 *
04cb9157
MH
711 * @retval SR_OK Success.
712 * @retval SR_ERR_ARG Invalid argument.
6b2d8d3e 713 */
102f1239
BV
714static int _sr_session_source_add(struct sr_session *session, GPollFD *pollfd,
715 int timeout, sr_receive_data_callback cb, void *cb_data, gintptr poll_object)
544a4582
BV
716{
717 struct source *new_sources, *s;
aac0ea25 718 GPollFD *new_pollfds;
544a4582 719
d08490aa 720 if (!cb) {
a421dc1d 721 sr_err("%s: cb was NULL", __func__);
e0508e67 722 return SR_ERR_ARG;
9f45fb3a
UH
723 }
724
1f9813eb 725 /* Note: cb_data can be NULL, that's not a bug. */
9f45fb3a 726
91219afc 727 new_pollfds = g_realloc(session->pollfds,
2ac2e629 728 sizeof(GPollFD) * (session->num_sources + 1));
91219afc 729 new_sources = g_realloc(session->sources, sizeof(struct source) *
2ac2e629 730 (session->num_sources + 1));
544a4582 731
b7e94111
LPC
732 new_pollfds[session->num_sources] = *pollfd;
733 s = &new_sources[session->num_sources++];
544a4582 734 s->timeout = timeout;
d08490aa 735 s->cb = cb;
1f9813eb 736 s->cb_data = cb_data;
aac0ea25 737 s->poll_object = poll_object;
b7e94111
LPC
738 session->pollfds = new_pollfds;
739 session->sources = new_sources;
544a4582 740
b7e94111
LPC
741 if (timeout != session->source_timeout && timeout > 0
742 && (session->source_timeout == -1 || timeout < session->source_timeout))
743 session->source_timeout = timeout;
9f45fb3a 744
e0508e67 745 return SR_OK;
544a4582
BV
746}
747
9f45fb3a 748/**
6b2d8d3e 749 * Add an event source for a file descriptor.
9f45fb3a 750 *
7efe889e 751 * @param session The session to use. Must not be NULL.
aac0ea25
LPC
752 * @param fd The file descriptor.
753 * @param events Events to check for.
754 * @param timeout Max time to wait before the callback is called, ignored if 0.
755 * @param cb Callback function to add. Must not be NULL.
756 * @param cb_data Data for the callback function. Can be NULL.
9f45fb3a 757 *
04cb9157
MH
758 * @retval SR_OK Success.
759 * @retval SR_ERR_ARG Invalid argument.
47117241
UH
760 *
761 * @since 0.3.0
aac0ea25 762 */
0812c40e
ML
763SR_API int sr_session_source_add(struct sr_session *session, int fd,
764 int events, int timeout, sr_receive_data_callback cb, void *cb_data)
aac0ea25
LPC
765{
766 GPollFD p;
767
aac0ea25
LPC
768 p.fd = fd;
769 p.events = events;
aac0ea25 770
102f1239 771 return _sr_session_source_add(session, &p, timeout, cb, cb_data, (gintptr)fd);
aac0ea25
LPC
772}
773
774/**
1a895c61 775 * Add an event source for a GPollFD.
aac0ea25 776 *
7efe889e 777 * @param session The session to use. Must not be NULL.
aac0ea25
LPC
778 * @param pollfd The GPollFD.
779 * @param timeout Max time to wait before the callback is called, ignored if 0.
780 * @param cb Callback function to add. Must not be NULL.
781 * @param cb_data Data for the callback function. Can be NULL.
44dae539 782 *
04cb9157
MH
783 * @retval SR_OK Success.
784 * @retval SR_ERR_ARG Invalid argument.
47117241
UH
785 *
786 * @since 0.3.0
9f45fb3a 787 */
0812c40e
ML
788SR_API int sr_session_source_add_pollfd(struct sr_session *session,
789 GPollFD *pollfd, int timeout, sr_receive_data_callback cb,
790 void *cb_data)
aac0ea25 791{
102f1239 792 return _sr_session_source_add(session, pollfd, timeout, cb,
8143cfdc 793 cb_data, (gintptr)pollfd);
aac0ea25
LPC
794}
795
796/**
1a895c61 797 * Add an event source for a GIOChannel.
aac0ea25 798 *
7efe889e 799 * @param session The session to use. Must not be NULL.
aac0ea25
LPC
800 * @param channel The GIOChannel.
801 * @param events Events to poll on.
802 * @param timeout Max time to wait before the callback is called, ignored if 0.
803 * @param cb Callback function to add. Must not be NULL.
804 * @param cb_data Data for the callback function. Can be NULL.
805 *
04cb9157
MH
806 * @retval SR_OK Success.
807 * @retval SR_ERR_ARG Invalid argument.
47117241
UH
808 *
809 * @since 0.3.0
aac0ea25 810 */
0812c40e
ML
811SR_API int sr_session_source_add_channel(struct sr_session *session,
812 GIOChannel *channel, int events, int timeout,
813 sr_receive_data_callback cb, void *cb_data)
aac0ea25
LPC
814{
815 GPollFD p;
816
817#ifdef _WIN32
6b2d8d3e 818 g_io_channel_win32_make_pollfd(channel, events, &p);
aac0ea25
LPC
819#else
820 p.fd = g_io_channel_unix_get_fd(channel);
821 p.events = events;
822#endif
823
102f1239 824 return _sr_session_source_add(session, &p, timeout, cb, cb_data, (gintptr)channel);
aac0ea25
LPC
825}
826
6b2d8d3e
UH
827/**
828 * Remove the source belonging to the specified channel.
829 *
7efe889e 830 * @param session The session to use. Must not be NULL.
04cb9157 831 * @param poll_object The channel for which the source should be removed.
6b2d8d3e 832 *
04cb9157
MH
833 * @retval SR_OK Success
834 * @retval SR_ERR_ARG Invalid arguments
04cb9157 835 * @retval SR_ERR_BUG Internal error
6b2d8d3e 836 */
102f1239 837static int _sr_session_source_remove(struct sr_session *session, gintptr poll_object)
544a4582 838{
b7e94111 839 unsigned int old;
544a4582 840
b7e94111 841 if (!session->sources || !session->num_sources) {
a421dc1d 842 sr_err("%s: sources was NULL", __func__);
0abee507 843 return SR_ERR_BUG;
e0508e67
UH
844 }
845
b7e94111
LPC
846 for (old = 0; old < session->num_sources; old++) {
847 if (session->sources[old].poll_object == poll_object)
2bccd322 848 break;
9f45fb3a
UH
849 }
850
2bccd322 851 /* fd not found, nothing to do */
b7e94111 852 if (old == session->num_sources)
2bccd322
LPC
853 return SR_OK;
854
91219afc 855 session->num_sources--;
2bccd322 856
b7e94111 857 if (old != session->num_sources) {
91219afc 858 memmove(&session->pollfds[old], &session->pollfds[old + 1],
b7e94111 859 (session->num_sources - old) * sizeof(GPollFD));
91219afc 860 memmove(&session->sources[old], &session->sources[old + 1],
b7e94111 861 (session->num_sources - old) * sizeof(struct source));
9f45fb3a 862 }
544a4582 863
91219afc
UH
864 session->pollfds = g_realloc(session->pollfds, sizeof(GPollFD) * session->num_sources);
865 session->sources = g_realloc(session->sources, sizeof(struct source) * session->num_sources);
2bccd322 866
e0508e67 867 return SR_OK;
544a4582 868}
aac0ea25 869
6b2d8d3e 870/**
aac0ea25
LPC
871 * Remove the source belonging to the specified file descriptor.
872 *
7efe889e 873 * @param session The session to use. Must not be NULL.
1a895c61 874 * @param fd The file descriptor for which the source should be removed.
aac0ea25 875 *
04cb9157
MH
876 * @retval SR_OK Success
877 * @retval SR_ERR_ARG Invalid argument
04cb9157 878 * @retval SR_ERR_BUG Internal error.
47117241
UH
879 *
880 * @since 0.3.0
aac0ea25 881 */
0812c40e 882SR_API int sr_session_source_remove(struct sr_session *session, int fd)
aac0ea25 883{
102f1239 884 return _sr_session_source_remove(session, (gintptr)fd);
aac0ea25
LPC
885}
886
887/**
888 * Remove the source belonging to the specified poll descriptor.
889 *
7efe889e 890 * @param session The session to use. Must not be NULL.
aac0ea25
LPC
891 * @param pollfd The poll descriptor for which the source should be removed.
892 *
893 * @return SR_OK upon success, SR_ERR_ARG upon invalid arguments, or
894 * SR_ERR_MALLOC upon memory allocation errors, SR_ERR_BUG upon
895 * internal errors.
47117241
UH
896 *
897 * @since 0.2.0
aac0ea25 898 */
0812c40e
ML
899SR_API int sr_session_source_remove_pollfd(struct sr_session *session,
900 GPollFD *pollfd)
aac0ea25 901{
102f1239 902 return _sr_session_source_remove(session, (gintptr)pollfd);
aac0ea25
LPC
903}
904
6b2d8d3e 905/**
aac0ea25
LPC
906 * Remove the source belonging to the specified channel.
907 *
7efe889e 908 * @param session The session to use. Must not be NULL.
1a895c61 909 * @param channel The channel for which the source should be removed.
aac0ea25 910 *
04cb9157
MH
911 * @retval SR_OK Success.
912 * @retval SR_ERR_ARG Invalid argument.
04cb9157 913 * @return SR_ERR_BUG Internal error.
47117241
UH
914 *
915 * @since 0.2.0
aac0ea25 916 */
0812c40e
ML
917SR_API int sr_session_source_remove_channel(struct sr_session *session,
918 GIOChannel *channel)
aac0ea25 919{
102f1239 920 return _sr_session_source_remove(session, (gintptr)channel);
aac0ea25 921}
7b870c38 922
8143cfdc
BV
923static void *copy_src(struct sr_config *src)
924{
925 struct sr_config *new_src;
926
927 new_src = g_malloc(sizeof(struct sr_config));
928 memcpy(new_src, src, sizeof(struct sr_config));
929 g_variant_ref(src->data);
930
931 return new_src;
932}
933
934SR_PRIV int sr_packet_copy(const struct sr_datafeed_packet *packet,
935 struct sr_datafeed_packet **copy)
936{
937 const struct sr_datafeed_meta *meta;
938 struct sr_datafeed_meta *meta_copy;
939 const struct sr_datafeed_logic *logic;
940 struct sr_datafeed_logic *logic_copy;
941 const struct sr_datafeed_analog *analog;
942 struct sr_datafeed_analog *analog_copy;
943 uint8_t *payload;
944
945 *copy = g_malloc0(sizeof(struct sr_datafeed_packet));
946 (*copy)->type = packet->type;
947
948 switch (packet->type) {
949 case SR_DF_TRIGGER:
950 case SR_DF_END:
951 /* No payload. */
952 break;
953 case SR_DF_HEADER:
954 payload = g_malloc(sizeof(struct sr_datafeed_header));
955 memcpy(payload, packet->payload, sizeof(struct sr_datafeed_header));
956 (*copy)->payload = payload;
957 break;
958 case SR_DF_META:
959 meta = packet->payload;
960 meta_copy = g_malloc(sizeof(struct sr_datafeed_meta));
961 meta_copy->config = g_slist_copy_deep(meta->config,
962 (GCopyFunc)copy_src, NULL);
963 (*copy)->payload = meta_copy;
964 break;
965 case SR_DF_LOGIC:
966 logic = packet->payload;
967 logic_copy = g_malloc(sizeof(logic));
968 logic_copy->length = logic->length;
969 logic_copy->unitsize = logic->unitsize;
970 memcpy(logic_copy->data, logic->data, logic->length * logic->unitsize);
971 (*copy)->payload = logic_copy;
972 break;
973 case SR_DF_ANALOG:
974 analog = packet->payload;
975 analog_copy = g_malloc(sizeof(analog));
976 analog_copy->channels = g_slist_copy(analog->channels);
977 analog_copy->num_samples = analog->num_samples;
978 analog_copy->mq = analog->mq;
979 analog_copy->unit = analog->unit;
980 analog_copy->mqflags = analog->mqflags;
981 memcpy(analog_copy->data, analog->data,
982 analog->num_samples * sizeof(float));
983 (*copy)->payload = analog_copy;
984 break;
985 default:
986 sr_err("Unknown packet type %d", packet->type);
987 return SR_ERR;
988 }
989
990 return SR_OK;
991}
992
993void sr_packet_free(struct sr_datafeed_packet *packet)
994{
995 const struct sr_datafeed_meta *meta;
996 const struct sr_datafeed_logic *logic;
997 const struct sr_datafeed_analog *analog;
998 struct sr_config *src;
999 GSList *l;
1000
1001 switch (packet->type) {
1002 case SR_DF_TRIGGER:
1003 case SR_DF_END:
1004 /* No payload. */
1005 break;
1006 case SR_DF_HEADER:
1007 /* Payload is a simple struct. */
1008 g_free((void *)packet->payload);
1009 break;
1010 case SR_DF_META:
1011 meta = packet->payload;
1012 for (l = meta->config; l; l = l->next) {
1013 src = l->data;
1014 g_variant_unref(src->data);
1015 g_free(src);
1016 }
1017 g_slist_free(meta->config);
1018 g_free((void *)packet->payload);
1019 break;
1020 case SR_DF_LOGIC:
1021 logic = packet->payload;
1022 g_free(logic->data);
1023 g_free((void *)packet->payload);
1024 break;
1025 case SR_DF_ANALOG:
1026 analog = packet->payload;
1027 g_slist_free(analog->channels);
1028 g_free(analog->data);
1029 g_free((void *)packet->payload);
1030 break;
1031 default:
1032 sr_err("Unknown packet type %d", packet->type);
1033 }
1034 g_free(packet);
1035
1036}
1037
7b870c38 1038/** @} */