]> sigrok.org Git - libsigrok.git/blame - output/output_text.c
Sigma: Move sigma state to device specific struct
[libsigrok.git] / output / output_text.c
CommitLineData
a1bb33af
UH
1/*
2 * This file is part of the sigrok project.
3 *
4 * Copyright (C) 2010 Bert Vermeulen <bert@biot.com>
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 <stdlib.h>
21#include <stdio.h>
22#include <string.h>
23#include <glib.h>
25e7d9b1 24#include <sigrok.h>
d2b36a10 25#include "config.h"
a1bb33af 26
02076d69 27#define DEFAULT_BPL_BITS 64
f7606f9b 28#define DEFAULT_BPL_HEX 192
a1bb33af
UH
29
30struct context {
afc8e4de 31 unsigned int num_enabled_probes;
a1bb33af 32 int samples_per_line;
afc8e4de 33 unsigned int unitsize;
a1bb33af
UH
34 int line_offset;
35 int linebuf_len;
36 char *probelist[65];
37 char *linebuf;
38 int spl_cnt;
39 uint8_t *linevalues;
40 char *header;
5045c217 41 int mark_trigger;
a1bb33af
UH
42};
43
afc8e4de 44static void flush_linebufs(struct context *ctx, char *outbuf)
a1bb33af
UH
45{
46 static int max_probename_len = 0;
47 int len, i;
48
99c1fc59 49 if (ctx->linebuf[0] == 0)
a1bb33af
UH
50 return;
51
99c1fc59
UH
52 if (max_probename_len == 0) {
53 /* First time through... */
54 for (i = 0; ctx->probelist[i]; i++) {
a1bb33af 55 len = strlen(ctx->probelist[i]);
99c1fc59 56 if (len > max_probename_len)
a1bb33af
UH
57 max_probename_len = len;
58 }
59 }
60
99c1fc59
UH
61 for (i = 0; ctx->probelist[i]; i++) {
62 sprintf(outbuf + strlen(outbuf), "%*s:%s\n", max_probename_len,
63 ctx->probelist[i], ctx->linebuf + i * ctx->linebuf_len);
a1bb33af 64 }
5045c217 65
e734b81a 66 /* Mark trigger with a ^ character. */
5045c217
HE
67 if (ctx->mark_trigger != -1)
68 sprintf(outbuf + strlen(outbuf), "T:%*s^\n",
69 ctx->mark_trigger + (ctx->mark_trigger / 8), "");
70
a1bb33af 71 memset(ctx->linebuf, 0, i * ctx->linebuf_len);
a1bb33af
UH
72}
73
5a8fda15 74static int init(struct output *o, int default_spl)
a1bb33af
UH
75{
76 struct context *ctx;
77 struct probe *probe;
78 GSList *l;
79 uint64_t samplerate;
80 int num_probes;
25e7d9b1 81 char *samplerate_s;
a1bb33af 82
e734b81a
UH
83 if (!(ctx = calloc(1, sizeof(struct context))))
84 return SIGROK_ERR_MALLOC;
85
a1bb33af
UH
86 o->internal = ctx;
87 ctx->num_enabled_probes = 0;
99c1fc59
UH
88
89 for (l = o->device->probes; l; l = l->next) {
a1bb33af 90 probe = l->data;
757b8c62
UH
91 if (!probe->enabled)
92 continue;
93 ctx->probelist[ctx->num_enabled_probes++] = probe->name;
a1bb33af 94 }
99c1fc59 95
a1bb33af
UH
96 ctx->probelist[ctx->num_enabled_probes] = 0;
97 ctx->unitsize = (ctx->num_enabled_probes + 7) / 8;
98 ctx->line_offset = 0;
99 ctx->spl_cnt = 0;
5045c217 100 ctx->mark_trigger = -1;
99c1fc59 101
ee5f5e81 102 if (o->param && o->param[0]) {
a1bb33af 103 ctx->samples_per_line = strtoul(o->param, NULL, 10);
ee5f5e81
BV
104 if (ctx->samples_per_line < 1)
105 return SIGROK_ERR;
106 } else
a1bb33af
UH
107 ctx->samples_per_line = default_spl;
108
e734b81a
UH
109 if (!(ctx->header = malloc(512))) {
110 free(ctx);
111 return SIGROK_ERR_MALLOC;
112 }
113
d2b36a10 114 snprintf(ctx->header, 511, "%s\n", PACKAGE_STRING);
78ed6420 115 num_probes = g_slist_length(o->device->probes);
7aae7462 116 if (o->device->plugin) {
7aae7462
BV
117 samplerate = *((uint64_t *) o->device->plugin->get_device_info(
118 o->device->plugin_index, DI_CUR_SAMPLERATE));
e734b81a
UH
119 if (!(samplerate_s = sigrok_samplerate_string(samplerate))) {
120 free(ctx->header);
121 free(ctx);
d2b36a10 122 return SIGROK_ERR;
e734b81a
UH
123 }
124 snprintf(ctx->header + strlen(ctx->header),
125 511 - strlen(ctx->header),
126 "Acquisition with %d/%d probes at %s\n",
127 ctx->num_enabled_probes, num_probes, samplerate_s);
7aae7462 128 free(samplerate_s);
7aae7462 129 }
a1bb33af 130
ee5f5e81 131 ctx->linebuf_len = ctx->samples_per_line * 2 + 4;
e734b81a
UH
132 if (!(ctx->linebuf = calloc(1, num_probes * ctx->linebuf_len))) {
133 free(ctx->header);
134 free(ctx);
135 return SIGROK_ERR_MALLOC;
136 }
137 if (!(ctx->linevalues = calloc(1, num_probes))) {
138 free(ctx->header);
139 free(ctx);
140 return SIGROK_ERR_MALLOC;
141 }
a1bb33af 142
e734b81a 143 return SIGROK_OK;
a1bb33af
UH
144}
145
99c1fc59
UH
146static int event(struct output *o, int event_type, char **data_out,
147 uint64_t *length_out)
a1bb33af
UH
148{
149 struct context *ctx;
150 int outsize;
151 char *outbuf;
152
153 ctx = o->internal;
99c1fc59 154 switch (event_type) {
a1bb33af 155 case DF_TRIGGER:
5045c217 156 ctx->mark_trigger = ctx->spl_cnt;
78ed6420
BV
157 *data_out = NULL;
158 *length_out = 0;
a1bb33af
UH
159 break;
160 case DF_END:
99c1fc59
UH
161 outsize = ctx->num_enabled_probes
162 * (ctx->samples_per_line + 20) + 512;
e734b81a
UH
163 if (!(outbuf = calloc(1, outsize)))
164 return SIGROK_ERR_MALLOC;
afc8e4de 165 flush_linebufs(ctx, outbuf);
a1bb33af
UH
166 *data_out = outbuf;
167 *length_out = strlen(outbuf);
168 free(o->internal);
169 o->internal = NULL;
170 break;
78ed6420
BV
171 default:
172 *data_out = NULL;
173 *length_out = 0;
174 break;
a1bb33af
UH
175 }
176
177 return SIGROK_OK;
178}
179
02076d69 180static int init_bits(struct output *o)
a1bb33af 181{
02076d69 182 return init(o, DEFAULT_BPL_BITS);
a1bb33af
UH
183}
184
99c1fc59
UH
185static int data_bits(struct output *o, char *data_in, uint64_t length_in,
186 char **data_out, uint64_t *length_out)
a1bb33af
UH
187{
188 struct context *ctx;
afc8e4de 189 unsigned int outsize, offset, p;
33972913 190 int max_linelen;
a1bb33af 191 uint64_t sample;
757b8c62 192 char *outbuf, c;
a1bb33af
UH
193
194 ctx = o->internal;
757b8c62
UH
195 max_linelen = MAX_PROBENAME_LEN + 3 + ctx->samples_per_line
196 + ctx->samples_per_line / 8;
3aa403e8
HE
197 outsize = (1 + (length_in / ctx->unitsize) / ctx->samples_per_line)
198 * (ctx->num_enabled_probes * max_linelen);
e734b81a
UH
199
200 if (!(outbuf = calloc(1, outsize + 1)))
201 return SIGROK_ERR_MALLOC;
202
203 outbuf[0] = '\0';
99c1fc59
UH
204 if (ctx->header) {
205 /* The header is still here, this must be the first packet. */
a1bb33af
UH
206 strncpy(outbuf, ctx->header, outsize);
207 free(ctx->header);
208 ctx->header = NULL;
e734b81a 209 }
a1bb33af 210
99c1fc59
UH
211 if (length_in >= ctx->unitsize) {
212 for (offset = 0; offset <= length_in - ctx->unitsize;
213 offset += ctx->unitsize) {
a1bb33af 214 memcpy(&sample, data_in + offset, ctx->unitsize);
99c1fc59 215 for (p = 0; p < ctx->num_enabled_probes; p++) {
757b8c62
UH
216 c = (sample & ((uint64_t) 1 << p)) ? '1' : '0';
217 ctx->linebuf[p * ctx->linebuf_len +
218 ctx->line_offset] = c;
a1bb33af
UH
219 }
220 ctx->line_offset++;
221 ctx->spl_cnt++;
222
99c1fc59
UH
223 /* Add a space every 8th bit. */
224 if ((ctx->spl_cnt & 7) == 0) {
225 for (p = 0; p < ctx->num_enabled_probes; p++)
226 ctx->linebuf[p * ctx->linebuf_len +
227 ctx->line_offset] = ' ';
a1bb33af
UH
228 ctx->line_offset++;
229 }
230
99c1fc59
UH
231 /* End of line. */
232 if (ctx->spl_cnt >= ctx->samples_per_line) {
afc8e4de 233 flush_linebufs(ctx, outbuf);
a1bb33af 234 ctx->line_offset = ctx->spl_cnt = 0;
5045c217 235 ctx->mark_trigger = -1;
a1bb33af
UH
236 }
237 }
e734b81a 238 } else {
99c1fc59 239 g_message("short buffer (length_in=%" PRIu64 ")", length_in);
e734b81a 240 }
a1bb33af
UH
241
242 *data_out = outbuf;
243 *length_out = strlen(outbuf);
244
245 return SIGROK_OK;
246}
247
5a8fda15 248static int init_hex(struct output *o)
a1bb33af 249{
f7606f9b 250 return init(o, DEFAULT_BPL_HEX);
a1bb33af
UH
251}
252
99c1fc59
UH
253static int data_hex(struct output *o, char *data_in, uint64_t length_in,
254 char **data_out, uint64_t *length_out)
a1bb33af
UH
255{
256 struct context *ctx;
afc8e4de 257 unsigned int outsize, offset, p;
33972913 258 int max_linelen;
a1bb33af
UH
259 uint64_t sample;
260 char *outbuf;
261
262 ctx = o->internal;
757b8c62
UH
263 max_linelen = MAX_PROBENAME_LEN + 3 + ctx->samples_per_line
264 + ctx->samples_per_line / 2;
265 outsize = length_in / ctx->unitsize * ctx->num_enabled_probes
266 / ctx->samples_per_line * max_linelen + 512;
e734b81a
UH
267
268 if (!(outbuf = calloc(1, outsize + 1)))
269 return SIGROK_ERR_MALLOC;
270
271 outbuf[0] = '\0';
99c1fc59
UH
272 if (ctx->header) {
273 /* The header is still here, this must be the first packet. */
a1bb33af
UH
274 strncpy(outbuf, ctx->header, outsize);
275 free(ctx->header);
276 ctx->header = NULL;
e734b81a 277 }
a1bb33af
UH
278
279 ctx->line_offset = 0;
99c1fc59
UH
280 for (offset = 0; offset <= length_in - ctx->unitsize;
281 offset += ctx->unitsize) {
a1bb33af 282 memcpy(&sample, data_in + offset, ctx->unitsize);
99c1fc59 283 for (p = 0; p < ctx->num_enabled_probes; p++) {
a1bb33af 284 ctx->linevalues[p] <<= 1;
99c1fc59
UH
285 if (sample & ((uint64_t) 1 << p))
286 ctx->linevalues[p] |= 1;
287 sprintf(ctx->linebuf + (p * ctx->linebuf_len) +
288 ctx->line_offset, "%.2x", ctx->linevalues[p]);
a1bb33af
UH
289 }
290 ctx->spl_cnt++;
291
99c1fc59
UH
292 /* Add a space after every complete hex byte. */
293 if ((ctx->spl_cnt & 7) == 0) {
294 for (p = 0; p < ctx->num_enabled_probes; p++)
295 ctx->linebuf[p * ctx->linebuf_len +
296 ctx->line_offset + 2] = ' ';
a1bb33af
UH
297 ctx->line_offset += 3;
298 }
299
99c1fc59
UH
300 /* End of line. */
301 if (ctx->spl_cnt >= ctx->samples_per_line) {
afc8e4de 302 flush_linebufs(ctx, outbuf);
a1bb33af
UH
303 ctx->line_offset = ctx->spl_cnt = 0;
304 }
305 }
306
307 *data_out = outbuf;
308 *length_out = strlen(outbuf);
309
310 return SIGROK_OK;
311}
312
02076d69 313struct output_format output_text_bits = {
1c5b9d30 314 "bits",
655756e0 315 "Bits (takes argument, default 64)",
f0411b1d 316 DF_LOGIC,
02076d69
UH
317 init_bits,
318 data_bits,
99c1fc59 319 event,
a1bb33af
UH
320};
321
a1bb33af
UH
322struct output_format output_text_hex = {
323 "hex",
f7606f9b 324 "Hexadecimal (takes argument, default 192)",
f0411b1d 325 DF_LOGIC,
a1bb33af
UH
326 init_hex,
327 data_hex,
99c1fc59 328 event,
a1bb33af 329};