[libsigrok.git] / src / output / analog.c

/*
 * This file is part of the libsigrok project.
 *
 * Copyright (C) 2012 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 <stdlib.h>
#include <string.h>
#include <math.h>
#include <glib.h>
#include <libsigrok/libsigrok.h>
#include "libsigrok-internal.h"

#define LOG_PREFIX "output/analog"

struct context {
	int num_enabled_channels;
	GPtrArray *channellist;
	int digits;
};

enum {
	DIGITS_ALL,
	DIGITS_SPEC,
};

static int init(struct sr_output *o, GHashTable *options)
{
	struct context *ctx;
	struct sr_channel *ch;
	GSList *l;
	const char *s;

	if (!o || !o->sdi)
		return SR_ERR_ARG;

	o->priv = ctx = g_malloc0(sizeof(struct context));
	s = g_variant_get_string(g_hash_table_lookup(options, "digits"), NULL);
	if (!strcmp(s, "all"))
		ctx->digits = DIGITS_ALL;
	else
		ctx->digits = DIGITS_SPEC;

	/* Get the number of channels and their names. */
	ctx->channellist = g_ptr_array_new();
	for (l = o->sdi->channels; l; l = l->next) {
		ch = l->data;
		if (!ch || !ch->enabled)
			continue;
		g_ptr_array_add(ctx->channellist, ch->name);
		ctx->num_enabled_channels++;
	}

	return SR_OK;
}

static void si_printf(float value, GString *out, char *unitstr)
{
	float v;

	if (signbit(value))
		v = -(value);
	else
		v = value;

	if (v < 1e-12 || v > 1e+12)
		g_string_append_printf(out, "%f %s", value, unitstr);
	else if (v > 1e+9)
		g_string_append_printf(out, "%f G%s", value / 1e+9, unitstr);
	else if (v > 1e+6)
		g_string_append_printf(out, "%f M%s", value / 1e+6, unitstr);
	else if (v > 1e+3)
		g_string_append_printf(out, "%f k%s", value / 1e+3, unitstr);
	else if (v < 1e-9)
		g_string_append_printf(out, "%f n%s", value * 1e+9, unitstr);
	else if (v < 1e-6)
		g_string_append_printf(out, "%f u%s", value * 1e+6, unitstr);
	else if (v < 1e-3)
		g_string_append_printf(out, "%f m%s", value * 1e+3, unitstr);
	else
		g_string_append_printf(out, "%f %s", value, unitstr);

}

static void fancyprint(int unit, int mqflags, float value, GString *out)
{
	switch (unit) {
	case SR_UNIT_VOLT:
		si_printf(value, out, "V");
		break;
	case SR_UNIT_AMPERE:
		si_printf(value, out, "A");
		break;
	case SR_UNIT_OHM:
		si_printf(value, out, "");
		g_string_append_unichar(out, 0x2126);
		break;
	case SR_UNIT_FARAD:
		si_printf(value, out, "F");
		break;
	case SR_UNIT_KELVIN:
		si_printf(value, out, "K");
		break;
	case SR_UNIT_CELSIUS:
		si_printf(value, out, "");
		g_string_append_unichar(out, 0x00b0);
		g_string_append_c(out, 'C');
		break;
	case SR_UNIT_FAHRENHEIT:
		si_printf(value, out, "");
		g_string_append_unichar(out, 0x00b0);
		g_string_append_c(out, 'F');
		break;
	case SR_UNIT_HERTZ:
		si_printf(value, out, "Hz");
		break;
	case SR_UNIT_PERCENTAGE:
		g_string_append_printf(out, "%f %%", value);
		break;
	case SR_UNIT_BOOLEAN:
		if (value > 0)
			g_string_append_printf(out, "TRUE");
		else
			g_string_append_printf(out, "FALSE");
		break;
	case SR_UNIT_SECOND:
		si_printf(value, out, "s");
		break;
	case SR_UNIT_SIEMENS:
		si_printf(value, out, "S");
		break;
	case SR_UNIT_DECIBEL_MW:
		si_printf(value, out, "dBu");
		break;
	case SR_UNIT_DECIBEL_VOLT:
		si_printf(value, out, "dBV");
		break;
	case SR_UNIT_UNITLESS:
		si_printf(value, out, "");
		break;
	case SR_UNIT_DECIBEL_SPL:
		if (mqflags & SR_MQFLAG_SPL_FREQ_WEIGHT_A)
			si_printf(value, out, "dB(A)");
		else if (mqflags & SR_MQFLAG_SPL_FREQ_WEIGHT_C)
			si_printf(value, out, "dB(C)");
		else if (mqflags & SR_MQFLAG_SPL_FREQ_WEIGHT_Z)
			si_printf(value, out, "dB(Z)");
		else
			/* No frequency weighting, or non-standard "flat" */
			si_printf(value, out, "dB(SPL)");
		if (mqflags & SR_MQFLAG_SPL_TIME_WEIGHT_S)
			g_string_append(out, " S");
		else if (mqflags & SR_MQFLAG_SPL_TIME_WEIGHT_F)
			g_string_append(out, " F");
		if (mqflags & SR_MQFLAG_SPL_LAT)
			g_string_append(out, " LAT");
		else if (mqflags & SR_MQFLAG_SPL_PCT_OVER_ALARM)
			/* Not a standard function for SLMs, so this is
			 * a made-up notation. */
			g_string_append(out, " %oA");
		break;
	case SR_UNIT_CONCENTRATION:
		g_string_append_printf(out, "%f ppm", value * (1000 * 1000));
		break;
	case SR_UNIT_REVOLUTIONS_PER_MINUTE:
		si_printf(value, out, "RPM");
		break;
	case SR_UNIT_VOLT_AMPERE:
		si_printf(value, out, "VA");
		break;
	case SR_UNIT_WATT:
		si_printf(value, out, "W");
		break;
	case SR_UNIT_WATT_HOUR:
		si_printf(value, out, "Wh");
		break;
	case SR_UNIT_METER_SECOND:
		si_printf(value, out, "m/s");
		break;
	case SR_UNIT_HECTOPASCAL:
		si_printf(value, out, "hPa");
		break;
	case SR_UNIT_HUMIDITY_293K:
		si_printf(value, out, "%rF");
		break;
	case SR_UNIT_DEGREE:
		si_printf(value, out, "");
		g_string_append_unichar(out, 0x00b0);
		break;
	case SR_UNIT_HENRY:
		si_printf(value, out, "H");
		break;
	case SR_UNIT_GRAM:
		si_printf(value, out, "g");
		break;
	case SR_UNIT_CARAT:
		si_printf(value, out, "ct");
		break;
	case SR_UNIT_OUNCE:
		si_printf(value, out, "oz");
		break;
	case SR_UNIT_TROY_OUNCE:
		si_printf(value, out, "oz t");
		break;
	case SR_UNIT_POUND:
		si_printf(value, out, "lb");
		break;
	case SR_UNIT_PENNYWEIGHT:
		si_printf(value, out, "dwt");
		break;
	case SR_UNIT_GRAIN:
		si_printf(value, out, "gr");
		break;
	case SR_UNIT_TAEL:
		si_printf(value, out, "tael");
		break;
	case SR_UNIT_MOMME:
		si_printf(value, out, "momme");
		break;
	case SR_UNIT_TOLA:
		si_printf(value, out, "tola");
		break;
	case SR_UNIT_PIECE:
		si_printf(value, out, "pcs");
		break;
	default:
		si_printf(value, out, "");
		break;
	}

	if (mqflags & SR_MQFLAG_AC)
		g_string_append_printf(out, " AC");
	if (mqflags & SR_MQFLAG_DC)
		g_string_append_printf(out, " DC");
	if (mqflags & SR_MQFLAG_RMS)
		g_string_append_printf(out, " RMS");
	if (mqflags & SR_MQFLAG_DIODE)
		g_string_append_printf(out, " DIODE");
	if (mqflags & SR_MQFLAG_HOLD)
		g_string_append_printf(out, " HOLD");
	if (mqflags & SR_MQFLAG_MAX)
		g_string_append_printf(out, " MAX");
	if (mqflags & SR_MQFLAG_MIN)
		g_string_append_printf(out, " MIN");
	if (mqflags & SR_MQFLAG_AUTORANGE)
		g_string_append_printf(out, " AUTO");
	if (mqflags & SR_MQFLAG_RELATIVE)
		g_string_append_printf(out, " REL");
	/* Note: SR_MQFLAG_SPL_* is handled above. */
	if (mqflags & SR_MQFLAG_DURATION)
		g_string_append_printf(out, " DURATION");
	if (mqflags & SR_MQFLAG_AVG)
		g_string_append_printf(out, " AVG");
	if (mqflags & SR_MQFLAG_REFERENCE)
		g_string_append_printf(out, " REF");
	if (mqflags & SR_MQFLAG_UNSTABLE)
		g_string_append_printf(out, " UNSTABLE");
	g_string_append_c(out, '\n');
}

static int receive(const struct sr_output *o, const struct sr_datafeed_packet *packet,
		GString **out)
{
	struct context *ctx;
	const struct sr_datafeed_analog *analog;
	const struct sr_datafeed_analog2 *analog2;
	struct sr_channel *ch;
	GSList *l;
	float *fdata;
	unsigned int i;
	int num_channels, c, ret, si, digits;
	char *number, *suffix;

	*out = NULL;
	if (!o || !o->sdi)
		return SR_ERR_ARG;
	ctx = o->priv;

	switch (packet->type) {
	case SR_DF_FRAME_BEGIN:
		*out = g_string_new("FRAME-BEGIN\n");
		break;
	case SR_DF_FRAME_END:
		*out = g_string_new("FRAME-END\n");
		break;
	case SR_DF_ANALOG:
		analog = packet->payload;
		fdata = (float *)analog->data;
		*out = g_string_sized_new(512);
		num_channels = g_slist_length(analog->channels);
		for (si = 0; si < analog->num_samples; si++) {
			for (l = analog->channels, c = 0; l; l = l->next, c++) {
				ch = l->data;
				g_string_append_printf(*out, "%s: ", ch->name);
				fancyprint(analog->unit, analog->mqflags,
						fdata[si * num_channels + c], *out);
			}
		}
		break;
	case SR_DF_ANALOG2:
		analog2 = packet->payload;
		if (!(fdata = g_try_malloc(analog2->num_samples * sizeof(float))))
			return SR_ERR_MALLOC;
		if ((ret = sr_analog_to_float(analog2, fdata)) != SR_OK)
			return ret;
		*out = g_string_sized_new(512);
		if (analog2->encoding->is_digits_decimal) {
			if (ctx->digits == DIGITS_ALL)
				digits = analog2->encoding->digits;
			else
				digits = analog2->spec->spec_digits;
		} else {
			/* TODO we don't know how to print by number of bits yet. */
			digits = 6;
		}
		sr_analog_unit_to_string(analog2, &suffix);
		num_channels = g_slist_length(analog2->meaning->channels);
		for (i = 0; i < analog2->num_samples; i++) {
			for (l = analog2->meaning->channels, c = 0; l; l = l->next, c++) {
				ch = l->data;
				g_string_append_printf(*out, "%s: ", ch->name);
				sr_analog_float_to_string(fdata[i * num_channels + c],
						digits, &number);
				g_string_append(*out, number);
				g_free(number);
				g_string_append(*out, " ");
				g_string_append(*out, suffix);
				g_string_append(*out, "\n");
			}
		}
		g_free(suffix);
		break;
	}

	return SR_OK;
}

static int cleanup(struct sr_output *o)
{
	struct context *ctx;

	if (!o || !o->sdi)
		return SR_ERR_ARG;
	ctx = o->priv;

	g_ptr_array_free(ctx->channellist, 1);
	g_free(ctx);
	o->priv = NULL;

	return SR_OK;
}

static struct sr_option options[] = {
	{ "digits", "Digits", "Digits to show", NULL, NULL },
	ALL_ZERO
};

static const struct sr_option *get_options(void)
{
	if (!options[0].def) {
		options[0].def = g_variant_ref_sink(g_variant_new_string("all"));
		options[0].values = g_slist_append(options[0].values,
				g_variant_ref_sink(g_variant_new_string("all")));
		options[0].values = g_slist_append(options[0].values,
				g_variant_ref_sink(g_variant_new_string("spec")));
	}

	return options;
}

SR_PRIV struct sr_output_module output_analog = {
	.id = "analog",
	.name = "Analog",
	.desc = "Analog data and types",
	.exts = NULL,
	.flags = 0,
	.options = get_options,
	.init = init,
	.receive = receive,
	.cleanup = cleanup
};
Commit	Line	Data
161a8a27	1	/*
50985c20	2	* This file is part of the libsigrok project.
161a8a27 BV	3	*
	4	* Copyright (C) 2012 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 <string.h>
a944a84b	22	#include <math.h>
161a8a27	23	#include <glib.h>
c1aae900	24	#include <libsigrok/libsigrok.h>
161a8a27	25	#include "libsigrok-internal.h"
a944a84b	26
3544f848	27	#define LOG_PREFIX "output/analog"
161a8a27 BV	28
161a8a27 BV	29	struct context {
ba7dd8bb UH	30	int num_enabled_channels;
ba7dd8bb UH	31	GPtrArray *channellist;
820c48f8 BV	32	int digits;
	33	};
	34
	35	enum {
	36	DIGITS_ALL,
	37	DIGITS_SPEC,
161a8a27 BV	38	};
161a8a27 BV	39
a755b0e1	40	static int init(struct sr_output o, GHashTable options)
161a8a27 BV	41	{
161a8a27 BV	42	struct context *ctx;
ba7dd8bb	43	struct sr_channel *ch;
161a8a27	44	GSList *l;
820c48f8	45	const char *s;
a944a84b	46
161a8a27 BV	47	if (!o \|\| !o->sdi)
	48	return SR_ERR_ARG;
	49
91219afc	50	o->priv = ctx = g_malloc0(sizeof(struct context));
820c48f8 BV	51	s = g_variant_get_string(g_hash_table_lookup(options, "digits"), NULL);
	52	if (!strcmp(s, "all"))
	53	ctx->digits = DIGITS_ALL;
	54	else
	55	ctx->digits = DIGITS_SPEC;
161a8a27	56
ba7dd8bb UH	57	/* Get the number of channels and their names. */
	58	ctx->channellist = g_ptr_array_new();
	59	for (l = o->sdi->channels; l; l = l->next) {
	60	ch = l->data;
	61	if (!ch \|\| !ch->enabled)
161a8a27	62	continue;
ba7dd8bb UH	63	g_ptr_array_add(ctx->channellist, ch->name);
ba7dd8bb UH	64	ctx->num_enabled_channels++;
161a8a27 BV	65	}
161a8a27 BV	66
161a8a27 BV	67	return SR_OK;
	68	}
	69
	70	static void si_printf(float value, GString out, char unitstr)
	71	{
d713e561	72	float v;
161a8a27	73
d713e561 BV	74	if (signbit(value))
	75	v = -(value);
	76	else
	77	v = value;
	78
	79	if (v < 1e-12 \|\| v > 1e+12)
	80	g_string_append_printf(out, "%f %s", value, unitstr);
	81	else if (v > 1e+9)
	82	g_string_append_printf(out, "%f G%s", value / 1e+9, unitstr);
	83	else if (v > 1e+6)
	84	g_string_append_printf(out, "%f M%s", value / 1e+6, unitstr);
	85	else if (v > 1e+3)
	86	g_string_append_printf(out, "%f k%s", value / 1e+3, unitstr);
	87	else if (v < 1e-9)
	88	g_string_append_printf(out, "%f n%s", value * 1e+9, unitstr);
	89	else if (v < 1e-6)
	90	g_string_append_printf(out, "%f u%s", value * 1e+6, unitstr);
	91	else if (v < 1e-3)
	92	g_string_append_printf(out, "%f m%s", value * 1e+3, unitstr);
161a8a27 BV	93	else
	94	g_string_append_printf(out, "%f %s", value, unitstr);
	95
	96	}
	97
	98	static void fancyprint(int unit, int mqflags, float value, GString *out)
	99	{
161a8a27	100	switch (unit) {
06c45a66 UH	101	case SR_UNIT_VOLT:
	102	si_printf(value, out, "V");
	103	break;
	104	case SR_UNIT_AMPERE:
	105	si_printf(value, out, "A");
	106	break;
	107	case SR_UNIT_OHM:
	108	si_printf(value, out, "");
	109	g_string_append_unichar(out, 0x2126);
	110	break;
	111	case SR_UNIT_FARAD:
	112	si_printf(value, out, "F");
	113	break;
	114	case SR_UNIT_KELVIN:
	115	si_printf(value, out, "K");
	116	break;
	117	case SR_UNIT_CELSIUS:
	118	si_printf(value, out, "");
	119	g_string_append_unichar(out, 0x00b0);
	120	g_string_append_c(out, 'C');
	121	break;
	122	case SR_UNIT_FAHRENHEIT:
	123	si_printf(value, out, "");
	124	g_string_append_unichar(out, 0x00b0);
	125	g_string_append_c(out, 'F');
	126	break;
	127	case SR_UNIT_HERTZ:
	128	si_printf(value, out, "Hz");
	129	break;
	130	case SR_UNIT_PERCENTAGE:
641d8f27	131	g_string_append_printf(out, "%f %%", value);
06c45a66 UH	132	break;
	133	case SR_UNIT_BOOLEAN:
	134	if (value > 0)
	135	g_string_append_printf(out, "TRUE");
	136	else
	137	g_string_append_printf(out, "FALSE");
	138	break;
	139	case SR_UNIT_SECOND:
	140	si_printf(value, out, "s");
	141	break;
	142	case SR_UNIT_SIEMENS:
	143	si_printf(value, out, "S");
	144	break;
	145	case SR_UNIT_DECIBEL_MW:
	146	si_printf(value, out, "dBu");
	147	break;
	148	case SR_UNIT_DECIBEL_VOLT:
	149	si_printf(value, out, "dBV");
	150	break;
c984f2f9 UH	151	case SR_UNIT_UNITLESS:
	152	si_printf(value, out, "");
	153	break;
06c45a66 UH	154	case SR_UNIT_DECIBEL_SPL:
	155	if (mqflags & SR_MQFLAG_SPL_FREQ_WEIGHT_A)
	156	si_printf(value, out, "dB(A)");
	157	else if (mqflags & SR_MQFLAG_SPL_FREQ_WEIGHT_C)
	158	si_printf(value, out, "dB(C)");
	159	else if (mqflags & SR_MQFLAG_SPL_FREQ_WEIGHT_Z)
	160	si_printf(value, out, "dB(Z)");
	161	else
	162	/* No frequency weighting, or non-standard "flat" */
	163	si_printf(value, out, "dB(SPL)");
	164	if (mqflags & SR_MQFLAG_SPL_TIME_WEIGHT_S)
	165	g_string_append(out, " S");
	166	else if (mqflags & SR_MQFLAG_SPL_TIME_WEIGHT_F)
	167	g_string_append(out, " F");
	168	if (mqflags & SR_MQFLAG_SPL_LAT)
	169	g_string_append(out, " LAT");
	170	else if (mqflags & SR_MQFLAG_SPL_PCT_OVER_ALARM)
	171	/* Not a standard function for SLMs, so this is
	172	* a made-up notation. */
	173	g_string_append(out, " %oA");
	174	break;
	175	case SR_UNIT_CONCENTRATION:
1a46cc62	176	g_string_append_printf(out, "%f ppm", value * (1000 * 1000));
06c45a66	177	break;
87532f23 AJ	178	case SR_UNIT_REVOLUTIONS_PER_MINUTE:
87532f23 AJ	179	si_printf(value, out, "RPM");
d69d2642	180	break;
45315d04 AJ	181	case SR_UNIT_VOLT_AMPERE:
	182	si_printf(value, out, "VA");
	183	break;
	184	case SR_UNIT_WATT:
	185	si_printf(value, out, "W");
	186	break;
	187	case SR_UNIT_WATT_HOUR:
	188	si_printf(value, out, "Wh");
87532f23	189	break;
543d041d BV	190	case SR_UNIT_METER_SECOND:
	191	si_printf(value, out, "m/s");
	192	break;
	193	case SR_UNIT_HECTOPASCAL:
	194	si_printf(value, out, "hPa");
	195	break;
	196	case SR_UNIT_HUMIDITY_293K:
	197	si_printf(value, out, "%rF");
	198	break;
02c7c482 JH	199	case SR_UNIT_DEGREE:
	200	si_printf(value, out, "");
	201	g_string_append_unichar(out, 0x00b0);
	202	break;
c984f2f9 UH	203	case SR_UNIT_HENRY:
	204	si_printf(value, out, "H");
	205	break;
34eaf4bc UH	206	case SR_UNIT_GRAM:
	207	si_printf(value, out, "g");
	208	break;
	209	case SR_UNIT_CARAT:
	210	si_printf(value, out, "ct");
	211	break;
	212	case SR_UNIT_OUNCE:
	213	si_printf(value, out, "oz");
	214	break;
	215	case SR_UNIT_TROY_OUNCE:
	216	si_printf(value, out, "oz t");
	217	break;
	218	case SR_UNIT_POUND:
	219	si_printf(value, out, "lb");
	220	break;
	221	case SR_UNIT_PENNYWEIGHT:
	222	si_printf(value, out, "dwt");
	223	break;
	224	case SR_UNIT_GRAIN:
	225	si_printf(value, out, "gr");
	226	break;
	227	case SR_UNIT_TAEL:
	228	si_printf(value, out, "tael");
	229	break;
	230	case SR_UNIT_MOMME:
	231	si_printf(value, out, "momme");
	232	break;
	233	case SR_UNIT_TOLA:
	234	si_printf(value, out, "tola");
	235	break;
	236	case SR_UNIT_PIECE:
	237	si_printf(value, out, "pcs");
	238	break;
06c45a66 UH	239	default:
	240	si_printf(value, out, "");
	241	break;
161a8a27	242	}
e6523173 UH	243
e6523173 UH	244	if (mqflags & SR_MQFLAG_AC)
161a8a27	245	g_string_append_printf(out, " AC");
e6523173	246	if (mqflags & SR_MQFLAG_DC)
161a8a27	247	g_string_append_printf(out, " DC");
e6523173 UH	248	if (mqflags & SR_MQFLAG_RMS)
	249	g_string_append_printf(out, " RMS");
	250	if (mqflags & SR_MQFLAG_DIODE)
	251	g_string_append_printf(out, " DIODE");
	252	if (mqflags & SR_MQFLAG_HOLD)
	253	g_string_append_printf(out, " HOLD");
	254	if (mqflags & SR_MQFLAG_MAX)
	255	g_string_append_printf(out, " MAX");
	256	if (mqflags & SR_MQFLAG_MIN)
	257	g_string_append_printf(out, " MIN");
	258	if (mqflags & SR_MQFLAG_AUTORANGE)
	259	g_string_append_printf(out, " AUTO");
	260	if (mqflags & SR_MQFLAG_RELATIVE)
	261	g_string_append_printf(out, " REL");
c984f2f9 UH	262	/* Note: SR_MQFLAG_SPL_* is handled above. */
	263	if (mqflags & SR_MQFLAG_DURATION)
	264	g_string_append_printf(out, " DURATION");
f5027ca4 AJ	265	if (mqflags & SR_MQFLAG_AVG)
f5027ca4 AJ	266	g_string_append_printf(out, " AVG");
02c7c482 JH	267	if (mqflags & SR_MQFLAG_REFERENCE)
02c7c482 JH	268	g_string_append_printf(out, " REF");
34eaf4bc UH	269	if (mqflags & SR_MQFLAG_UNSTABLE)
34eaf4bc UH	270	g_string_append_printf(out, " UNSTABLE");
161a8a27	271	g_string_append_c(out, '\n');
161a8a27 BV	272	}
161a8a27 BV	273
a755b0e1	274	static int receive(const struct sr_output o, const struct sr_datafeed_packet packet,
dba3e682	275	GString **out)
161a8a27	276	{
820c48f8	277	struct context *ctx;
69e19dd7	278	const struct sr_datafeed_analog *analog;
e02e9e6a	279	const struct sr_datafeed_analog2 *analog2;
ba7dd8bb	280	struct sr_channel *ch;
69e19dd7	281	GSList *l;
e02e9e6a BV	282	float *fdata;
e02e9e6a BV	283	unsigned int i;
820c48f8	284	int num_channels, c, ret, si, digits;
a24da9a8	285	char number, suffix;
161a8a27	286
17f63de6	287	*out = NULL;
161a8a27	288	if (!o \|\| !o->sdi)
17f63de6	289	return SR_ERR_ARG;
820c48f8	290	ctx = o->priv;
161a8a27	291
161a8a27	292	switch (packet->type) {
161a8a27	293	case SR_DF_FRAME_BEGIN:
17f63de6	294	*out = g_string_new("FRAME-BEGIN\n");
161a8a27 BV	295	break;
161a8a27 BV	296	case SR_DF_FRAME_END:
17f63de6	297	*out = g_string_new("FRAME-END\n");
161a8a27 BV	298	break;
	299	case SR_DF_ANALOG:
	300	analog = packet->payload;
e02e9e6a	301	fdata = (float *)analog->data;
17f63de6	302	*out = g_string_sized_new(512);
6e6babb9	303	num_channels = g_slist_length(analog->channels);
e02e9e6a	304	for (si = 0; si < analog->num_samples; si++) {
6e6babb9	305	for (l = analog->channels, c = 0; l; l = l->next, c++) {
ba7dd8bb UH	306	ch = l->data;
ba7dd8bb UH	307	g_string_append_printf(*out, "%s: ", ch->name);
161a8a27	308	fancyprint(analog->unit, analog->mqflags,
e02e9e6a BV	309	fdata[si * num_channels + c], *out);
	310	}
	311	}
	312	break;
	313	case SR_DF_ANALOG2:
	314	analog2 = packet->payload;
	315	if (!(fdata = g_try_malloc(analog2->num_samples * sizeof(float))))
	316	return SR_ERR_MALLOC;
	317	if ((ret = sr_analog_to_float(analog2, fdata)) != SR_OK)
	318	return ret;
	319	*out = g_string_sized_new(512);
820c48f8 BV	320	if (analog2->encoding->is_digits_decimal) {
	321	if (ctx->digits == DIGITS_ALL)
	322	digits = analog2->encoding->digits;
	323	else
	324	digits = analog2->spec->spec_digits;
	325	} else {
	326	/* TODO we don't know how to print by number of bits yet. */
	327	digits = 6;
	328	}
a24da9a8	329	sr_analog_unit_to_string(analog2, &suffix);
e02e9e6a BV	330	num_channels = g_slist_length(analog2->meaning->channels);
	331	for (i = 0; i < analog2->num_samples; i++) {
	332	for (l = analog2->meaning->channels, c = 0; l; l = l->next, c++) {
	333	ch = l->data;
	334	g_string_append_printf(*out, "%s: ", ch->name);
820c48f8	335	sr_analog_float_to_string(fdata[i * num_channels + c],
a24da9a8	336	digits, &number);
820c48f8	337	g_string_append(*out, number);
a24da9a8	338	g_free(number);
820c48f8 BV	339	g_string_append(*out, " ");
	340	g_string_append(*out, suffix);
	341	g_string_append(*out, "\n");
161a8a27 BV	342	}
161a8a27 BV	343	}
a24da9a8	344	g_free(suffix);
161a8a27 BV	345	break;
	346	}
	347
17f63de6	348	return SR_OK;
161a8a27 BV	349	}
	350
	351	static int cleanup(struct sr_output *o)
	352	{
	353	struct context *ctx;
	354
	355	if (!o \|\| !o->sdi)
	356	return SR_ERR_ARG;
d686c5ec	357	ctx = o->priv;
161a8a27	358
ba7dd8bb	359	g_ptr_array_free(ctx->channellist, 1);
161a8a27	360	g_free(ctx);
d686c5ec	361	o->priv = NULL;
161a8a27 BV	362
	363	return SR_OK;
	364	}
	365
820c48f8 BV	366	static struct sr_option options[] = {
	367	{ "digits", "Digits", "Digits to show", NULL, NULL },
	368	ALL_ZERO
	369	};
	370
	371	static const struct sr_option *get_options(void)
	372	{
	373	if (!options[0].def) {
	374	options[0].def = g_variant_ref_sink(g_variant_new_string("all"));
	375	options[0].values = g_slist_append(options[0].values,
	376	g_variant_ref_sink(g_variant_new_string("all")));
	377	options[0].values = g_slist_append(options[0].values,
	378	g_variant_ref_sink(g_variant_new_string("spec")));
	379	}
	380
	381	return options;
	382	}
	383
a755b0e1	384	SR_PRIV struct sr_output_module output_analog = {
161a8a27	385	.id = "analog",
a755b0e1 BV	386	.name = "Analog",
a755b0e1 BV	387	.desc = "Analog data and types",
8a174d23	388	.exts = NULL,
3cd4b381	389	.flags = 0,
820c48f8	390	.options = get_options,
161a8a27	391	.init = init,
17f63de6	392	.receive = receive,
161a8a27 BV	393	.cleanup = cleanup
161a8a27 BV	394	};