2 * This file is part of the libsigrok project.
4 * Copyright (C) 2020 Gerhard Sittig <gerhard.sittig@gmx.net>
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.
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.
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/>.
20 #include <libsigrok/libsigrok.h>
21 #include "libsigrok-internal.h"
24 struct feed_queue_logic {
25 const struct sr_dev_inst *sdi;
30 struct sr_datafeed_packet packet;
31 struct sr_datafeed_logic logic;
34 SR_API struct feed_queue_logic *feed_queue_logic_alloc(
35 const struct sr_dev_inst *sdi,
36 size_t sample_count, size_t unit_size)
38 struct feed_queue_logic *q;
40 q = g_malloc0(sizeof(*q));
42 q->unit_size = unit_size;
43 q->alloc_count = sample_count;
44 q->data_bytes = g_try_malloc(q->alloc_count * q->unit_size);
50 memset(&q->packet, 0, sizeof(q->packet));
51 memset(&q->logic, 0, sizeof(q->logic));
52 q->packet.type = SR_DF_LOGIC;
53 q->packet.payload = &q->logic;
54 q->logic.unitsize = q->unit_size;
55 q->logic.data = q->data_bytes;
60 SR_API int feed_queue_logic_submit(struct feed_queue_logic *q,
61 const uint8_t *data, size_t count)
66 wrptr = &q->data_bytes[q->fill_count * q->unit_size];
68 memcpy(wrptr, data, q->unit_size);
69 wrptr += q->unit_size;
71 if (q->fill_count == q->alloc_count) {
72 ret = feed_queue_logic_flush(q);
75 wrptr = &q->data_bytes[0];
82 SR_API int feed_queue_logic_flush(struct feed_queue_logic *q)
89 q->logic.length = q->fill_count * q->unit_size;
90 ret = sr_session_send(q->sdi, &q->packet);
98 SR_API void feed_queue_logic_free(struct feed_queue_logic *q)
104 g_free(q->data_bytes);
108 struct feed_queue_analog {
109 const struct sr_dev_inst *sdi;
114 struct sr_datafeed_packet packet;
115 struct sr_datafeed_analog analog;
116 struct sr_analog_encoding encoding;
117 struct sr_analog_meaning meaning;
118 struct sr_analog_spec spec;
122 SR_API struct feed_queue_analog *feed_queue_analog_alloc(
123 const struct sr_dev_inst *sdi,
124 size_t sample_count, int digits, struct sr_channel *ch)
126 struct feed_queue_analog *q;
128 q = g_malloc0(sizeof(*q));
130 q->alloc_count = sample_count;
131 q->data_values = g_try_malloc(q->alloc_count * sizeof(float));
132 if (!q->data_values) {
137 q->channels = g_slist_append(NULL, ch);
139 memset(&q->packet, 0, sizeof(q->packet));
140 sr_analog_init(&q->analog, &q->encoding, &q->meaning, &q->spec, digits);
141 q->packet.type = SR_DF_ANALOG;
142 q->packet.payload = &q->analog;
143 q->encoding.is_signed = TRUE;
144 q->meaning.channels = q->channels;
145 q->analog.data = q->data_values;
150 SR_API int feed_queue_analog_submit(struct feed_queue_analog *q,
151 float data, size_t count)
156 q->data_values[q->fill_count++] = data;
157 if (q->fill_count == q->alloc_count) {
158 ret = feed_queue_analog_flush(q);
167 SR_API int feed_queue_analog_flush(struct feed_queue_analog *q)
174 q->analog.num_samples = q->fill_count;
175 ret = sr_session_send(q->sdi, &q->packet);
183 SR_API void feed_queue_analog_free(struct feed_queue_analog *q)
189 g_free(q->data_values);
190 g_slist_free(q->channels);