[libsigrokdecode.git] / tests / runtc.c

/*
 * This file is part of the libsigrokdecode project.
 *
 * Copyright (C) 2013 Bert Vermeulen <bert@biot.com>
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#include "../libsigrokdecode.h"
#include <libsigrok/libsigrok.h>
#include <stdlib.h>
#include <stdio.h>
#include <stdarg.h>
#include <unistd.h>
#include <errno.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <time.h>
#include <sys/time.h>
#include <sys/resource.h>
#include <glib.h>
#ifdef __LINUX__
#include <sched.h>
#endif
#include "../config.h"


int debug = FALSE;
int statistics = FALSE;

struct probe {
	char *name;
	int probe;
};

struct option {
	char *key;
	char *value;
};

struct pd {
	char *name;
	GSList *probes;
	GSList *options;
};

struct output {
	char *pd;
	int type;
	char *class;
	int class_idx;
	char *outfile;
	int outfd;
};


void logmsg(char *prefix, FILE *out, const char *format, va_list args)
{
	if (prefix)
		fprintf(out, "%s", prefix);
	vfprintf(out, format, args);
	fprintf(out, "\n");
}

void DBG(const char *format, ...)
{
	va_list args;

	if (!debug)
		return;
	va_start(args, format);
	logmsg("DBG: ", stdout, format, args);
	va_end(args);
}

void ERR(const char *format, ...)
{
	va_list args;

	va_start(args, format);
	logmsg("Error: ", stderr, format, args);
	va_end(args);
}

int sr_log(void *cb_data, int loglevel, const char *format, va_list args)
{
	(void)cb_data;

	if (loglevel == SR_LOG_ERR || loglevel == SR_LOG_WARN)
		logmsg("Error: sr: ", stderr, format, args);
	else if (debug)
		logmsg("DBG: sr: ", stdout, format, args);

	return SRD_OK;
}

int srd_log(void *cb_data, int loglevel, const char *format, va_list args)
{
	(void)cb_data;

	if (loglevel == SRD_LOG_ERR || loglevel == SRD_LOG_WARN)
		logmsg("Error: srd: ", stderr, format, args);
	else if (debug)
		logmsg("DBG: srd: ", stdout, format, args);

	return SRD_OK;
}

void usage(char *msg)
{
	if (msg)
		fprintf(stderr, "%s\n", msg);

	printf("Usage: runtc [-dPpoiOf]\n");
	printf("  -d  Debug\n");
	printf("  -P  <protocol decoder>\n");
	printf("  -p  <probename=probenum> (optional)\n");
	printf("  -o  <probeoption=value> (optional)\n");
	printf("  -i <input file>\n");
	printf("  -O <output-pd:output-type[:output-class]>\n");
	printf("  -f <output file> (optional)\n");
	exit(msg ? 1 : 0);

}

/* This is a neutered version of libsigrokdecode's py_str_as_str(). It
 * does no error checking, but then the only strings it processes are
 * generated by Python's repr(), so are known good. */
char *py_str_as_str(const PyObject *py_str)
{
	PyObject *py_encstr;
	char *str, *outstr;

	py_encstr = PyUnicode_AsEncodedString((PyObject *)py_str, "utf-8", NULL);
	str = PyBytes_AS_STRING(py_encstr);
	outstr = g_strdup(str);
	Py_DecRef(py_encstr);

	return outstr;
}

static void srd_cb_py(struct srd_proto_data *pdata, void *cb_data)
{
	struct output *op;
	PyObject *pydata, *pyrepr;
	GString *out;
	char *s;

	DBG("Python output from %s", pdata->pdo->di->inst_id);
	op = cb_data;
	pydata = pdata->data;
	DBG("ptr %p", pydata);

	if (strcmp(pdata->pdo->di->inst_id, op->pd))
		/* This is not the PD selected for output. */
		return;

	if (!(pyrepr = PyObject_Repr(pydata))) {
		ERR("Invalid Python object.");
		return;
	}
	s = py_str_as_str(pyrepr);
	Py_DecRef(pyrepr);

	/* Output format for testing is '<ss>-<es> <inst-id>: <repr>\n' */
	out = g_string_sized_new(128);
	g_string_printf(out, "%"PRIu64"-%"PRIu64" %s: %s\n",
			pdata->start_sample, pdata->end_sample,
			pdata->pdo->di->inst_id, s);
	g_free(s);
	if (write(op->outfd, out->str, out->len) == -1)
		ERR("SRD_OUTPUT_PYTHON callback write failure!");
	DBG("wrote '%s'", out->str);
	g_string_free(out, TRUE);

}

static void srd_cb_bin(struct srd_proto_data *pdata, void *cb_data)
{
	struct srd_proto_data_binary *pdb;
	struct output *op;
	GString *out;
	unsigned int i;

	DBG("Binary output from %s", pdata->pdo->di->inst_id);
	op = cb_data;
	pdb = pdata->data;

	if (strcmp(pdata->pdo->di->inst_id, op->pd))
		/* This is not the PD selected for output. */
		return;

	if (op->class_idx != -1 && op->class_idx != pdb->bin_class)
		/*
		 * This output takes a specific binary class,
		 * but not the one that just came in.
		 */
		return;

	out = g_string_sized_new(128);
	g_string_printf(out, "%"PRIu64"-%"PRIu64" %s:",
			pdata->start_sample, pdata->end_sample,
			pdata->pdo->di->inst_id);
	for (i = 0; i < pdb->size; i++) {
		g_string_append_printf(out, " %.2x", pdb->data[i]);
	}
	g_string_append(out, "\n");
	if (write(op->outfd, out->str, out->len) == -1)
		ERR("SRD_OUTPUT_BINARY callback write failure!");

}

static void srd_cb_ann(struct srd_proto_data *pdata, void *cb_data)
{
	struct srd_decoder *dec;
	struct srd_proto_data_annotation *pda;
	struct output *op;
	GString *line;
	int i;
	char **dec_ann;

	DBG("Annotation output from %s", pdata->pdo->di->inst_id);
	op = cb_data;
	pda = pdata->data;
	dec = pdata->pdo->di->decoder;
	if (strcmp(pdata->pdo->di->inst_id, op->pd))
		/* This is not the PD selected for output. */
		return;

	if (op->class_idx != -1 && op->class_idx != pda->ann_format)
		/*
		 * This output takes a specific annotation class,
		 * but not the one that just came in.
		 */
		return;

	dec_ann = g_slist_nth_data(dec->annotations, pda->ann_format);
	line = g_string_sized_new(256);
	g_string_printf(line, "%"PRIu64"-%"PRIu64" %s: %s:",
			pdata->start_sample, pdata->end_sample,
			pdata->pdo->di->inst_id, dec_ann[0]);
	for (i = 0; pda->ann_text[i]; i++)
		g_string_append_printf(line, " \"%s\"", pda->ann_text[i]);
	g_string_append(line, "\n");
	if (write(op->outfd, line->str, line->len) == -1)
		ERR("SRD_OUTPUT_ANN callback write failure!");
	g_string_free(line, TRUE);

}

static void sr_cb(const struct sr_dev_inst *sdi,
		const struct sr_datafeed_packet *packet, void *cb_data)
{
	const struct sr_datafeed_logic *logic;
	struct srd_session *sess;
	GVariant *gvar;
	uint64_t samplerate;
	int num_samples;
	static int samplecnt = 0;

	sess = cb_data;

	switch (packet->type) {
	case SR_DF_HEADER:
		DBG("Received SR_DF_HEADER");
		if (sr_config_get(sdi->driver, sdi, NULL, SR_CONF_SAMPLERATE,
				&gvar) != SR_OK) {
			ERR("Getting samplerate failed");
			break;
		}
		samplerate = g_variant_get_uint64(gvar);
		g_variant_unref(gvar);
		if (srd_session_metadata_set(sess, SRD_CONF_SAMPLERATE,
				g_variant_new_uint64(samplerate)) != SRD_OK) {
			ERR("Setting samplerate failed");
			break;
		}
		if (srd_session_start(sess) != SRD_OK) {
			ERR("Session start failed");
			break;
		}
		break;
	case SR_DF_LOGIC:
		logic = packet->payload;
		num_samples = logic->length / logic->unitsize;
		DBG("Received SR_DF_LOGIC: %d samples", num_samples);
		srd_session_send(sess, samplecnt, samplecnt + num_samples,
				logic->data, logic->length);
		samplecnt += logic->length / logic->unitsize;
		break;
	case SR_DF_END:
		DBG("Received SR_DF_END");
		break;
	}

}

int get_stats(int stats[2])
{
	FILE *f;
	size_t len;
	int tmp;
	char *buf;

	stats[0] = stats[1] = -1;
	if (!(f = fopen("/proc/self/status", "r")))
		return FALSE;
	len = 128;
	buf = malloc(len);
	while (getline(&buf, &len, f) != -1) {
		if (strcasestr(buf, "vmpeak:")) {
			stats[0] = strtoul(buf + 10, NULL, 10);
		} else if (strcasestr(buf, "vmsize:")) {
			tmp = strtoul(buf + 10, NULL, 10);
			if (tmp > stats[0])
				stats[0] = tmp;
		} else if (strcasestr(buf, "vmhwm:")) {
			stats[1] = strtoul(buf + 6, NULL, 10);
		} else if (strcasestr(buf, "vmrss:")) {
			tmp = strtoul(buf + 10, NULL, 10);
			if (tmp > stats[0])
				stats[0] = tmp;
		}
	}
	free(buf);
	fclose(f);

	return TRUE;
}

static int run_testcase(char *infile, GSList *pdlist, struct output *op)
{
	struct srd_session *sess;
	struct srd_decoder *dec;
	struct srd_decoder_inst *di, *prev_di;
	srd_pd_output_callback_t cb;
	struct pd *pd;
	struct probe *probe;
	struct option *option;
	GVariant *gvar;
	GHashTable *probes, *opts;
	GSList *pdl, *l;
	int idx;
	char **decoder_class;

	if (op->outfile) {
		if ((op->outfd = open(op->outfile, O_CREAT|O_WRONLY, 0600)) == -1) {
			ERR("Unable to open %s for writing: %s", op->outfile,
					strerror(errno));
			return FALSE;
		}
	}

	if (sr_session_load(infile) != SR_OK)
		return FALSE;

	if (srd_session_new(&sess) != SRD_OK)
		return FALSE;
	sr_session_datafeed_callback_add(sr_cb, sess);
	switch (op->type) {
	case SRD_OUTPUT_ANN:
		cb = srd_cb_ann;
		break;
	case SRD_OUTPUT_BINARY:
		cb = srd_cb_bin;
		break;
	case SRD_OUTPUT_PYTHON:
		cb = srd_cb_py;
		break;
	default:
		return FALSE;
	}
	srd_pd_output_callback_add(sess, op->type, cb, op);

	prev_di = NULL;
	pd = NULL;
	for (pdl = pdlist; pdl; pdl = pdl->next) {
		pd = pdl->data;
		if (srd_decoder_load(pd->name) != SRD_OK)
			return FALSE;

		/* Instantiate decoder and pass in options. */
		opts = g_hash_table_new_full(g_str_hash, g_str_equal, NULL,
				(GDestroyNotify)g_variant_unref);
		for (l = pd->options; l; l = l->next) {
			option = l->data;
			g_hash_table_insert(opts, option->key, option->value);
		}
		if (!(di = srd_inst_new(sess, pd->name, opts)))
			return FALSE;
		g_hash_table_destroy(opts);

		/* Map probes. */
		if (pd->probes) {
			probes = g_hash_table_new_full(g_str_hash, g_str_equal, NULL,
					(GDestroyNotify)g_variant_unref);
			for (l = pd->probes; l; l = l->next) {
				probe = l->data;
				gvar = g_variant_new_int32(probe->probe);
				g_variant_ref_sink(gvar);
				g_hash_table_insert(probes, probe->name, gvar);
			}
			if (srd_inst_probe_set_all(di, probes) != SRD_OK)
				return FALSE;
			g_hash_table_destroy(probes);
		}

		/* If this is not the first decoder in the list, stack it
		 * on top of the previous one. */
		if (prev_di) {
			if (srd_inst_stack(sess, prev_di, di) != SRD_OK) {
				ERR("Failed to stack decoder instances.");
				return FALSE;
			}
		}
		prev_di = di;
	}

	/* Resolve top decoder's class index, so we can match. */
	dec = srd_decoder_get_by_id(pd->name);
	if (op->class) {
		if (op->type == SRD_OUTPUT_ANN)
			l = dec->annotations;
		else if (op->type == SRD_OUTPUT_BINARY)
			l = dec->binary;
		else
			/* Only annotations and binary can have a class. */
			return FALSE;
		idx = 0;
		while(l) {
			decoder_class = l->data;
			if (!strcmp(decoder_class[0], op->class)) {
				op->class_idx = idx;
				break;
			} else
				idx++;
			l = l->next;
		}
		if (op->class_idx == -1) {
			ERR("Output class '%s' not found in decoder %s.",
					op->class, pd->name);
			return FALSE;
		} else
			DBG("Class %s index is %d", op->class, op->class_idx);
	}

	sr_session_start();
	sr_session_run();
	sr_session_stop();

	srd_session_destroy(sess);

	if (op->outfile)
		close(op->outfd);

	return TRUE;
}

int main(int argc, char **argv)
{
	struct sr_context *ctx;
	GSList *pdlist;
	struct pd *pd;
	struct probe *probe;
	struct option *option;
	struct output *op;
	int ret;
	char c, *opt_infile, **kv, **opstr;

	op = malloc(sizeof(struct output));
	op->pd = NULL;
	op->type = -1;
	op->class = NULL;
	op->class_idx = -1;
	op->outfd = 1;

	pdlist = NULL;
	opt_infile = NULL;
	pd = NULL;
	while((c = getopt(argc, argv, "dP:p:o:i:O:f:S")) != -1) {
		switch(c) {
		case 'd':
			debug = TRUE;
			break;
		case 'P':
			pd = g_malloc(sizeof(struct pd));
			pd->name = g_strdup(optarg);
			pd->probes = pd->options = NULL;
			pdlist = g_slist_append(pdlist, pd);
			break;
		case 'p':
		case 'o':
			if (g_slist_length(pdlist) == 0) {
				/* No previous -P. */
				ERR("Syntax error at '%s'", optarg);
				usage(NULL);
			}
			kv = g_strsplit(optarg, "=", 0);
			if (!kv[0] || (!kv[1] || kv[2])) {
				/* Need x=y. */
				ERR("Syntax error at '%s'", optarg);
				g_strfreev(kv);
				usage(NULL);
			}
			if (c == 'p') {
				probe = malloc(sizeof(struct probe));
				probe->name = g_strdup(kv[0]);
				probe->probe = strtoul(kv[1], 0, 10);
				/* Apply to last PD. */
				pd->probes = g_slist_append(pd->probes, probe);
			} else {
				option = malloc(sizeof(struct option));
				option->key = g_strdup(kv[0]);
				option->value = g_strdup(kv[1]);
				/* Apply to last PD. */
				pd->options = g_slist_append(pd->options, option);
			}
			break;
		case 'i':
			opt_infile = optarg;
			break;
		case 'O':
			opstr = g_strsplit(optarg, ":", 0);
			if (!opstr[0] || !opstr[1]) {
				/* Need at least abc:def. */
				ERR("Syntax error at '%s'", optarg);
				g_strfreev(opstr);
				usage(NULL);
			}
			op->pd = g_strdup(opstr[0]);
			if (!strcmp(opstr[1], "annotation"))
				op->type = SRD_OUTPUT_ANN;
			else if (!strcmp(opstr[1], "binary"))
				op->type = SRD_OUTPUT_BINARY;
			else if (!strcmp(opstr[1], "python"))
				op->type = SRD_OUTPUT_PYTHON;
			else {
				ERR("Unknown output type '%s'", opstr[1]);
				g_strfreev(opstr);
				usage(NULL);
			}
			if (opstr[2])
				op->class = g_strdup(opstr[2]);
			g_strfreev(opstr);
			break;
		case 'f':
			op->outfile = g_strdup(optarg);
			op->outfd = -1;
			break;
		case 'S':
			statistics = TRUE;
			break;
		default:
			usage(NULL);
		}
	}
	if (argc > optind)
		usage(NULL);
	if (g_slist_length(pdlist) == 0)
		usage(NULL);
	if (!opt_infile)
		usage(NULL);
	if (!op->pd || op->type == -1)
		usage(NULL);

	sr_log_callback_set(sr_log, NULL);
	if (sr_init(&ctx) != SR_OK)
		return 1;

	srd_log_callback_set(srd_log, NULL);
	if (srd_init(DECODERS_DIR) != SRD_OK)
		return 1;

	ret = 0;
	if (!run_testcase(opt_infile, pdlist, op))
		ret = 1;

	srd_exit();
	sr_exit(ctx);

	return ret;
}
Commit	Line	Data
fbd226c3 BV	1	/*
	2	* This file is part of the libsigrokdecode project.
	3	*
	4	* Copyright (C) 2013 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 "../libsigrokdecode.h"
	21	#include <libsigrok/libsigrok.h>
	22	#include <stdlib.h>
	23	#include <stdio.h>
	24	#include <stdarg.h>
	25	#include <unistd.h>
	26	#include <errno.h>
	27	#include <sys/types.h>
	28	#include <sys/stat.h>
	29	#include <fcntl.h>
	30	#include <time.h>
	31	#include <sys/time.h>
	32	#include <sys/resource.h>
	33	#include <glib.h>
	34	#ifdef __LINUX__
	35	#include <sched.h>
	36	#endif
	37	#include "../config.h"
	38
	39
	40	int debug = FALSE;
	41	int statistics = FALSE;
	42
	43	struct probe {
	44	char *name;
	45	int probe;
	46	};
	47
	48	struct option {
	49	char *key;
	50	char *value;
	51	};
	52
	53	struct pd {
	54	char *name;
	55	GSList *probes;
	56	GSList *options;
	57	};
	58
	59	struct output {
	60	char *pd;
	61	int type;
	62	char *class;
	63	int class_idx;
	64	char *outfile;
65	int outfd;
66	};
67
68
69	void logmsg(char prefix, FILE out, const char *format, va_list args)
70	{
71	if (prefix)
72	fprintf(out, "%s", prefix);
73	vfprintf(out, format, args);
74	fprintf(out, "\n");
75	}
76
77	void DBG(const char *format, ...)
78	{
79	va_list args;
80
81	if (!debug)
82	return;
83	va_start(args, format);
84	logmsg("DBG: ", stdout, format, args);
85	va_end(args);
86	}
87
88	void ERR(const char *format, ...)
89	{
90	va_list args;
91
92	va_start(args, format);
93	logmsg("Error: ", stderr, format, args);
94	va_end(args);
95	}
96
caa4b2cc BV	97	int sr_log(void cb_data, int loglevel, const char format, va_list args)
	98	{
	99	(void)cb_data;
	100
	101	if (loglevel == SR_LOG_ERR \|\| loglevel == SR_LOG_WARN)
	102	logmsg("Error: sr: ", stderr, format, args);
	103	else if (debug)
	104	logmsg("DBG: sr: ", stdout, format, args);
	105
	106	return SRD_OK;
	107	}
	108
fbd226c3 BV	109	int srd_log(void cb_data, int loglevel, const char format, va_list args)
	110	{
	111	(void)cb_data;
	112
	113	if (loglevel == SRD_LOG_ERR \|\| loglevel == SRD_LOG_WARN)
	114	logmsg("Error: srd: ", stderr, format, args);
caa4b2cc	115	else if (debug)
fbd226c3 BV	116	logmsg("DBG: srd: ", stdout, format, args);
	117
	118	return SRD_OK;
	119	}
	120
	121	void usage(char *msg)
	122	{
	123	if (msg)
	124	fprintf(stderr, "%s\n", msg);
	125
fbd226c3 BV	126	printf("Usage: runtc [-dPpoiOf]\n");
	127	printf(" -d Debug\n");
	128	printf(" -P <protocol decoder>\n");
	129	printf(" -p <probename=probenum> (optional)\n");
	130	printf(" -o <probeoption=value> (optional)\n");
	131	printf(" -i <input file>\n");
	132	printf(" -O <output-pd:output-type[:output-class]>\n");
	133	printf(" -f <output file> (optional)\n");
	134	exit(msg ? 1 : 0);
	135
	136	}
	137
b7e15e0e BV	138	/* This is a neutered version of libsigrokdecode's py_str_as_str(). It
	139	* does no error checking, but then the only strings it processes are
	140	* generated by Python's repr(), so are known good. */
	141	char py_str_as_str(const PyObject py_str)
	142	{
	143	PyObject *py_encstr;
	144	char str, outstr;
	145
	146	py_encstr = PyUnicode_AsEncodedString((PyObject *)py_str, "utf-8", NULL);
	147	str = PyBytes_AS_STRING(py_encstr);
	148	outstr = g_strdup(str);
	149	Py_DecRef(py_encstr);
	150
	151	return outstr;
	152	}
	153
	154	static void srd_cb_py(struct srd_proto_data pdata, void cb_data)
d7d693b5	155	{
d7d693b5	156	struct output *op;
b7e15e0e BV	157	PyObject pydata, pyrepr;
	158	GString *out;
	159	char *s;
d7d693b5	160
b7e15e0e	161	DBG("Python output from %s", pdata->pdo->di->inst_id);
d7d693b5	162	op = cb_data;
b7e15e0e BV	163	pydata = pdata->data;
	164	DBG("ptr %p", pydata);
	165
	166	if (strcmp(pdata->pdo->di->inst_id, op->pd))
	167	/* This is not the PD selected for output. */
	168	return;
	169
	170	if (!(pyrepr = PyObject_Repr(pydata))) {
	171	ERR("Invalid Python object.");
d7d693b5	172	return;
b7e15e0e BV	173	}
	174	s = py_str_as_str(pyrepr);
	175	Py_DecRef(pyrepr);
	176
	177	/* Output format for testing is '<ss>-<es> <inst-id>: <repr>\n' */
	178	out = g_string_sized_new(128);
	179	g_string_printf(out, "%"PRIu64"-%"PRIu64" %s: %s\n",
	180	pdata->start_sample, pdata->end_sample,
	181	pdata->pdo->di->inst_id, s);
	182	g_free(s);
	183	if (write(op->outfd, out->str, out->len) == -1)
	184	ERR("SRD_OUTPUT_PYTHON callback write failure!");
	185	DBG("wrote '%s'", out->str);
	186	g_string_free(out, TRUE);
	187
	188	}
	189
	190	static void srd_cb_bin(struct srd_proto_data pdata, void cb_data)
	191	{
	192	struct srd_proto_data_binary *pdb;
	193	struct output *op;
97578cb1 BV	194	GString *out;
97578cb1 BV	195	unsigned int i;
d7d693b5 BV	196
d7d693b5 BV	197	DBG("Binary output from %s", pdata->pdo->di->inst_id);
b7e15e0e	198	op = cb_data;
d7d693b5 BV	199	pdb = pdata->data;
	200
	201	if (strcmp(pdata->pdo->di->inst_id, op->pd))
	202	/* This is not the PD selected for output. */
	203	return;
	204
	205	if (op->class_idx != -1 && op->class_idx != pdb->bin_class)
	206	/*
	207	* This output takes a specific binary class,
	208	* but not the one that just came in.
	209	*/
	210	return;
	211
97578cb1 BV	212	out = g_string_sized_new(128);
	213	g_string_printf(out, "%"PRIu64"-%"PRIu64" %s:",
	214	pdata->start_sample, pdata->end_sample,
	215	pdata->pdo->di->inst_id);
	216	for (i = 0; i < pdb->size; i++) {
	217	g_string_append_printf(out, " %.2x", pdb->data[i]);
	218	}
	219	g_string_append(out, "\n");
	220	if (write(op->outfd, out->str, out->len) == -1)
b7e15e0e	221	ERR("SRD_OUTPUT_BINARY callback write failure!");
d7d693b5 BV	222
	223	}
	224
fbd226c3 BV	225	static void srd_cb_ann(struct srd_proto_data pdata, void cb_data)
	226	{
	227	struct srd_decoder *dec;
	228	struct srd_proto_data_annotation *pda;
	229	struct output *op;
	230	GString *line;
	231	int i;
	232	char **dec_ann;
	233
d7d693b5	234	DBG("Annotation output from %s", pdata->pdo->di->inst_id);
b7e15e0e	235	op = cb_data;
fbd226c3 BV	236	pda = pdata->data;
fbd226c3 BV	237	dec = pdata->pdo->di->decoder;
fbd226c3 BV	238	if (strcmp(pdata->pdo->di->inst_id, op->pd))
	239	/* This is not the PD selected for output. */
	240	return;
	241
	242	if (op->class_idx != -1 && op->class_idx != pda->ann_format)
d7d693b5 BV	243	/*
	244	* This output takes a specific annotation class,
	245	* but not the one that just came in.
	246	*/
fbd226c3 BV	247	return;
	248
	249	dec_ann = g_slist_nth_data(dec->annotations, pda->ann_format);
	250	line = g_string_sized_new(256);
	251	g_string_printf(line, "%"PRIu64"-%"PRIu64" %s: %s:",
	252	pdata->start_sample, pdata->end_sample,
	253	pdata->pdo->di->inst_id, dec_ann[0]);
	254	for (i = 0; pda->ann_text[i]; i++)
	255	g_string_append_printf(line, " \"%s\"", pda->ann_text[i]);
	256	g_string_append(line, "\n");
	257	if (write(op->outfd, line->str, line->len) == -1)
b7e15e0e	258	ERR("SRD_OUTPUT_ANN callback write failure!");
fbd226c3 BV	259	g_string_free(line, TRUE);
	260
	261	}
	262
	263	static void sr_cb(const struct sr_dev_inst *sdi,
	264	const struct sr_datafeed_packet packet, void cb_data)
	265	{
	266	const struct sr_datafeed_logic *logic;
	267	struct srd_session *sess;
	268	GVariant *gvar;
	269	uint64_t samplerate;
	270	int num_samples;
	271	static int samplecnt = 0;
	272
	273	sess = cb_data;
	274
	275	switch (packet->type) {
	276	case SR_DF_HEADER:
	277	DBG("Received SR_DF_HEADER");
	278	if (sr_config_get(sdi->driver, sdi, NULL, SR_CONF_SAMPLERATE,
	279	&gvar) != SR_OK) {
	280	ERR("Getting samplerate failed");
	281	break;
	282	}
	283	samplerate = g_variant_get_uint64(gvar);
	284	g_variant_unref(gvar);
	285	if (srd_session_metadata_set(sess, SRD_CONF_SAMPLERATE,
	286	g_variant_new_uint64(samplerate)) != SRD_OK) {
	287	ERR("Setting samplerate failed");
	288	break;
	289	}
	290	if (srd_session_start(sess) != SRD_OK) {
	291	ERR("Session start failed");
	292	break;
	293	}
	294	break;
	295	case SR_DF_LOGIC:
	296	logic = packet->payload;
	297	num_samples = logic->length / logic->unitsize;
	298	DBG("Received SR_DF_LOGIC: %d samples", num_samples);
	299	srd_session_send(sess, samplecnt, samplecnt + num_samples,
	300	logic->data, logic->length);
	301	samplecnt += logic->length / logic->unitsize;
	302	break;
	303	case SR_DF_END:
	304	DBG("Received SR_DF_END");
	305	break;
	306	}
	307
	308	}
	309
	310	int get_stats(int stats[2])
	311	{
	312	FILE *f;
	313	size_t len;
	314	int tmp;
	315	char *buf;
	316
	317	stats[0] = stats[1] = -1;
	318	if (!(f = fopen("/proc/self/status", "r")))
	319	return FALSE;
	320	len = 128;
	321	buf = malloc(len);
	322	while (getline(&buf, &len, f) != -1) {
323	if (strcasestr(buf, "vmpeak:")) {
324	stats[0] = strtoul(buf + 10, NULL, 10);
325	} else if (strcasestr(buf, "vmsize:")) {
326	tmp = strtoul(buf + 10, NULL, 10);
327	if (tmp > stats[0])
328	stats[0] = tmp;
329	} else if (strcasestr(buf, "vmhwm:")) {
330	stats[1] = strtoul(buf + 6, NULL, 10);
331	} else if (strcasestr(buf, "vmrss:")) {
332	tmp = strtoul(buf + 10, NULL, 10);
333	if (tmp > stats[0])
334	stats[0] = tmp;
335	}
336	}
337	free(buf);
338	fclose(f);
339
340	return TRUE;
341	}
342
343	static int run_testcase(char infile, GSList pdlist, struct output *op)
344	{
345	struct srd_session *sess;
346	struct srd_decoder *dec;
347	struct srd_decoder_inst di, prev_di;
b7e15e0e	348	srd_pd_output_callback_t cb;
fbd226c3 BV	349	struct pd *pd;
	350	struct probe *probe;
	351	struct option *option;
	352	GVariant *gvar;
	353	GHashTable probes, opts;
6b85745a	354	GSList pdl, l;
fbd226c3	355	int idx;
6b85745a	356	char **decoder_class;
fbd226c3 BV	357
	358	if (op->outfile) {
	359	if ((op->outfd = open(op->outfile, O_CREAT\|O_WRONLY, 0600)) == -1) {
	360	ERR("Unable to open %s for writing: %s", op->outfile,
	361	strerror(errno));
	362	return FALSE;
	363	}
	364	}
	365
	366	if (sr_session_load(infile) != SR_OK)
	367	return FALSE;
	368
	369	if (srd_session_new(&sess) != SRD_OK)
	370	return FALSE;
	371	sr_session_datafeed_callback_add(sr_cb, sess);
b7e15e0e BV	372	switch (op->type) {
	373	case SRD_OUTPUT_ANN:
	374	cb = srd_cb_ann;
	375	break;
	376	case SRD_OUTPUT_BINARY:
	377	cb = srd_cb_bin;
	378	break;
	379	case SRD_OUTPUT_PYTHON:
	380	cb = srd_cb_py;
	381	break;
	382	default:
	383	return FALSE;
	384	}
	385	srd_pd_output_callback_add(sess, op->type, cb, op);
fbd226c3 BV	386
	387	prev_di = NULL;
	388	pd = NULL;
	389	for (pdl = pdlist; pdl; pdl = pdl->next) {
	390	pd = pdl->data;
	391	if (srd_decoder_load(pd->name) != SRD_OK)
	392	return FALSE;
	393
	394	/* Instantiate decoder and pass in options. */
	395	opts = g_hash_table_new_full(g_str_hash, g_str_equal, NULL,
	396	(GDestroyNotify)g_variant_unref);
	397	for (l = pd->options; l; l = l->next) {
	398	option = l->data;
	399	g_hash_table_insert(opts, option->key, option->value);
	400	}
	401	if (!(di = srd_inst_new(sess, pd->name, opts)))
	402	return FALSE;
	403	g_hash_table_destroy(opts);
	404
	405	/* Map probes. */
	406	if (pd->probes) {
	407	probes = g_hash_table_new_full(g_str_hash, g_str_equal, NULL,
	408	(GDestroyNotify)g_variant_unref);
	409	for (l = pd->probes; l; l = l->next) {
	410	probe = l->data;
	411	gvar = g_variant_new_int32(probe->probe);
	412	g_variant_ref_sink(gvar);
	413	g_hash_table_insert(probes, probe->name, gvar);
	414	}
	415	if (srd_inst_probe_set_all(di, probes) != SRD_OK)
	416	return FALSE;
	417	g_hash_table_destroy(probes);
	418	}
	419
fbd226c3 BV	420	/* If this is not the first decoder in the list, stack it
	421	* on top of the previous one. */
	422	if (prev_di) {
	423	if (srd_inst_stack(sess, prev_di, di) != SRD_OK) {
	424	ERR("Failed to stack decoder instances.");
	425	return FALSE;
	426	}
	427	}
	428	prev_di = di;
	429	}
	430
	431	/* Resolve top decoder's class index, so we can match. */
	432	dec = srd_decoder_get_by_id(pd->name);
	433	if (op->class) {
	434	if (op->type == SRD_OUTPUT_ANN)
6b85745a	435	l = dec->annotations;
fbd226c3	436	else if (op->type == SRD_OUTPUT_BINARY)
6b85745a	437	l = dec->binary;
fbd226c3	438	else
b7e15e0e	439	/* Only annotations and binary can have a class. */
fbd226c3 BV	440	return FALSE;
fbd226c3 BV	441	idx = 0;
6b85745a BV	442	while(l) {
	443	decoder_class = l->data;
	444	if (!strcmp(decoder_class[0], op->class)) {
fbd226c3 BV	445	op->class_idx = idx;
	446	break;
	447	} else
	448	idx++;
6b85745a	449	l = l->next;
fbd226c3 BV	450	}
	451	if (op->class_idx == -1) {
	452	ERR("Output class '%s' not found in decoder %s.",
	453	op->class, pd->name);
	454	return FALSE;
d7d693b5 BV	455	} else
d7d693b5 BV	456	DBG("Class %s index is %d", op->class, op->class_idx);
fbd226c3 BV	457	}
	458
	459	sr_session_start();
	460	sr_session_run();
	461	sr_session_stop();
	462
	463	srd_session_destroy(sess);
	464
	465	if (op->outfile)
	466	close(op->outfd);
	467
	468	return TRUE;
	469	}
	470
	471	int main(int argc, char **argv)
	472	{
	473	struct sr_context *ctx;
	474	GSList *pdlist;
	475	struct pd *pd;
	476	struct probe *probe;
	477	struct option *option;
	478	struct output *op;
932606db	479	int ret;
fbd226c3 BV	480	char c, opt_infile, kv, *opstr;
	481
	482	op = malloc(sizeof(struct output));
	483	op->pd = NULL;
	484	op->type = -1;
	485	op->class = NULL;
	486	op->class_idx = -1;
	487	op->outfd = 1;
	488
	489	pdlist = NULL;
	490	opt_infile = NULL;
	491	pd = NULL;
	492	while((c = getopt(argc, argv, "dP:p:o:i:O:f:S")) != -1) {
	493	switch(c) {
	494	case 'd':
	495	debug = TRUE;
	496	break;
	497	case 'P':
	498	pd = g_malloc(sizeof(struct pd));
	499	pd->name = g_strdup(optarg);
	500	pd->probes = pd->options = NULL;
	501	pdlist = g_slist_append(pdlist, pd);
	502	break;
	503	case 'p':
	504	case 'o':
	505	if (g_slist_length(pdlist) == 0) {
	506	/* No previous -P. */
	507	ERR("Syntax error at '%s'", optarg);
	508	usage(NULL);
	509	}
	510	kv = g_strsplit(optarg, "=", 0);
	511	if (!kv[0] \|\| (!kv[1] \|\| kv[2])) {
	512	/* Need x=y. */
	513	ERR("Syntax error at '%s'", optarg);
	514	g_strfreev(kv);
	515	usage(NULL);
	516	}
	517	if (c == 'p') {
	518	probe = malloc(sizeof(struct probe));
	519	probe->name = g_strdup(kv[0]);
	520	probe->probe = strtoul(kv[1], 0, 10);
	521	/* Apply to last PD. */
	522	pd->probes = g_slist_append(pd->probes, probe);
	523	} else {
	524	option = malloc(sizeof(struct option));
	525	option->key = g_strdup(kv[0]);
	526	option->value = g_strdup(kv[1]);
	527	/* Apply to last PD. */
	528	pd->options = g_slist_append(pd->options, option);
	529	}
	530	break;
	531	case 'i':
	532	opt_infile = optarg;
	533	break;
	534	case 'O':
	535	opstr = g_strsplit(optarg, ":", 0);
	536	if (!opstr[0] \|\| !opstr[1]) {
	537	/* Need at least abc:def. */
	538	ERR("Syntax error at '%s'", optarg);
	539	g_strfreev(opstr);
	540	usage(NULL);
	541	}
	542	op->pd = g_strdup(opstr[0]);
	543	if (!strcmp(opstr[1], "annotation"))
544	op->type = SRD_OUTPUT_ANN;
545	else if (!strcmp(opstr[1], "binary"))
546	op->type = SRD_OUTPUT_BINARY;
547	else if (!strcmp(opstr[1], "python"))
548	op->type = SRD_OUTPUT_PYTHON;
549	else {
550	ERR("Unknown output type '%s'", opstr[1]);
551	g_strfreev(opstr);
552	usage(NULL);
553	}
554	if (opstr[2])
555	op->class = g_strdup(opstr[2]);
556	g_strfreev(opstr);
557	break;
558	case 'f':
559	op->outfile = g_strdup(optarg);
560	op->outfd = -1;
561	break;
562	case 'S':
563	statistics = TRUE;
564	break;
565	default:
566	usage(NULL);
567	}
568	}
569	if (argc > optind)
570	usage(NULL);
571	if (g_slist_length(pdlist) == 0)
572	usage(NULL);
573	if (!opt_infile)
574	usage(NULL);
575	if (!op->pd \|\| op->type == -1)
576	usage(NULL);
577
caa4b2cc	578	sr_log_callback_set(sr_log, NULL);
fbd226c3 BV	579	if (sr_init(&ctx) != SR_OK)
	580	return 1;
	581
	582	srd_log_callback_set(srd_log, NULL);
b7482381	583	if (srd_init(DECODERS_DIR) != SRD_OK)
fbd226c3 BV	584	return 1;
fbd226c3 BV	585
932606db BV	586	ret = 0;
	587	if (!run_testcase(opt_infile, pdlist, op))
	588	ret = 1;
fbd226c3 BV	589
	590	srd_exit();
	591	sr_exit(ctx);
	592
932606db	593	return ret;
fbd226c3 BV	594	}
	595
	596