[libsigrok.git] / src / hardware / brymen-bm86x / protocol.c

/*
 * This file is part of the libsigrok project.
 *
 * Copyright (C) 2014 Aurelien Jacobs <aurel@gnuage.org>
 *
 * 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 <config.h>
#include <string.h>
#include <math.h>
#include "protocol.h"

#define USB_TIMEOUT 500

static const char char_map[128] = {
	[0x20] = '-',
	[0x5F] = '0',
	[0x50] = '1',
	[0x6D] = '2',
	[0x7C] = '3',
	[0x72] = '4',
	[0x3E] = '5',
	[0x3F] = '6',
	[0x54] = '7',
	[0x7F] = '8',
	[0x7E] = '9',
	[0x0F] = 'C',
	[0x27] = 'F',
	[0x0B] = 'L',
	[0x79] = 'd',
	[0x10] = 'i',
	[0x39] = 'o',
};

static int brymen_bm86x_parse_digits(const unsigned char *buf, int length,
                                     char *str, float *floatval,
                                     char *temp_unit, int *digits, int flag)
{
	char c, *p = str;
	int i, ret;

	*digits = INT_MIN;

	if (buf[0] & flag)
		*p++ = '-';
	for (i = 0; i < length; i++) {
		if (i && i < 5 && buf[i+1] & 0x01) {
			*p++ = '.';
			*digits = 0;
		}
		c = char_map[buf[i+1] >> 1];
		if (i == 5 && (c == 'C' || c == 'F'))
			*temp_unit = c;
		else if (c) {
			*p++ = c;
			(*digits)++;
		}
	}
	*p = 0;

	if (*digits < 0)
		*digits = 0;

	if ((ret = sr_atof_ascii(str, floatval))) {
		sr_dbg("invalid float string: '%s'", str);
		return ret;
	}

	return SR_OK;
}

static void brymen_bm86x_parse(unsigned char *buf, float *floatval,
                               struct sr_datafeed_analog *analog)
{
	char str[16], temp_unit;
	int ret1, ret2, digits[2], over_limit;

	ret1 = brymen_bm86x_parse_digits(buf+2, 6, str, &floatval[0],
	                                 &temp_unit, &digits[0], 0x80);
	over_limit = strstr(str, "0L") || strstr(str, "0.L");
	ret2 = brymen_bm86x_parse_digits(buf+9, 4, str, &floatval[1],
	                                 &temp_unit, &digits[1], 0x10);

	/* main display */
	if (ret1 == SR_OK || over_limit) {
		/* SI unit */
		if (buf[8] & 0x01) {
			analog[0].meaning->mq = SR_MQ_VOLTAGE;
			analog[0].meaning->unit = SR_UNIT_VOLT;
			if (!strcmp(str, "diod")) {
				analog[0].meaning->mqflags |= SR_MQFLAG_DIODE;
				analog[0].meaning->mqflags |= SR_MQFLAG_DC;
			}
		} else if (buf[14] & 0x80) {
			analog[0].meaning->mq = SR_MQ_CURRENT;
			analog[0].meaning->unit = SR_UNIT_AMPERE;
		} else if (buf[14] & 0x20) {
			analog[0].meaning->mq = SR_MQ_CAPACITANCE;
			analog[0].meaning->unit = SR_UNIT_FARAD;
		} else if (buf[14] & 0x10) {
			analog[0].meaning->mq = SR_MQ_CONDUCTANCE;
			analog[0].meaning->unit = SR_UNIT_SIEMENS;
		} else if (buf[15] & 0x01) {
			analog[0].meaning->mq = SR_MQ_FREQUENCY;
			analog[0].meaning->unit = SR_UNIT_HERTZ;
		} else if (buf[10] & 0x01) {
			analog[0].meaning->mq = SR_MQ_CONTINUITY;
			analog[0].meaning->unit = SR_UNIT_OHM;
		} else if (buf[15] & 0x10) {
			analog[0].meaning->mq = SR_MQ_RESISTANCE;
			analog[0].meaning->unit = SR_UNIT_OHM;
		} else if (buf[15] & 0x02) {
			analog[0].meaning->mq = SR_MQ_POWER;
			analog[0].meaning->unit = SR_UNIT_DECIBEL_MW;
		} else if (buf[15] & 0x80) {
			analog[0].meaning->mq = SR_MQ_DUTY_CYCLE;
			analog[0].meaning->unit = SR_UNIT_PERCENTAGE;
		} else if (buf[ 2] & 0x0A) {
			analog[0].meaning->mq = SR_MQ_TEMPERATURE;
			if (temp_unit == 'F')
				analog[0].meaning->unit = SR_UNIT_FAHRENHEIT;
			else
				analog[0].meaning->unit = SR_UNIT_CELSIUS;
		}

		/* when MIN MAX and AVG are displayed at the same time, remove them */
		if ((buf[1] & 0xE0) == 0xE0)
			buf[1] &= ~0xE0;

		/* AC/DC/Auto flags */
		if (buf[1] & 0x10)  analog[0].meaning->mqflags |= SR_MQFLAG_DC;
		if (buf[2] & 0x01)  analog[0].meaning->mqflags |= SR_MQFLAG_AC;
		if (buf[1] & 0x01)  analog[0].meaning->mqflags |= SR_MQFLAG_AUTORANGE;
		if (buf[1] & 0x08)  analog[0].meaning->mqflags |= SR_MQFLAG_HOLD;
		if (buf[1] & 0x20)  analog[0].meaning->mqflags |= SR_MQFLAG_MAX;
		if (buf[1] & 0x40)  analog[0].meaning->mqflags |= SR_MQFLAG_MIN;
		if (buf[1] & 0x80)  analog[0].meaning->mqflags |= SR_MQFLAG_AVG;
		if (buf[3] & 0x01)  analog[0].meaning->mqflags |= SR_MQFLAG_RELATIVE;

		/* when dBm is displayed, remove the m suffix so that it is
		   not considered as the 10e-3 SI prefix */
		if (buf[15] & 0x02)
			buf[15] &= ~0x04;

		/* SI prefix */
		if (buf[14] & 0x40)  { floatval[0] *= 1e-9; digits[0] += 9; } /* n */
		if (buf[15] & 0x08)  { floatval[0] *= 1e-6; digits[0] += 6; } /* µ */
		if (buf[15] & 0x04)  { floatval[0] *= 1e-3; digits[0] += 3; } /* m */
		if (buf[15] & 0x40)  { floatval[0] *= 1e3;  digits[0] -= 3; } /* k */
		if (buf[15] & 0x20)  { floatval[0] *= 1e6;  digits[0] -= 6; } /* M */

		if (over_limit)      floatval[0] = INFINITY;

		analog[0].encoding->digits  = digits[0];
		analog[0].spec->spec_digits = digits[0];
	}

	/* secondary display */
	if (ret2 == SR_OK) {
		/* SI unit */
		if (buf[14] & 0x08) {
			analog[1].meaning->mq = SR_MQ_VOLTAGE;
			analog[1].meaning->unit = SR_UNIT_VOLT;
		} else if (buf[9] & 0x04) {
			analog[1].meaning->mq = SR_MQ_CURRENT;
			analog[1].meaning->unit = SR_UNIT_AMPERE;
		} else if (buf[9] & 0x08) {
			analog[1].meaning->mq = SR_MQ_CURRENT;
			analog[1].meaning->unit = SR_UNIT_PERCENTAGE;
		} else if (buf[14] & 0x04) {
			analog[1].meaning->mq = SR_MQ_FREQUENCY;
			analog[1].meaning->unit = SR_UNIT_HERTZ;
		} else if (buf[9] & 0x40) {
			analog[1].meaning->mq = SR_MQ_TEMPERATURE;
			if (temp_unit == 'F')
				analog[1].meaning->unit = SR_UNIT_FAHRENHEIT;
			else
				analog[1].meaning->unit = SR_UNIT_CELSIUS;
		}

		/* AC flag */
		if (buf[9] & 0x20)  analog[1].meaning->mqflags |= SR_MQFLAG_AC;

		/* SI prefix */
		if (buf[ 9] & 0x01)  { floatval[1] *= 1e-6; digits[1] += 6; } /* µ */
		if (buf[ 9] & 0x02)  { floatval[1] *= 1e-3; digits[1] += 3; } /* m */
		if (buf[14] & 0x02)  { floatval[1] *= 1e3;  digits[1] -= 3; } /* k */
		if (buf[14] & 0x01)  { floatval[1] *= 1e6;  digits[1] -= 6; } /* M */

		analog[1].encoding->digits  = digits[1];
		analog[1].spec->spec_digits = digits[1];
	}

	if (buf[9] & 0x80)
		sr_spew("Battery is low.");
}

static void brymen_bm86x_handle_packet(const struct sr_dev_inst *sdi,
                                       unsigned char *buf)
{
	struct dev_context *devc;
	struct sr_datafeed_packet packet;
	struct sr_datafeed_analog analog[2];
	struct sr_analog_encoding encoding[2];
	struct sr_analog_meaning meaning[2];
	struct sr_analog_spec spec[2];
	struct sr_channel *channel;
	int sent_ch1, sent_ch2;
	float floatval[2];

	devc = sdi->priv;

	/* Note: digits/spec_digits will be overridden later. */
	sr_analog_init(&analog[0], &encoding[0], &meaning[0], &spec[0], 0);
	sr_analog_init(&analog[1], &encoding[1], &meaning[1], &spec[1], 0);

	brymen_bm86x_parse(buf, floatval, analog);
	sent_ch1 = sent_ch2 = 0;

	channel = sdi->channels->data;
	if (analog[0].meaning->mq != 0 && channel->enabled) {
		/* Got a measurement. */
		sent_ch1 = 1;
		analog[0].num_samples = 1;
		analog[0].data = &floatval[0];
		analog[0].meaning->channels = g_slist_append(NULL, channel);
		packet.type = SR_DF_ANALOG;
		packet.payload = &analog[0];
		sr_session_send(sdi, &packet);
		g_slist_free(analog[0].meaning->channels);
	}

	channel = sdi->channels->next->data;
	if (analog[1].meaning->mq != 0 && channel->enabled) {
		/* Got a measurement. */
		sent_ch2 = 1;
		analog[1].num_samples = 1;
		analog[1].data = &floatval[1];
		analog[1].meaning->channels = g_slist_append(NULL, channel);
		packet.type = SR_DF_ANALOG;
		packet.payload = &analog[1];
		sr_session_send(sdi, &packet);
		g_slist_free(analog[1].meaning->channels);
	}

	if (sent_ch1 || sent_ch2)
		sr_sw_limits_update_samples_read(&devc->sw_limits, 1);
}

static int brymen_bm86x_send_command(const struct sr_dev_inst *sdi)
{
	struct sr_usb_dev_inst *usb;
	unsigned char buf[] = { 0x00, 0x86, 0x66 };
	int ret;

	usb = sdi->conn;

	sr_dbg("Sending HID set report.");
	ret = libusb_control_transfer(usb->devhdl,
	                              LIBUSB_REQUEST_TYPE_CLASS |
	                              LIBUSB_RECIPIENT_INTERFACE |
	                              LIBUSB_ENDPOINT_OUT,
	                              9,     /* bRequest: HID set_report */
	                              0x300, /* wValue: HID feature, report num 0 */
	                              0,     /* wIndex: interface 0 */
	                              buf, sizeof(buf), USB_TIMEOUT);

	if (ret < 0) {
		sr_err("HID feature report error: %s.", libusb_error_name(ret));
		return SR_ERR;
	}

	if (ret != sizeof(buf)) {
		sr_err("Short packet: sent %d/%zu bytes.", ret, sizeof(buf));
		return SR_ERR;
	}

	return SR_OK;
}

static int brymen_bm86x_read_interrupt(const struct sr_dev_inst *sdi)
{
	struct dev_context *devc;
	struct sr_usb_dev_inst *usb;
	unsigned char buf[24];
	int ret, transferred;

	devc = sdi->priv;
	usb = sdi->conn;

	sr_dbg("Reading HID interrupt report.");
	/* Get data from EP1 using an interrupt transfer. */
	ret = libusb_interrupt_transfer(usb->devhdl,
	                                LIBUSB_ENDPOINT_IN | 1, /* EP1, IN */
	                                buf, sizeof(buf),
	                                &transferred, USB_TIMEOUT);

	if (ret == LIBUSB_ERROR_TIMEOUT) {
		if (++devc->interrupt_pending > 3)
			devc->interrupt_pending = 0;
		return SR_OK;
	}

	if (ret < 0) {
		sr_err("USB receive error: %s.", libusb_error_name(ret));
		return SR_ERR;
	}

	if (transferred != sizeof(buf)) {
		sr_err("Short packet: received %d/%zu bytes.", transferred, sizeof(buf));
		return SR_ERR;
	}

	devc->interrupt_pending = 0;
	brymen_bm86x_handle_packet(sdi, buf);

	return SR_OK;
}

SR_PRIV int brymen_bm86x_receive_data(int fd, int revents, void *cb_data)
{
	struct sr_dev_inst *sdi;
	struct dev_context *devc;

	(void)fd;
	(void)revents;

	if (!(sdi = cb_data))
		return TRUE;

	if (!(devc = sdi->priv))
		return TRUE;

	if (!devc->interrupt_pending) {
		if (brymen_bm86x_send_command(sdi))
			return FALSE;
		devc->interrupt_pending = 1;
	}

	if (brymen_bm86x_read_interrupt(sdi))
		return FALSE;

	if (sr_sw_limits_check(&devc->sw_limits))
		sr_dev_acquisition_stop(sdi);

	return TRUE;
}
Commit	Line	Data
8d9c8554 AJ	1	/*
	2	* This file is part of the libsigrok project.
	3	*
	4	* Copyright (C) 2014 Aurelien Jacobs <aurel@gnuage.org>
	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
6ec6c43b	20	#include <config.h>
ecaa89af AJ	21	#include <string.h>
ecaa89af AJ	22	#include <math.h>
8d9c8554 AJ	23	#include "protocol.h"
8d9c8554 AJ	24
ecaa89af AJ	25	#define USB_TIMEOUT 500
ecaa89af AJ	26
329733d9	27	static const char char_map[128] = {
ecaa89af AJ	28	[0x20] = '-',
	29	[0x5F] = '0',
	30	[0x50] = '1',
	31	[0x6D] = '2',
	32	[0x7C] = '3',
	33	[0x72] = '4',
	34	[0x3E] = '5',
	35	[0x3F] = '6',
	36	[0x54] = '7',
	37	[0x7F] = '8',
	38	[0x7E] = '9',
	39	[0x0F] = 'C',
	40	[0x27] = 'F',
	41	[0x0B] = 'L',
	42	[0x79] = 'd',
	43	[0x10] = 'i',
	44	[0x39] = 'o',
	45	};
	46
	47	static int brymen_bm86x_parse_digits(const unsigned char *buf, int length,
	48	char str, float floatval,
1baf30f5	49	char temp_unit, int digits, int flag)
ecaa89af AJ	50	{
	51	char c, *p = str;
	52	int i, ret;
	53
1baf30f5 AJ	54	*digits = INT_MIN;
1baf30f5 AJ	55
ecaa89af AJ	56	if (buf[0] & flag)
	57	*p++ = '-';
	58	for (i = 0; i < length; i++) {
1baf30f5	59	if (i && i < 5 && buf[i+1] & 0x01) {
ecaa89af	60	*p++ = '.';
1baf30f5 AJ	61	*digits = 0;
1baf30f5 AJ	62	}
ecaa89af AJ	63	c = char_map[buf[i+1] >> 1];
	64	if (i == 5 && (c == 'C' \|\| c == 'F'))
	65	*temp_unit = c;
1baf30f5	66	else if (c) {
ecaa89af	67	*p++ = c;
1baf30f5 AJ	68	(*digits)++;
1baf30f5 AJ	69	}
ecaa89af AJ	70	}
	71	*p = 0;
	72
1baf30f5 AJ	73	if (*digits < 0)
	74	*digits = 0;
	75
ecaa89af AJ	76	if ((ret = sr_atof_ascii(str, floatval))) {
	77	sr_dbg("invalid float string: '%s'", str);
	78	return ret;
	79	}
	80
	81	return SR_OK;
	82	}
	83
	84	static void brymen_bm86x_parse(unsigned char buf, float floatval,
a46f869b	85	struct sr_datafeed_analog *analog)
ecaa89af AJ	86	{
ecaa89af AJ	87	char str[16], temp_unit;
1baf30f5	88	int ret1, ret2, digits[2], over_limit;
ecaa89af AJ	89
ecaa89af AJ	90	ret1 = brymen_bm86x_parse_digits(buf+2, 6, str, &floatval[0],
1baf30f5	91	&temp_unit, &digits[0], 0x80);
ecaa89af AJ	92	over_limit = strstr(str, "0L") \|\| strstr(str, "0.L");
ecaa89af AJ	93	ret2 = brymen_bm86x_parse_digits(buf+9, 4, str, &floatval[1],
1baf30f5	94	&temp_unit, &digits[1], 0x10);
ecaa89af AJ	95
	96	/* main display */
	97	if (ret1 == SR_OK \|\| over_limit) {
	98	/* SI unit */
	99	if (buf[8] & 0x01) {
a46f869b UH	100	analog[0].meaning->mq = SR_MQ_VOLTAGE;
a46f869b UH	101	analog[0].meaning->unit = SR_UNIT_VOLT;
64aa214a	102	if (!strcmp(str, "diod")) {
a46f869b	103	analog[0].meaning->mqflags \|= SR_MQFLAG_DIODE;
64aa214a GS	104	analog[0].meaning->mqflags \|= SR_MQFLAG_DC;
64aa214a GS	105	}
ecaa89af	106	} else if (buf[14] & 0x80) {
a46f869b UH	107	analog[0].meaning->mq = SR_MQ_CURRENT;
a46f869b UH	108	analog[0].meaning->unit = SR_UNIT_AMPERE;
ecaa89af	109	} else if (buf[14] & 0x20) {
a46f869b UH	110	analog[0].meaning->mq = SR_MQ_CAPACITANCE;
a46f869b UH	111	analog[0].meaning->unit = SR_UNIT_FARAD;
ecaa89af	112	} else if (buf[14] & 0x10) {
a46f869b UH	113	analog[0].meaning->mq = SR_MQ_CONDUCTANCE;
a46f869b UH	114	analog[0].meaning->unit = SR_UNIT_SIEMENS;
ecaa89af	115	} else if (buf[15] & 0x01) {
a46f869b UH	116	analog[0].meaning->mq = SR_MQ_FREQUENCY;
a46f869b UH	117	analog[0].meaning->unit = SR_UNIT_HERTZ;
ecaa89af	118	} else if (buf[10] & 0x01) {
a46f869b UH	119	analog[0].meaning->mq = SR_MQ_CONTINUITY;
a46f869b UH	120	analog[0].meaning->unit = SR_UNIT_OHM;
ecaa89af	121	} else if (buf[15] & 0x10) {
a46f869b UH	122	analog[0].meaning->mq = SR_MQ_RESISTANCE;
a46f869b UH	123	analog[0].meaning->unit = SR_UNIT_OHM;
ecaa89af	124	} else if (buf[15] & 0x02) {
a46f869b UH	125	analog[0].meaning->mq = SR_MQ_POWER;
a46f869b UH	126	analog[0].meaning->unit = SR_UNIT_DECIBEL_MW;
ecaa89af	127	} else if (buf[15] & 0x80) {
a46f869b UH	128	analog[0].meaning->mq = SR_MQ_DUTY_CYCLE;
a46f869b UH	129	analog[0].meaning->unit = SR_UNIT_PERCENTAGE;
ecaa89af	130	} else if (buf[ 2] & 0x0A) {
a46f869b	131	analog[0].meaning->mq = SR_MQ_TEMPERATURE;
ecaa89af	132	if (temp_unit == 'F')
a46f869b	133	analog[0].meaning->unit = SR_UNIT_FAHRENHEIT;
ecaa89af	134	else
a46f869b	135	analog[0].meaning->unit = SR_UNIT_CELSIUS;
ecaa89af AJ	136	}
	137
	138	/* when MIN MAX and AVG are displayed at the same time, remove them */
	139	if ((buf[1] & 0xE0) == 0xE0)
	140	buf[1] &= ~0xE0;
	141
	142	/* AC/DC/Auto flags */
a46f869b UH	143	if (buf[1] & 0x10) analog[0].meaning->mqflags \|= SR_MQFLAG_DC;
	144	if (buf[2] & 0x01) analog[0].meaning->mqflags \|= SR_MQFLAG_AC;
	145	if (buf[1] & 0x01) analog[0].meaning->mqflags \|= SR_MQFLAG_AUTORANGE;
	146	if (buf[1] & 0x08) analog[0].meaning->mqflags \|= SR_MQFLAG_HOLD;
	147	if (buf[1] & 0x20) analog[0].meaning->mqflags \|= SR_MQFLAG_MAX;
	148	if (buf[1] & 0x40) analog[0].meaning->mqflags \|= SR_MQFLAG_MIN;
	149	if (buf[1] & 0x80) analog[0].meaning->mqflags \|= SR_MQFLAG_AVG;
	150	if (buf[3] & 0x01) analog[0].meaning->mqflags \|= SR_MQFLAG_RELATIVE;
ecaa89af AJ	151
	152	/* when dBm is displayed, remove the m suffix so that it is
	153	not considered as the 10e-3 SI prefix */
	154	if (buf[15] & 0x02)
	155	buf[15] &= ~0x04;
	156
	157	/* SI prefix */
d9251a2c UH	158	if (buf[14] & 0x40) { floatval[0] = 1e-9; digits[0] += 9; } / n */
	159	if (buf[15] & 0x08) { floatval[0] = 1e-6; digits[0] += 6; } / µ */
	160	if (buf[15] & 0x04) { floatval[0] = 1e-3; digits[0] += 3; } / m */
	161	if (buf[15] & 0x40) { floatval[0] = 1e3; digits[0] -= 3; } / k */
	162	if (buf[15] & 0x20) { floatval[0] = 1e6; digits[0] -= 6; } / M */
ecaa89af AJ	163
ecaa89af AJ	164	if (over_limit) floatval[0] = INFINITY;
1baf30f5 AJ	165
	166	analog[0].encoding->digits = digits[0];
	167	analog[0].spec->spec_digits = digits[0];
ecaa89af AJ	168	}
	169
	170	/* secondary display */
	171	if (ret2 == SR_OK) {
	172	/* SI unit */
	173	if (buf[14] & 0x08) {
a46f869b UH	174	analog[1].meaning->mq = SR_MQ_VOLTAGE;
a46f869b UH	175	analog[1].meaning->unit = SR_UNIT_VOLT;
ecaa89af	176	} else if (buf[9] & 0x04) {
a46f869b UH	177	analog[1].meaning->mq = SR_MQ_CURRENT;
a46f869b UH	178	analog[1].meaning->unit = SR_UNIT_AMPERE;
af1e487e	179	} else if (buf[9] & 0x08) {
a46f869b UH	180	analog[1].meaning->mq = SR_MQ_CURRENT;
a46f869b UH	181	analog[1].meaning->unit = SR_UNIT_PERCENTAGE;
ecaa89af	182	} else if (buf[14] & 0x04) {
a46f869b UH	183	analog[1].meaning->mq = SR_MQ_FREQUENCY;
a46f869b UH	184	analog[1].meaning->unit = SR_UNIT_HERTZ;
ecaa89af	185	} else if (buf[9] & 0x40) {
a46f869b	186	analog[1].meaning->mq = SR_MQ_TEMPERATURE;
ecaa89af	187	if (temp_unit == 'F')
a46f869b	188	analog[1].meaning->unit = SR_UNIT_FAHRENHEIT;
ecaa89af	189	else
a46f869b	190	analog[1].meaning->unit = SR_UNIT_CELSIUS;
ecaa89af AJ	191	}
	192
	193	/* AC flag */
a46f869b	194	if (buf[9] & 0x20) analog[1].meaning->mqflags \|= SR_MQFLAG_AC;
ecaa89af AJ	195
ecaa89af AJ	196	/* SI prefix */
d9251a2c UH	197	if (buf[ 9] & 0x01) { floatval[1] = 1e-6; digits[1] += 6; } / µ */
	198	if (buf[ 9] & 0x02) { floatval[1] = 1e-3; digits[1] += 3; } / m */
	199	if (buf[14] & 0x02) { floatval[1] = 1e3; digits[1] -= 3; } / k */
	200	if (buf[14] & 0x01) { floatval[1] = 1e6; digits[1] -= 6; } / M */
1baf30f5 AJ	201
	202	analog[1].encoding->digits = digits[1];
	203	analog[1].spec->spec_digits = digits[1];
ecaa89af AJ	204	}
	205
	206	if (buf[9] & 0x80)
	207	sr_spew("Battery is low.");
	208	}
	209
	210	static void brymen_bm86x_handle_packet(const struct sr_dev_inst *sdi,
	211	unsigned char *buf)
	212	{
	213	struct dev_context *devc;
	214	struct sr_datafeed_packet packet;
a46f869b UH	215	struct sr_datafeed_analog analog[2];
	216	struct sr_analog_encoding encoding[2];
	217	struct sr_analog_meaning meaning[2];
	218	struct sr_analog_spec spec[2];
5753d2e8 GS	219	struct sr_channel *channel;
5753d2e8 GS	220	int sent_ch1, sent_ch2;
ecaa89af AJ	221	float floatval[2];
	222
	223	devc = sdi->priv;
	224
869c8375	225	/* Note: digits/spec_digits will be overridden later. */
a46f869b UH	226	sr_analog_init(&analog[0], &encoding[0], &meaning[0], &spec[0], 0);
a46f869b UH	227	sr_analog_init(&analog[1], &encoding[1], &meaning[1], &spec[1], 0);
ecaa89af	228
ecaa89af	229	brymen_bm86x_parse(buf, floatval, analog);
5753d2e8	230	sent_ch1 = sent_ch2 = 0;
ecaa89af	231
5753d2e8 GS	232	channel = sdi->channels->data;
5753d2e8 GS	233	if (analog[0].meaning->mq != 0 && channel->enabled) {
ecaa89af	234	/* Got a measurement. */
5753d2e8	235	sent_ch1 = 1;
ecaa89af AJ	236	analog[0].num_samples = 1;
ecaa89af AJ	237	analog[0].data = &floatval[0];
5753d2e8	238	analog[0].meaning->channels = g_slist_append(NULL, channel);
a46f869b	239	packet.type = SR_DF_ANALOG;
ecaa89af	240	packet.payload = &analog[0];
102f1239	241	sr_session_send(sdi, &packet);
a46f869b	242	g_slist_free(analog[0].meaning->channels);
ecaa89af AJ	243	}
ecaa89af AJ	244
5753d2e8 GS	245	channel = sdi->channels->next->data;
5753d2e8 GS	246	if (analog[1].meaning->mq != 0 && channel->enabled) {
ecaa89af	247	/* Got a measurement. */
5753d2e8	248	sent_ch2 = 1;
ecaa89af AJ	249	analog[1].num_samples = 1;
ecaa89af AJ	250	analog[1].data = &floatval[1];
5753d2e8	251	analog[1].meaning->channels = g_slist_append(NULL, channel);
a46f869b	252	packet.type = SR_DF_ANALOG;
ecaa89af	253	packet.payload = &analog[1];
102f1239	254	sr_session_send(sdi, &packet);
a46f869b	255	g_slist_free(analog[1].meaning->channels);
ecaa89af AJ	256	}
ecaa89af AJ	257
5753d2e8	258	if (sent_ch1 \|\| sent_ch2)
ab939ebb	259	sr_sw_limits_update_samples_read(&devc->sw_limits, 1);
ecaa89af AJ	260	}
	261
	262	static int brymen_bm86x_send_command(const struct sr_dev_inst *sdi)
	263	{
	264	struct sr_usb_dev_inst *usb;
	265	unsigned char buf[] = { 0x00, 0x86, 0x66 };
	266	int ret;
	267
	268	usb = sdi->conn;
	269
	270	sr_dbg("Sending HID set report.");
	271	ret = libusb_control_transfer(usb->devhdl,
d9251a2c	272	LIBUSB_REQUEST_TYPE_CLASS \|
ecaa89af AJ	273	LIBUSB_RECIPIENT_INTERFACE \|
	274	LIBUSB_ENDPOINT_OUT,
	275	9, /* bRequest: HID set_report */
	276	0x300, /* wValue: HID feature, report num 0 */
	277	0, /* wIndex: interface 0 */
	278	buf, sizeof(buf), USB_TIMEOUT);
	279
	280	if (ret < 0) {
	281	sr_err("HID feature report error: %s.", libusb_error_name(ret));
	282	return SR_ERR;
	283	}
	284
	285	if (ret != sizeof(buf)) {
0c536bcd	286	sr_err("Short packet: sent %d/%zu bytes.", ret, sizeof(buf));
ecaa89af AJ	287	return SR_ERR;
	288	}
	289
	290	return SR_OK;
	291	}
	292
	293	static int brymen_bm86x_read_interrupt(const struct sr_dev_inst *sdi)
	294	{
	295	struct dev_context *devc;
	296	struct sr_usb_dev_inst *usb;
	297	unsigned char buf[24];
	298	int ret, transferred;
	299
	300	devc = sdi->priv;
	301	usb = sdi->conn;
	302
	303	sr_dbg("Reading HID interrupt report.");
	304	/* Get data from EP1 using an interrupt transfer. */
	305	ret = libusb_interrupt_transfer(usb->devhdl,
	306	LIBUSB_ENDPOINT_IN \| 1, /* EP1, IN */
	307	buf, sizeof(buf),
	308	&transferred, USB_TIMEOUT);
	309
	310	if (ret == LIBUSB_ERROR_TIMEOUT) {
	311	if (++devc->interrupt_pending > 3)
	312	devc->interrupt_pending = 0;
	313	return SR_OK;
	314	}
	315
	316	if (ret < 0) {
	317	sr_err("USB receive error: %s.", libusb_error_name(ret));
	318	return SR_ERR;
	319	}
	320
	321	if (transferred != sizeof(buf)) {
6433156c	322	sr_err("Short packet: received %d/%zu bytes.", transferred, sizeof(buf));
ecaa89af AJ	323	return SR_ERR;
	324	}
	325
	326	devc->interrupt_pending = 0;
	327	brymen_bm86x_handle_packet(sdi, buf);
	328
	329	return SR_OK;
	330	}
	331
8d9c8554 AJ	332	SR_PRIV int brymen_bm86x_receive_data(int fd, int revents, void *cb_data)
8d9c8554 AJ	333	{
ecaa89af	334	struct sr_dev_inst *sdi;
8d9c8554 AJ	335	struct dev_context *devc;
	336
	337	(void)fd;
ecaa89af	338	(void)revents;
8d9c8554 AJ	339
	340	if (!(sdi = cb_data))
	341	return TRUE;
	342
	343	if (!(devc = sdi->priv))
	344	return TRUE;
	345
ecaa89af AJ	346	if (!devc->interrupt_pending) {
	347	if (brymen_bm86x_send_command(sdi))
	348	return FALSE;
	349	devc->interrupt_pending = 1;
	350	}
	351
	352	if (brymen_bm86x_read_interrupt(sdi))
	353	return FALSE;
	354
ab939ebb	355	if (sr_sw_limits_check(&devc->sw_limits))
d2f7c417	356	sr_dev_acquisition_stop(sdi);
8d9c8554 AJ	357
	358	return TRUE;
	359	}