blob: 06d4a3b4f68bdfec6d10616632f663bb0f597f2e [file] [log] [blame]
Uwe Hermanna1bb33a2010-04-02 20:18:27 +02001/*
2 * This file is part of the sigrok project.
3 *
Bert Vermeulenc73d2ea2012-02-13 14:31:51 +01004 * Copyright (C) 2010-2012 Bert Vermeulen <bert@biot.com>
Uwe Hermanna1bb33a2010-04-02 20:18:27 +02005 *
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>
Bert Vermeulen544a4582011-01-30 02:40:55 +010024#include <glib.h>
Uwe Hermannb7f09cf2011-12-28 23:07:08 +010025#include "sigrok.h"
26#include "sigrok-internal.h"
Bert Vermeulenaa4b1102011-01-24 07:46:16 +010027
Uwe Hermann3d2efd72012-02-05 13:36:03 +010028/* demo.c. TODO: Should not be global! */
29extern SR_PRIV GIOChannel channels[2];
Uwe Hermanna1bb33a2010-04-02 20:18:27 +020030
Bert Vermeulen544a4582011-01-30 02:40:55 +010031struct source {
32 int fd;
33 int events;
34 int timeout;
Uwe Hermannd08490a2012-02-29 21:56:24 +010035 sr_receive_data_callback_t cb;
Bert Vermeulen544a4582011-01-30 02:40:55 +010036 void *user_data;
37};
38
Bert Vermeulen7d658872011-01-31 22:34:14 +010039/* There can only be one session at a time. */
Uwe Hermanna0ecd832011-12-28 22:55:21 +010040/* 'session' is not static, it's used elsewhere (via 'extern'). */
Uwe Hermann2872d212011-02-08 17:50:29 +010041struct sr_session *session;
Uwe Hermanna0ecd832011-12-28 22:55:21 +010042static int num_sources = 0;
Bert Vermeulen7d658872011-01-31 22:34:14 +010043
Uwe Hermanna0ecd832011-12-28 22:55:21 +010044static struct source *sources = NULL;
45static int source_timeout = -1;
Bert Vermeulen544a4582011-01-30 02:40:55 +010046
Uwe Hermann9f45fb32012-01-02 14:15:25 +010047/**
48 * Create a new session.
49 *
Uwe Hermann9f45fb32012-01-02 14:15:25 +010050 * TODO: Should it use the file-global "session" variable or take an argument?
51 * The same question applies to all the other session functions.
52 *
53 * @return A pointer to the newly allocated session, or NULL upon errors.
54 */
Uwe Hermann1a081ca2012-02-01 23:40:35 +010055SR_API struct sr_session *sr_session_new(void)
Uwe Hermanna1bb33a2010-04-02 20:18:27 +020056{
Uwe Hermann133a37b2012-02-11 20:06:46 +010057 if (!(session = g_try_malloc0(sizeof(struct sr_session)))) {
Uwe Hermann9f45fb32012-01-02 14:15:25 +010058 sr_err("session: %s: session malloc failed", __func__);
59 return NULL; /* TODO: SR_ERR_MALLOC? */
60 }
Uwe Hermanna1bb33a2010-04-02 20:18:27 +020061
62 return session;
63}
64
Uwe Hermann9f45fb32012-01-02 14:15:25 +010065/**
66 * Destroy the current session.
67 *
68 * This frees up all memory used by the session.
69 *
Uwe Hermanne0508e62012-01-07 17:08:54 +010070 * @return SR_OK upon success, SR_ERR_BUG if no session exists.
Uwe Hermann9f45fb32012-01-02 14:15:25 +010071 */
Uwe Hermann1a081ca2012-02-01 23:40:35 +010072SR_API int sr_session_destroy(void)
Uwe Hermanna1bb33a2010-04-02 20:18:27 +020073{
Uwe Hermann9f45fb32012-01-02 14:15:25 +010074 if (!session) {
Uwe Hermann133a37b2012-02-11 20:06:46 +010075 sr_err("session: %s: session was NULL", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +010076 return SR_ERR_BUG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +010077 }
78
Uwe Hermannbb7ef792012-02-17 22:25:01 +010079 g_slist_free(session->devs);
80 session->devs = NULL;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +020081
Uwe Hermann9f45fb32012-01-02 14:15:25 +010082 /* TODO: Error checks needed? */
83
Bert Vermeulenaa4b1102011-01-24 07:46:16 +010084 /* TODO: Loop over protocol decoders and free them. */
Uwe Hermanna1bb33a2010-04-02 20:18:27 +020085
86 g_free(session);
Uwe Hermann9f45fb32012-01-02 14:15:25 +010087 session = NULL;
Uwe Hermanne0508e62012-01-07 17:08:54 +010088
89 return SR_OK;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +020090}
91
Uwe Hermann9f45fb32012-01-02 14:15:25 +010092/**
93 * Remove all the devices from the current session. TODO?
94 *
95 * The session itself (i.e., the struct sr_session) is not free'd and still
96 * exists after this function returns.
97 *
Uwe Hermanne0508e62012-01-07 17:08:54 +010098 * @return SR_OK upon success, SR_ERR_BUG if no session exists.
Uwe Hermann9f45fb32012-01-02 14:15:25 +010099 */
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100100SR_API int sr_session_dev_clear(void)
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200101{
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100102 if (!session) {
Uwe Hermann133a37b2012-02-11 20:06:46 +0100103 sr_err("session: %s: session was NULL", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100104 return SR_ERR_BUG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100105 }
106
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100107 g_slist_free(session->devs);
108 session->devs = NULL;
Uwe Hermanne0508e62012-01-07 17:08:54 +0100109
110 return SR_OK;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200111}
112
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100113/**
114 * Add a device to the current session.
115 *
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100116 * @param dev The device to add to the current session. Must not be NULL.
Uwe Hermannc09f0b52012-02-28 23:52:30 +0100117 * Also, dev->driver and dev->driver->dev_open must not be NULL.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100118 *
119 * @return SR_OK upon success, SR_ERR_ARG upon invalid arguments.
120 */
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100121SR_API int sr_session_dev_add(struct sr_dev *dev)
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200122{
123 int ret;
124
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100125 if (!dev) {
126 sr_err("session: %s: dev was NULL", __func__);
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100127 return SR_ERR_ARG;
128 }
129
Uwe Hermannc09f0b52012-02-28 23:52:30 +0100130 if (!dev->driver) {
131 sr_err("session: %s: dev->driver was NULL", __func__);
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100132 return SR_ERR_ARG;
133 }
134
Uwe Hermannc09f0b52012-02-28 23:52:30 +0100135 if (!dev->driver->dev_open) {
136 sr_err("session: %s: dev->driver->dev_open was NULL",
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100137 __func__);
138 return SR_ERR_ARG;
139 }
140
141 if (!session) {
142 sr_err("session: %s: session was NULL", __func__);
143 return SR_ERR; /* TODO: SR_ERR_BUG? */
144 }
145
Uwe Hermannc09f0b52012-02-28 23:52:30 +0100146 if ((ret = dev->driver->dev_open(dev->driver_index)) != SR_OK) {
Uwe Hermanne7eb7032012-02-18 11:57:43 +0100147 sr_err("session: %s: dev_open failed (%d)", __func__, ret);
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100148 return ret;
Bert Vermeulenaa4b1102011-01-24 07:46:16 +0100149 }
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200150
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100151 session->devs = g_slist_append(session->devs, dev);
Bert Vermeulenaa4b1102011-01-24 07:46:16 +0100152
Uwe Hermanne46b8fb2011-01-29 16:23:12 +0100153 return SR_OK;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200154}
155
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100156/**
157 * Clear all datafeed callbacks in the current session.
158 *
Uwe Hermanne0508e62012-01-07 17:08:54 +0100159 * @return SR_OK upon success, SR_ERR_BUG if no session exists.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100160 */
Uwe Hermann1a081ca2012-02-01 23:40:35 +0100161SR_API int sr_session_datafeed_callback_clear(void)
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200162{
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100163 if (!session) {
164 sr_err("session: %s: session was NULL", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100165 return SR_ERR_BUG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100166 }
167
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200168 g_slist_free(session->datafeed_callbacks);
169 session->datafeed_callbacks = NULL;
Uwe Hermanne0508e62012-01-07 17:08:54 +0100170
171 return SR_OK;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200172}
173
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100174/**
175 * Add a datafeed callback to the current session.
176 *
Uwe Hermannd08490a2012-02-29 21:56:24 +0100177 * @param cb Function to call when a chunk of data is received.
Bert Vermeulena1645fc2012-02-13 03:36:32 +0100178 *
Uwe Hermanne0508e62012-01-07 17:08:54 +0100179 * @return SR_OK upon success, SR_ERR_BUG if no session exists.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100180 */
Uwe Hermannd08490a2012-02-29 21:56:24 +0100181SR_API int sr_session_datafeed_callback_add(sr_datafeed_callback_t cb)
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200182{
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100183 if (!session) {
184 sr_err("session: %s: session was NULL", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100185 return SR_ERR_BUG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100186 }
187
Uwe Hermannd08490a2012-02-29 21:56:24 +0100188 /* TODO: Is 'cb' allowed to be NULL? */
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100189
Uwe Hermann62c82022010-04-15 20:16:53 +0200190 session->datafeed_callbacks =
Uwe Hermannd08490a2012-02-29 21:56:24 +0100191 g_slist_append(session->datafeed_callbacks, cb);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100192
193 return SR_OK;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200194}
195
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100196/**
197 * TODO.
198 */
Uwe Hermanne0508e62012-01-07 17:08:54 +0100199static int sr_session_run_poll(void)
Bert Vermeulen544a4582011-01-30 02:40:55 +0100200{
201 GPollFD *fds, my_gpollfd;
202 int ret, i;
203
Bert Vermeulen544a4582011-01-30 02:40:55 +0100204 fds = NULL;
205 while (session->running) {
Uwe Hermann133a37b2012-02-11 20:06:46 +0100206 /* TODO: Add comment. */
207 g_free(fds);
Bert Vermeulen544a4582011-01-30 02:40:55 +0100208
209 /* Construct g_poll()'s array. */
Uwe Hermann133a37b2012-02-11 20:06:46 +0100210 if (!(fds = g_try_malloc(sizeof(GPollFD) * num_sources))) {
Uwe Hermanne0508e62012-01-07 17:08:54 +0100211 sr_err("session: %s: fds malloc failed", __func__);
212 return SR_ERR_MALLOC;
213 }
Bert Vermeulen544a4582011-01-30 02:40:55 +0100214 for (i = 0; i < num_sources; i++) {
215#ifdef _WIN32
216 g_io_channel_win32_make_pollfd(&channels[0],
217 sources[i].events, &my_gpollfd);
218#else
219 my_gpollfd.fd = sources[i].fd;
220 my_gpollfd.events = sources[i].events;
221 fds[i] = my_gpollfd;
222#endif
223 }
224
225 ret = g_poll(fds, num_sources, source_timeout);
226
227 for (i = 0; i < num_sources; i++) {
228 if (fds[i].revents > 0 || (ret == 0
229 && source_timeout == sources[i].timeout)) {
230 /*
231 * Invoke the source's callback on an event,
232 * or if the poll timeout out and this source
233 * asked for that timeout.
234 */
Gareth McMullin5c582d92011-11-06 11:44:25 +1300235 if (!sources[i].cb(fds[i].fd, fds[i].revents,
236 sources[i].user_data))
237 sr_session_source_remove(sources[i].fd);
Bert Vermeulen544a4582011-01-30 02:40:55 +0100238 }
239 }
240 }
Uwe Hermann133a37b2012-02-11 20:06:46 +0100241 g_free(fds);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100242
243 return SR_OK;
Bert Vermeulen544a4582011-01-30 02:40:55 +0100244}
245
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100246/**
247 * Start a session.
248 *
Bert Vermeulena1645fc2012-02-13 03:36:32 +0100249 * There can only be one session at a time.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100250 *
251 * @return SR_OK upon success, SR_ERR upon errors.
252 */
Uwe Hermann1a081ca2012-02-01 23:40:35 +0100253SR_API int sr_session_start(void)
Bert Vermeulen7d658872011-01-31 22:34:14 +0100254{
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100255 struct sr_dev *dev;
Bert Vermeulen7d658872011-01-31 22:34:14 +0100256 GSList *l;
257 int ret;
258
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100259 if (!session) {
260 sr_err("session: %s: session was NULL; a session must be "
261 "created first, before starting it.", __func__);
262 return SR_ERR; /* TODO: SR_ERR_BUG? */
263 }
264
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100265 if (!session->devs) {
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100266 /* TODO: Actually the case? */
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100267 sr_err("session: %s: session->devs was NULL; a session "
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100268 "cannot be started without devices.", __func__);
269 return SR_ERR; /* TODO: SR_ERR_BUG? */
270 }
271
Uwe Hermannc09f0b52012-02-28 23:52:30 +0100272 /* TODO: Check driver_index validity? */
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100273
Uwe Hermannb08024a2011-04-14 09:46:53 +0200274 sr_info("session: starting");
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100275
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100276 for (l = session->devs; l; l = l->next) {
277 dev = l->data;
278 /* TODO: Check for dev != NULL. */
Uwe Hermannc09f0b52012-02-28 23:52:30 +0100279 if ((ret = dev->driver->dev_acquisition_start(
280 dev->driver_index, dev)) != SR_OK) {
Renato Caldas446a0372012-01-06 00:04:29 +0000281 sr_err("session: %s: could not start an acquisition "
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100282 "(%d)", __func__, ret);
Bert Vermeulen7d658872011-01-31 22:34:14 +0100283 break;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100284 }
Bert Vermeulen7d658872011-01-31 22:34:14 +0100285 }
286
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100287 /* TODO: What if there are multiple devices? Which return code? */
288
Bert Vermeulen7d658872011-01-31 22:34:14 +0100289 return ret;
290}
291
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100292/**
293 * Run the session.
294 *
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100295 * TODO: Various error checks etc.
296 *
Uwe Hermanne0508e62012-01-07 17:08:54 +0100297 * @return SR_OK upon success, SR_ERR_BUG upon errors.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100298 */
Uwe Hermann1a081ca2012-02-01 23:40:35 +0100299SR_API int sr_session_run(void)
Bert Vermeulen7d658872011-01-31 22:34:14 +0100300{
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100301 if (!session) {
302 sr_err("session: %s: session was NULL; a session must be "
303 "created first, before running it.", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100304 return SR_ERR_BUG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100305 }
306
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100307 if (!session->devs) {
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100308 /* TODO: Actually the case? */
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100309 sr_err("session: %s: session->devs was NULL; a session "
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100310 "cannot be run without devices.", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100311 return SR_ERR_BUG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100312 }
313
Uwe Hermannb08024a2011-04-14 09:46:53 +0200314 sr_info("session: running");
Bert Vermeulen7d658872011-01-31 22:34:14 +0100315 session->running = TRUE;
316
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100317 /* Do we have real sources? */
318 if (num_sources == 1 && sources[0].fd == -1) {
319 /* Dummy source, freewheel over it. */
Bert Vermeulen7d658872011-01-31 22:34:14 +0100320 while (session->running)
321 sources[0].cb(-1, 0, sources[0].user_data);
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100322 } else {
323 /* Real sources, use g_poll() main loop. */
Uwe Hermann8a2efef2011-02-08 18:00:49 +0100324 sr_session_run_poll();
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100325 }
326
Uwe Hermanne0508e62012-01-07 17:08:54 +0100327 return SR_OK;
Bert Vermeulen7d658872011-01-31 22:34:14 +0100328}
329
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100330/**
331 * Halt the current session.
332 *
Uwe Hermann44dae532012-02-17 20:44:19 +0100333 * This requests the current session be stopped as soon as possible, for
334 * example on receiving an SR_DF_END packet.
Uwe Hermanne0508e62012-01-07 17:08:54 +0100335 *
336 * @return SR_OK upon success, SR_ERR_BUG if no session exists.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100337 */
Uwe Hermann1a081ca2012-02-01 23:40:35 +0100338SR_API int sr_session_halt(void)
Bert Vermeulen544a4582011-01-30 02:40:55 +0100339{
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100340 if (!session) {
341 sr_err("session: %s: session was NULL", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100342 return SR_ERR_BUG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100343 }
344
Uwe Hermannb08024a2011-04-14 09:46:53 +0200345 sr_info("session: halting");
Bert Vermeulen544a4582011-01-30 02:40:55 +0100346 session->running = FALSE;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100347
Uwe Hermanne0508e62012-01-07 17:08:54 +0100348 return SR_OK;
Bert Vermeulen544a4582011-01-30 02:40:55 +0100349}
350
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100351/**
352 * Stop the current session.
353 *
Bert Vermeulena1645fc2012-02-13 03:36:32 +0100354 * The current session is stopped immediately, with all acquisition sessions
Uwe Hermannc09f0b52012-02-28 23:52:30 +0100355 * being stopped and hardware drivers cleaned up.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100356 *
Uwe Hermanne0508e62012-01-07 17:08:54 +0100357 * @return SR_OK upon success, SR_ERR_BUG if no session exists.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100358 */
Uwe Hermann1a081ca2012-02-01 23:40:35 +0100359SR_API int sr_session_stop(void)
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200360{
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100361 struct sr_dev *dev;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200362 GSList *l;
363
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100364 if (!session) {
365 sr_err("session: %s: session was NULL", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100366 return SR_ERR_BUG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100367 }
368
Uwe Hermannb08024a2011-04-14 09:46:53 +0200369 sr_info("session: stopping");
Bert Vermeulen544a4582011-01-30 02:40:55 +0100370 session->running = FALSE;
Uwe Hermanne0508e62012-01-07 17:08:54 +0100371
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100372 for (l = session->devs; l; l = l->next) {
373 dev = l->data;
374 /* Check for dev != NULL. */
Uwe Hermannc09f0b52012-02-28 23:52:30 +0100375 if (dev->driver) {
376 if (dev->driver->dev_acquisition_stop)
377 dev->driver->dev_acquisition_stop(dev->driver_index, dev);
378 if (dev->driver->cleanup)
379 dev->driver->cleanup();
Bert Vermeulen8c76be52012-01-08 22:05:00 +0100380 }
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200381 }
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100382
Uwe Hermanne0508e62012-01-07 17:08:54 +0100383 return SR_OK;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200384}
385
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100386/**
Bert Vermeulena1645fc2012-02-13 03:36:32 +0100387 * Debug helper.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100388 *
Bert Vermeulen996b0c72012-02-13 02:13:51 +0100389 * @param packet The packet to show debugging information for.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100390 */
Bert Vermeulen18beaef2012-02-13 00:08:23 +0100391static void datafeed_dump(struct sr_datafeed_packet *packet)
Bert Vermeulen7d2afd62011-06-20 11:42:43 +0200392{
393 struct sr_datafeed_logic *logic;
394
395 switch (packet->type) {
396 case SR_DF_HEADER:
397 sr_dbg("bus: received SR_DF_HEADER");
398 break;
399 case SR_DF_TRIGGER:
Bert Vermeulen01469702012-02-01 02:59:41 +0100400 sr_dbg("bus: received SR_DF_TRIGGER");
Bert Vermeulen7d2afd62011-06-20 11:42:43 +0200401 break;
402 case SR_DF_LOGIC:
403 logic = packet->payload;
Uwe Hermanne0508e62012-01-07 17:08:54 +0100404 /* TODO: Check for logic != NULL. */
Bert Vermeulen01469702012-02-01 02:59:41 +0100405 sr_dbg("bus: received SR_DF_LOGIC %" PRIu64 " bytes", logic->length);
Bert Vermeulen7d2afd62011-06-20 11:42:43 +0200406 break;
407 case SR_DF_END:
408 sr_dbg("bus: received SR_DF_END");
409 break;
410 default:
Bert Vermeulen18beaef2012-02-13 00:08:23 +0100411 sr_dbg("bus: received unknown packet type %d", packet->type);
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100412 break;
Bert Vermeulen7d2afd62011-06-20 11:42:43 +0200413 }
Bert Vermeulen7d2afd62011-06-20 11:42:43 +0200414}
415
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100416/**
Bert Vermeulena1645fc2012-02-13 03:36:32 +0100417 * Send a packet to whatever is listening on the datafeed bus.
418 *
419 * Hardware drivers use this to send a data packet to the frontend.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100420 *
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100421 * @param dev TODO.
Uwe Hermann31ccebc2012-02-29 22:08:45 +0100422 * @param packet The datafeed packet to send to the session bus.
Uwe Hermann44dae532012-02-17 20:44:19 +0100423 *
Uwe Hermanne0508e62012-01-07 17:08:54 +0100424 * @return SR_OK upon success, SR_ERR_ARG upon invalid arguments.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100425 */
Uwe Hermann31ccebc2012-02-29 22:08:45 +0100426SR_PRIV int sr_session_send(struct sr_dev *dev,
427 struct sr_datafeed_packet *packet)
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200428{
429 GSList *l;
Uwe Hermannd08490a2012-02-29 21:56:24 +0100430 sr_datafeed_callback_t cb;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200431
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100432 if (!dev) {
433 sr_err("session: %s: dev was NULL", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100434 return SR_ERR_ARG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100435 }
436
Uwe Hermannc09f0b52012-02-28 23:52:30 +0100437 if (!dev->driver) {
438 sr_err("session: %s: dev->driver was NULL", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100439 return SR_ERR_ARG;
440 }
441
442 if (!packet) {
443 sr_err("session: %s: packet was NULL", __func__);
444 return SR_ERR_ARG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100445 }
446
Uwe Hermann62c82022010-04-15 20:16:53 +0200447 for (l = session->datafeed_callbacks; l; l = l->next) {
Bert Vermeulen18beaef2012-02-13 00:08:23 +0100448 if (sr_log_loglevel_get() >= SR_LOG_DBG)
449 datafeed_dump(packet);
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200450 cb = l->data;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100451 /* TODO: Check for cb != NULL. */
Uwe Hermannbb7ef792012-02-17 22:25:01 +0100452 cb(dev, packet);
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200453 }
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100454
Uwe Hermanne0508e62012-01-07 17:08:54 +0100455 return SR_OK;
Uwe Hermanna1bb33a2010-04-02 20:18:27 +0200456}
457
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100458/**
459 * TODO.
460 *
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100461 * TODO: More error checks etc.
462 *
463 * @param fd TODO.
464 * @param events TODO.
465 * @param timeout TODO.
Uwe Hermannd08490a2012-02-29 21:56:24 +0100466 * @param cb TODO.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100467 * @param user_data TODO.
Uwe Hermann44dae532012-02-17 20:44:19 +0100468 *
Uwe Hermanne0508e62012-01-07 17:08:54 +0100469 * @return SR_OK upon success, SR_ERR_ARG upon invalid arguments, or
470 * SR_ERR_MALLOC upon memory allocation errors.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100471 */
Uwe Hermann1a081ca2012-02-01 23:40:35 +0100472SR_API int sr_session_source_add(int fd, int events, int timeout,
Uwe Hermannd08490a2012-02-29 21:56:24 +0100473 sr_receive_data_callback_t cb, void *user_data)
Bert Vermeulen544a4582011-01-30 02:40:55 +0100474{
475 struct source *new_sources, *s;
476
Uwe Hermannd08490a2012-02-29 21:56:24 +0100477 if (!cb) {
478 sr_err("session: %s: cb was NULL", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100479 return SR_ERR_ARG;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100480 }
481
482 /* Note: user_data can be NULL, that's not a bug. */
483
Uwe Hermann133a37b2012-02-11 20:06:46 +0100484 new_sources = g_try_malloc0(sizeof(struct source) * (num_sources + 1));
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100485 if (!new_sources) {
486 sr_err("session: %s: new_sources malloc failed", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100487 return SR_ERR_MALLOC;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100488 }
Bert Vermeulen544a4582011-01-30 02:40:55 +0100489
490 if (sources) {
491 memcpy(new_sources, sources,
492 sizeof(struct source) * num_sources);
Uwe Hermann133a37b2012-02-11 20:06:46 +0100493 g_free(sources);
Bert Vermeulen544a4582011-01-30 02:40:55 +0100494 }
495
496 s = &new_sources[num_sources++];
497 s->fd = fd;
498 s->events = events;
499 s->timeout = timeout;
Uwe Hermannd08490a2012-02-29 21:56:24 +0100500 s->cb = cb;
Bert Vermeulen544a4582011-01-30 02:40:55 +0100501 s->user_data = user_data;
502 sources = new_sources;
503
504 if (timeout != source_timeout && timeout > 0
505 && (source_timeout == -1 || timeout < source_timeout))
506 source_timeout = timeout;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100507
Uwe Hermanne0508e62012-01-07 17:08:54 +0100508 return SR_OK;
Bert Vermeulen544a4582011-01-30 02:40:55 +0100509}
510
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100511/**
512 * Remove the source belonging to the specified file descriptor.
513 *
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100514 * TODO: More error checks.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100515 *
516 * @param fd TODO.
Uwe Hermann44dae532012-02-17 20:44:19 +0100517 *
Uwe Hermanne0508e62012-01-07 17:08:54 +0100518 * @return SR_OK upon success, SR_ERR_ARG upon invalid arguments, or
519 * SR_ERR_MALLOC upon memory allocation errors, SR_ERR_BUG upon
520 * internal errors.
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100521 */
Uwe Hermann1a081ca2012-02-01 23:40:35 +0100522SR_API int sr_session_source_remove(int fd)
Bert Vermeulen544a4582011-01-30 02:40:55 +0100523{
524 struct source *new_sources;
525 int old, new;
526
Uwe Hermanne0508e62012-01-07 17:08:54 +0100527 if (!sources) {
528 sr_err("session: %s: sources was NULL", __func__);
529 return SR_ERR_BUG; /* TODO: Other? */
530 }
531
532 /* TODO: Check if 'fd' valid. */
Bert Vermeulen544a4582011-01-30 02:40:55 +0100533
Uwe Hermann133a37b2012-02-11 20:06:46 +0100534 new_sources = g_try_malloc0(sizeof(struct source) * num_sources);
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100535 if (!new_sources) {
536 sr_err("session: %s: new_sources malloc failed", __func__);
Uwe Hermanne0508e62012-01-07 17:08:54 +0100537 return SR_ERR_MALLOC;
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100538 }
539
540 for (old = 0, new = 0; old < num_sources; old++) {
Bert Vermeulen544a4582011-01-30 02:40:55 +0100541 if (sources[old].fd != fd)
542 memcpy(&new_sources[new++], &sources[old],
543 sizeof(struct source));
Uwe Hermann9f45fb32012-01-02 14:15:25 +0100544 }
Bert Vermeulen544a4582011-01-30 02:40:55 +0100545
546 if (old != new) {
Uwe Hermann133a37b2012-02-11 20:06:46 +0100547 g_free(sources);
Bert Vermeulen544a4582011-01-30 02:40:55 +0100548 sources = new_sources;
549 num_sources--;
550 } else {
551 /* Target fd was not found. */
Uwe Hermann133a37b2012-02-11 20:06:46 +0100552 g_free(new_sources);
Bert Vermeulen544a4582011-01-30 02:40:55 +0100553 }
Uwe Hermanne0508e62012-01-07 17:08:54 +0100554
555 return SR_OK;
Bert Vermeulen544a4582011-01-30 02:40:55 +0100556}