2 * This file is part of the libsigrokdecode project.
4 * Copyright (C) 2013 Bert Vermeulen <bert@biot.com>
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 "../libsigrokdecode.h"
21 #include <libsigrok/libsigrok.h>
27 #include <sys/types.h>
32 #include <sys/resource.h>
37 #include "../config.h"
41 int statistics = FALSE;
69 void logmsg(char *prefix, FILE *out, const char *format, va_list args)
72 fprintf(out, "%s", prefix);
73 vfprintf(out, format, args);
77 void DBG(const char *format, ...)
83 va_start(args, format);
84 logmsg("DBG: ", stdout, format, args);
88 void ERR(const char *format, ...)
92 va_start(args, format);
93 logmsg("Error: ", stderr, format, args);
97 int srd_log(void *cb_data, int loglevel, const char *format, va_list args)
101 if (loglevel == SRD_LOG_ERR || loglevel == SRD_LOG_WARN)
102 logmsg("Error: srd: ", stderr, format, args);
103 else if (loglevel >= SRD_LOG_DBG && debug)
104 logmsg("DBG: srd: ", stdout, format, args);
109 void usage(char *msg)
112 fprintf(stderr, "%s\n", msg);
114 //while((c = getopt(argc, argv, "dP:p:o:i:O:f:S")) != -1) {
115 printf("Usage: runtc [-dPpoiOf]\n");
116 printf(" -d Debug\n");
117 printf(" -P <protocol decoder>\n");
118 printf(" -p <probename=probenum> (optional)\n");
119 printf(" -o <probeoption=value> (optional)\n");
120 printf(" -i <input file>\n");
121 printf(" -O <output-pd:output-type[:output-class]>\n");
122 printf(" -f <output file> (optional)\n");
127 static void srd_cb_ann(struct srd_proto_data *pdata, void *cb_data)
129 struct srd_decoder *dec;
130 struct srd_proto_data_annotation *pda;
136 DBG("Annotation from %s", pdata->pdo->di->inst_id);
139 dec = pdata->pdo->di->decoder;
141 if (strcmp(pdata->pdo->di->inst_id, op->pd))
142 /* This is not the PD selected for output. */
145 if (op->class_idx != -1 && op->class_idx != pda->ann_format)
146 /* This output takes a specific annotation class,
147 * but not the one that just came in. */
150 dec_ann = g_slist_nth_data(dec->annotations, pda->ann_format);
151 line = g_string_sized_new(256);
152 g_string_printf(line, "%"PRIu64"-%"PRIu64" %s: %s:",
153 pdata->start_sample, pdata->end_sample,
154 pdata->pdo->di->inst_id, dec_ann[0]);
155 for (i = 0; pda->ann_text[i]; i++)
156 g_string_append_printf(line, " \"%s\"", pda->ann_text[i]);
157 g_string_append(line, "\n");
158 if (write(op->outfd, line->str, line->len) == -1)
160 g_string_free(line, TRUE);
164 static void sr_cb(const struct sr_dev_inst *sdi,
165 const struct sr_datafeed_packet *packet, void *cb_data)
167 const struct sr_datafeed_logic *logic;
168 struct srd_session *sess;
172 static int samplecnt = 0;
176 switch (packet->type) {
178 DBG("Received SR_DF_HEADER");
179 if (sr_config_get(sdi->driver, sdi, NULL, SR_CONF_SAMPLERATE,
181 ERR("Getting samplerate failed");
184 samplerate = g_variant_get_uint64(gvar);
185 g_variant_unref(gvar);
186 if (srd_session_metadata_set(sess, SRD_CONF_SAMPLERATE,
187 g_variant_new_uint64(samplerate)) != SRD_OK) {
188 ERR("Setting samplerate failed");
191 if (srd_session_start(sess) != SRD_OK) {
192 ERR("Session start failed");
197 logic = packet->payload;
198 num_samples = logic->length / logic->unitsize;
199 DBG("Received SR_DF_LOGIC: %d samples", num_samples);
200 srd_session_send(sess, samplecnt, samplecnt + num_samples,
201 logic->data, logic->length);
202 samplecnt += logic->length / logic->unitsize;
205 DBG("Received SR_DF_END");
211 int get_stats(int stats[2])
218 stats[0] = stats[1] = -1;
219 if (!(f = fopen("/proc/self/status", "r")))
223 while (getline(&buf, &len, f) != -1) {
224 if (strcasestr(buf, "vmpeak:")) {
225 stats[0] = strtoul(buf + 10, NULL, 10);
226 } else if (strcasestr(buf, "vmsize:")) {
227 tmp = strtoul(buf + 10, NULL, 10);
230 } else if (strcasestr(buf, "vmhwm:")) {
231 stats[1] = strtoul(buf + 6, NULL, 10);
232 } else if (strcasestr(buf, "vmrss:")) {
233 tmp = strtoul(buf + 10, NULL, 10);
244 static int run_testcase(char *infile, GSList *pdlist, struct output *op)
246 struct srd_session *sess;
247 struct srd_decoder *dec;
248 struct srd_decoder_inst *di, *prev_di;
251 struct option *option;
253 GHashTable *probes, *opts;
254 GSList *pdl, *l, *annl;
259 if ((op->outfd = open(op->outfile, O_CREAT|O_WRONLY, 0600)) == -1) {
260 ERR("Unable to open %s for writing: %s", op->outfile,
266 if (sr_session_load(infile) != SR_OK)
269 if (srd_session_new(&sess) != SRD_OK)
271 sr_session_datafeed_callback_add(sr_cb, sess);
272 srd_pd_output_callback_add(sess, SRD_OUTPUT_ANN, srd_cb_ann, op);
276 for (pdl = pdlist; pdl; pdl = pdl->next) {
278 if (srd_decoder_load(pd->name) != SRD_OK)
281 /* Instantiate decoder and pass in options. */
282 opts = g_hash_table_new_full(g_str_hash, g_str_equal, NULL,
283 (GDestroyNotify)g_variant_unref);
284 for (l = pd->options; l; l = l->next) {
286 g_hash_table_insert(opts, option->key, option->value);
288 if (!(di = srd_inst_new(sess, pd->name, opts)))
290 g_hash_table_destroy(opts);
294 probes = g_hash_table_new_full(g_str_hash, g_str_equal, NULL,
295 (GDestroyNotify)g_variant_unref);
296 for (l = pd->probes; l; l = l->next) {
298 gvar = g_variant_new_int32(probe->probe);
299 g_variant_ref_sink(gvar);
300 g_hash_table_insert(probes, probe->name, gvar);
302 if (srd_inst_probe_set_all(di, probes) != SRD_OK)
304 g_hash_table_destroy(probes);
308 /* If this is not the first decoder in the list, stack it
309 * on top of the previous one. */
311 if (srd_inst_stack(sess, prev_di, di) != SRD_OK) {
312 ERR("Failed to stack decoder instances.");
319 /* Resolve top decoder's class index, so we can match. */
320 dec = srd_decoder_get_by_id(pd->name);
322 if (op->type == SRD_OUTPUT_ANN)
323 annl = dec->annotations;
324 /* TODO can't dereference this for binary yet
325 else if (op->type == SRD_OUTPUT_BINARY)
329 /* Only annotations and binary for now. */
333 dec_ann = annl->data;
334 /* TODO can't dereference this for binary yet */
335 if (!strcmp(dec_ann[0], op->class)) {
342 if (op->class_idx == -1) {
343 ERR("Output class '%s' not found in decoder %s.",
344 op->class, pd->name);
353 srd_session_destroy(sess);
361 int main(int argc, char **argv)
363 struct sr_context *ctx;
367 struct option *option;
369 char c, *opt_infile, **kv, **opstr;
371 op = malloc(sizeof(struct output));
381 while((c = getopt(argc, argv, "dP:p:o:i:O:f:S")) != -1) {
387 pd = g_malloc(sizeof(struct pd));
388 pd->name = g_strdup(optarg);
389 pd->probes = pd->options = NULL;
390 pdlist = g_slist_append(pdlist, pd);
394 if (g_slist_length(pdlist) == 0) {
395 /* No previous -P. */
396 ERR("Syntax error at '%s'", optarg);
399 kv = g_strsplit(optarg, "=", 0);
400 if (!kv[0] || (!kv[1] || kv[2])) {
402 ERR("Syntax error at '%s'", optarg);
407 probe = malloc(sizeof(struct probe));
408 probe->name = g_strdup(kv[0]);
409 probe->probe = strtoul(kv[1], 0, 10);
410 /* Apply to last PD. */
411 pd->probes = g_slist_append(pd->probes, probe);
413 option = malloc(sizeof(struct option));
414 option->key = g_strdup(kv[0]);
415 option->value = g_strdup(kv[1]);
416 /* Apply to last PD. */
417 pd->options = g_slist_append(pd->options, option);
424 opstr = g_strsplit(optarg, ":", 0);
425 if (!opstr[0] || !opstr[1]) {
426 /* Need at least abc:def. */
427 ERR("Syntax error at '%s'", optarg);
431 op->pd = g_strdup(opstr[0]);
432 if (!strcmp(opstr[1], "annotation"))
433 op->type = SRD_OUTPUT_ANN;
434 else if (!strcmp(opstr[1], "binary"))
435 op->type = SRD_OUTPUT_BINARY;
436 else if (!strcmp(opstr[1], "python"))
437 op->type = SRD_OUTPUT_PYTHON;
439 ERR("Unknown output type '%s'", opstr[1]);
444 op->class = g_strdup(opstr[2]);
448 op->outfile = g_strdup(optarg);
460 if (g_slist_length(pdlist) == 0)
464 if (!op->pd || op->type == -1)
467 if (sr_init(&ctx) != SR_OK)
470 srd_log_callback_set(srd_log, NULL);
471 if (srd_init(DECODERS_DIR) != SRD_OK)
474 run_testcase(opt_infile, pdlist, op);