From: Uwe Hermann Date: Sat, 10 Nov 2012 12:32:46 +0000 (+0100) Subject: radioshack-dmm: Use new file naming conventions. X-Git-Tag: dsupstream~571 X-Git-Url: https://sigrok.org/gitaction?a=commitdiff_plain;h=936e27f19712572d5a1c506dc0ef59aad8743fc4;p=libsigrok.git radioshack-dmm: Use new file naming conventions. --- diff --git a/hardware/radioshack-dmm/Makefile.am b/hardware/radioshack-dmm/Makefile.am index 99091aa1..cbccb88b 100644 --- a/hardware/radioshack-dmm/Makefile.am +++ b/hardware/radioshack-dmm/Makefile.am @@ -25,8 +25,8 @@ noinst_LTLIBRARIES = libsigrokhwradioshackdmm.la libsigrokhwradioshackdmm_la_SOURCES = \ api.c \ - radioshack.c \ - radioshack-dmm.h + protocol.c \ + protocol.h libsigrokhwradioshackdmm_la_CFLAGS = \ -I$(top_srcdir) diff --git a/hardware/radioshack-dmm/api.c b/hardware/radioshack-dmm/api.c index a920d3a9..7a6f0339 100644 --- a/hardware/radioshack-dmm/api.c +++ b/hardware/radioshack-dmm/api.c @@ -26,7 +26,7 @@ #include #include "libsigrok.h" #include "libsigrok-internal.h" -#include "radioshack-dmm.h" +#include "protocol.h" static const int hwopts[] = { SR_HWOPT_CONN, diff --git a/hardware/radioshack-dmm/protocol.c b/hardware/radioshack-dmm/protocol.c new file mode 100644 index 00000000..96342cec --- /dev/null +++ b/hardware/radioshack-dmm/protocol.c @@ -0,0 +1,476 @@ +/* + * This file is part of the sigrok project. + * + * Copyright (C) 2012 Bert Vermeulen + * Copyright (C) 2012 Alexandru Gagniuc + * + * 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 . + */ + +#include +#include +#include +#include +#include +#include "libsigrok.h" +#include "libsigrok-internal.h" +#include "protocol.h" + +/* Byte 1 of the packet, and the modes it represents */ +#define IND1_HZ 0x80 +#define IND1_OHM 0x40 +#define IND1_KILO 0x20 +#define IND1_MEGA 0x10 +#define IND1_FARAD 0x08 +#define IND1_AMP 0x04 +#define IND1_VOLT 0x02 +#define IND1_MILI 0x01 +/* Byte 2 of the packet, and the modes it represents */ +#define IND2_MICRO 0x80 +#define IND2_NANO 0x40 +#define IND2_DBM 0x20 +#define IND2_SEC 0x10 +#define IND2_DUTY 0x08 +#define IND2_HFE 0x04 +#define IND2_REL 0x02 +#define IND2_MIN 0x01 +/* Byte 7 of the packet, and the modes it represents */ +#define INFO_BEEP 0x80 +#define INFO_DIODE 0x30 +#define INFO_BAT 0x20 +#define INFO_HOLD 0x10 +#define INFO_NEG 0x08 +#define INFO_AC 0x04 +#define INFO_RS232 0x02 +#define INFO_AUTO 0x01 +/* Instead of a decimal point, digit 4 carries the MAX flag */ +#define DIG4_MAX 0x08 +/* Mask to remove the decimal point from a digit */ +#define DP_MASK 0x08 + +/* What the LCD values represent */ +#define LCD_0 0xd7 +#define LCD_1 0x50 +#define LCD_2 0xb5 +#define LCD_3 0xf1 +#define LCD_4 0x72 +#define LCD_5 0xe3 +#define LCD_6 0xe7 +#define LCD_7 0x51 +#define LCD_8 0xf7 +#define LCD_9 0xf3 + +#define LCD_C 0x87 +#define LCD_E +#define LCD_F +#define LCD_h 0x66 +#define LCD_H 0x76 +#define LCD_I +#define LCD_n +#define LCD_P 0x37 +#define LCD_r + +enum { + MODE_DC_V = 0, + MODE_AC_V = 1, + MODE_DC_UA = 2, + MODE_DC_MA = 3, + MODE_DC_A = 4, + MODE_AC_UA = 5, + MODE_AC_MA = 6, + MODE_AC_A = 7, + MODE_OHM = 8, + MODE_FARAD = 9, + MODE_HZ = 10, + MODE_VOLT_HZ = 11, + MODE_AMP_HZ = 12, + MODE_DUTY = 13, + MODE_VOLT_DUTY = 14, + MODE_AMP_DUTY = 15, + MODE_WIDTH = 16, + MODE_VOLT_WIDTH = 17, + MODE_AMP_WIDTH = 18, + MODE_DIODE = 19, + MODE_CONT = 20, + MODE_HFE = 21, + MODE_LOGIC = 22, + MODE_DBM = 23, + // MODE_EF = 24, + MODE_TEMP = 25, + MODE_INVALID = 26, +}; + +enum { + READ_ALL, + READ_TEMP, +}; + +static gboolean checksum_valid(const struct rs_22_812_packet *rs_packet) +{ + uint8_t *raw; + uint8_t sum = 0; + int i; + + raw = (void *)rs_packet; + + for (i = 0; i < RS_22_812_PACKET_SIZE - 1; i++) + sum += raw[i]; + + /* This is just a funky constant added to the checksum. */ + sum += 57; + sum -= rs_packet->checksum; + return (sum == 0); +} + +static gboolean selection_good(const struct rs_22_812_packet *rs_packet) +{ + int count; + + /* Does the packet have more than one multiplier ? */ + count = 0; + count += (rs_packet->indicatrix1 & IND1_KILO) ? 1 : 0; + count += (rs_packet->indicatrix1 & IND1_MEGA) ? 1 : 0; + count += (rs_packet->indicatrix1 & IND1_MILI) ? 1 : 0; + count += (rs_packet->indicatrix2 & IND2_MICRO) ? 1 : 0; + count += (rs_packet->indicatrix2 & IND2_NANO) ? 1 : 0; + if (count > 1) { + sr_err("More than one multiplier detected in packet."); + return FALSE; + } + + /* Does the packet "measure" more than one type of value? */ + count = 0; + count += (rs_packet->indicatrix1 & IND1_HZ) ? 1 : 0; + count += (rs_packet->indicatrix1 & IND1_OHM) ? 1 : 0; + count += (rs_packet->indicatrix1 & IND1_FARAD) ? 1 : 0; + count += (rs_packet->indicatrix1 & IND1_AMP) ? 1 : 0; + count += (rs_packet->indicatrix1 & IND1_VOLT) ? 1 : 0; + count += (rs_packet->indicatrix2 & IND2_DBM) ? 1 : 0; + count += (rs_packet->indicatrix2 & IND2_SEC) ? 1 : 0; + count += (rs_packet->indicatrix2 & IND2_DUTY) ? 1 : 0; + count += (rs_packet->indicatrix2 & IND2_HFE) ? 1 : 0; + if (count > 1) { + sr_err("More than one measurement type detected in packet."); + return FALSE; + } + + return TRUE; +} + +/* + * Since the 22-812 does not identify itself in any way, shape, or form, + * we really don't know for sure who is sending the data. We must use every + * possible check to filter out bad packets, especially since detection of the + * 22-812 depends on how well we can filter the packets. + */ +SR_PRIV gboolean rs_22_812_packet_valid(const struct rs_22_812_packet *rs_packet) +{ + if (!checksum_valid(rs_packet)) + return FALSE; + + if (!(rs_packet->mode < MODE_INVALID)) + return FALSE; + + if (!selection_good(rs_packet)) + return FALSE; + + return TRUE; +} + +static uint8_t decode_digit(uint8_t raw_digit) +{ + /* Take out the decimal point, so we can use a simple switch(). */ + raw_digit &= ~DP_MASK; + + switch (raw_digit) { + case 0x00: + case LCD_0: + return 0; + case LCD_1: + return 1; + case LCD_2: + return 2; + case LCD_3: + return 3; + case LCD_4: + return 4; + case LCD_5: + return 5; + case LCD_6: + return 6; + case LCD_7: + return 7; + case LCD_8: + return 8; + case LCD_9: + return 9; + default: + sr_err("Invalid digit byte: 0x%02x.", raw_digit); + return 0xff; + } +} + +static double lcd_to_double(const struct rs_22_812_packet *rs_packet, int type) +{ + double rawval, multiplier = 1; + uint8_t digit, raw_digit; + gboolean dp_reached = FALSE; + int i, end; + + /* end = 1: Don't parse last digit. end = 0: Parse all digits. */ + end = (type == READ_TEMP) ? 1 : 0; + + /* We have 4 digits, and we start from the most significant. */ + for (i = 3; i >= end; i--) { + raw_digit = *(&(rs_packet->digit4) + i); + digit = decode_digit(raw_digit); + if (digit == 0xff) { + rawval = NAN; + break; + } + /* + * Digit 1 does not have a decimal point. Instead, the decimal + * point is used to indicate MAX, so we must avoid testing it. + */ + if ((i < 3) && (raw_digit & DP_MASK)) + dp_reached = TRUE; + if (dp_reached) + multiplier /= 10; + rawval = rawval * 10 + digit; + } + rawval *= multiplier; + if (rs_packet->info & INFO_NEG) + rawval *= -1; + + /* See if we need to multiply our raw value by anything. */ + if (rs_packet->indicatrix1 & IND2_NANO) { + rawval *= 1E-9; + } else if (rs_packet->indicatrix2 & IND2_MICRO) { + rawval *= 1E-6; + } else if (rs_packet->indicatrix1 & IND1_MILI) { + rawval *= 1E-3; + } else if (rs_packet->indicatrix1 & IND1_KILO) { + rawval *= 1E3; + } else if (rs_packet->indicatrix1 & IND1_MEGA) { + rawval *= 1E6; + } + + return rawval; +} + +static gboolean is_celsius(struct rs_22_812_packet *rs_packet) +{ + return ((rs_packet->digit4 & ~DP_MASK) == LCD_C); +} + +static gboolean is_shortcirc(struct rs_22_812_packet *rs_packet) +{ + return ((rs_packet->digit2 & ~DP_MASK) == LCD_h); +} + +static gboolean is_logic_high(struct rs_22_812_packet *rs_packet) +{ + sr_spew("Digit 2: 0x%02x.", rs_packet->digit2 & ~DP_MASK); + return ((rs_packet->digit2 & ~DP_MASK) == LCD_H); +} + +static void handle_packet(struct rs_22_812_packet *rs_packet, + struct dev_context *devc) +{ + double rawval; + struct sr_datafeed_packet packet; + struct sr_datafeed_analog *analog; + + rawval = lcd_to_double(rs_packet, READ_ALL); + + /* TODO: Check malloc return value. */ + analog = g_try_malloc0(sizeof(struct sr_datafeed_analog)); + analog->num_samples = 1; + /* TODO: Check malloc return value. */ + analog->data = g_try_malloc(sizeof(float)); + *analog->data = (float)rawval; + analog->mq = -1; + + switch (rs_packet->mode) { + case MODE_DC_V: + analog->mq = SR_MQ_VOLTAGE; + analog->unit = SR_UNIT_VOLT; + analog->mqflags |= SR_MQFLAG_DC; + break; + case MODE_AC_V: + analog->mq = SR_MQ_VOLTAGE; + analog->unit = SR_UNIT_VOLT; + analog->mqflags |= SR_MQFLAG_AC; + break; + case MODE_DC_UA: + case MODE_DC_MA: + case MODE_DC_A: + analog->mq = SR_MQ_CURRENT; + analog->unit = SR_UNIT_AMPERE; + analog->mqflags |= SR_MQFLAG_DC; + break; + case MODE_AC_UA: + case MODE_AC_MA: + case MODE_AC_A: + analog->mq = SR_MQ_CURRENT; + analog->unit = SR_UNIT_AMPERE; + analog->mqflags |= SR_MQFLAG_AC; + break; + case MODE_OHM: + analog->mq = SR_MQ_RESISTANCE; + analog->unit = SR_UNIT_OHM; + break; + case MODE_FARAD: + analog->mq = SR_MQ_CAPACITANCE; + analog->unit = SR_UNIT_FARAD; + break; + case MODE_CONT: + analog->mq = SR_MQ_CONTINUITY; + analog->unit = SR_UNIT_BOOLEAN; + *analog->data = is_shortcirc(rs_packet); + break; + case MODE_DIODE: + analog->mq = SR_MQ_VOLTAGE; + analog->unit = SR_UNIT_VOLT; + analog->mqflags |= SR_MQFLAG_DIODE | SR_MQFLAG_DC; + break; + case MODE_HZ: + case MODE_VOLT_HZ: + case MODE_AMP_HZ: + analog->mq = SR_MQ_FREQUENCY; + analog->unit = SR_UNIT_HERTZ; + break; + case MODE_LOGIC: + /* + * No matter whether or not we have an actual voltage reading, + * we are measuring voltage, so we set our MQ as VOLTAGE. + */ + analog->mq = SR_MQ_VOLTAGE; + if (!isnan(rawval)) { + /* We have an actual voltage. */ + analog->unit = SR_UNIT_VOLT; + } else { + /* We have either HI or LOW. */ + analog->unit = SR_UNIT_BOOLEAN; + *analog->data = is_logic_high(rs_packet); + } + break; + case MODE_HFE: + analog->mq = SR_MQ_GAIN; + analog->unit = SR_UNIT_UNITLESS; + break; + case MODE_DUTY: + case MODE_VOLT_DUTY: + case MODE_AMP_DUTY: + analog->mq = SR_MQ_DUTY_CYCLE; + analog->unit = SR_UNIT_PERCENTAGE; + break; + case MODE_WIDTH: + case MODE_VOLT_WIDTH: + case MODE_AMP_WIDTH: + analog->mq = SR_MQ_PULSE_WIDTH; + analog->unit = SR_UNIT_SECOND; + case MODE_TEMP: + analog->mq = SR_MQ_TEMPERATURE; + /* We need to reparse. */ + *analog->data = lcd_to_double(rs_packet, READ_TEMP); + analog->unit = is_celsius(rs_packet) ? + SR_UNIT_CELSIUS : SR_UNIT_FAHRENHEIT; + break; + case MODE_DBM: + analog->mq = SR_MQ_POWER; + analog->unit = SR_UNIT_DECIBEL_MW; + analog->mqflags |= SR_MQFLAG_AC; + break; + default: + sr_err("Unknown mode: %d.", rs_packet->mode); + break; + } + + if (rs_packet->info & INFO_HOLD) + analog->mqflags |= SR_MQFLAG_HOLD; + if (rs_packet->digit4 & DIG4_MAX) + analog->mqflags |= SR_MQFLAG_MAX; + if (rs_packet->indicatrix2 & IND2_MIN) + analog->mqflags |= SR_MQFLAG_MIN; + if (rs_packet->info & INFO_AUTO) + analog->mqflags |= SR_MQFLAG_AUTORANGE; + + if (analog->mq != -1) { + /* Got a measurement. */ + sr_spew("Value: %f.", rawval); + packet.type = SR_DF_ANALOG; + packet.payload = analog; + sr_session_send(devc->cb_data, &packet); + devc->num_samples++; + } + g_free(analog->data); + g_free(analog); +} + +static void handle_new_data(struct dev_context *devc, int fd) +{ + int len; + size_t i, offset = 0; + struct rs_22_812_packet *rs_packet; + + /* Try to get as much data as the buffer can hold. */ + len = RS_DMM_BUFSIZE - devc->buflen; + len = serial_read(fd, devc->buf + devc->buflen, len); + if (len < 1) { + sr_err("Serial port read error."); + return; + } + devc->buflen += len; + + /* Now look for packets in that data. */ + while ((devc->buflen - offset) >= RS_22_812_PACKET_SIZE) { + rs_packet = (void *)(devc->buf + offset); + if (rs_22_812_packet_valid(rs_packet)) { + handle_packet(rs_packet, devc); + offset += RS_22_812_PACKET_SIZE; + } else { + offset++; + } + } + + /* If we have any data left, move it to the beginning of our buffer. */ + for (i = 0; i < devc->buflen - offset; i++) + devc->buf[i] = devc->buf[offset + i]; + devc->buflen -= offset; +} + +SR_PRIV int radioshack_dmm_receive_data(int fd, int revents, void *cb_data) +{ + struct sr_dev_inst *sdi; + struct dev_context *devc; + + if (!(sdi = cb_data)) + return TRUE; + + if (!(devc = sdi->priv)) + return TRUE; + + if (revents == G_IO_IN) { + /* Serial data arrived. */ + handle_new_data(devc, fd); + } + + if (devc->num_samples >= devc->limit_samples) { + sdi->driver->dev_acquisition_stop(sdi, cb_data); + return TRUE; + } + + return TRUE; +} diff --git a/hardware/radioshack-dmm/protocol.h b/hardware/radioshack-dmm/protocol.h new file mode 100644 index 00000000..833cc458 --- /dev/null +++ b/hardware/radioshack-dmm/protocol.h @@ -0,0 +1,68 @@ +/* + * This file is part of the sigrok project. + * + * Copyright (C) 2012 Bert Vermeulen + * Copyright (C) 2012 Alexandru Gagniuc + * + * 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 . + */ + +#ifndef LIBSIGROK_HARDWARE_RADIOSHACK_DMM_PROTOCOL_H +#define LIBSIGROK_HARDWARE_RADIOSHACK_DMM_PROTOCOL_H + +/* Message logging helpers with driver-specific prefix string. */ +#define DRIVER_LOG_DOMAIN "radioshack-dmm: " +#define sr_log(l, s, args...) sr_log(l, DRIVER_LOG_DOMAIN s, ## args) +#define sr_spew(s, args...) sr_spew(DRIVER_LOG_DOMAIN s, ## args) +#define sr_dbg(s, args...) sr_dbg(DRIVER_LOG_DOMAIN s, ## args) +#define sr_info(s, args...) sr_info(DRIVER_LOG_DOMAIN s, ## args) +#define sr_warn(s, args...) sr_warn(DRIVER_LOG_DOMAIN s, ## args) +#define sr_err(s, args...) sr_err(DRIVER_LOG_DOMAIN s, ## args) + +#define RS_DMM_BUFSIZE 256 + +#define RS_22_812_PACKET_SIZE 9 + +struct rs_22_812_packet { + uint8_t mode; + uint8_t indicatrix1; + uint8_t indicatrix2; + uint8_t digit4; + uint8_t digit3; + uint8_t digit2; + uint8_t digit1; + uint8_t info; + uint8_t checksum; +}; + +/* Private, per-device-instance driver context. */ +struct dev_context { + uint64_t limit_samples; + struct sr_serial_dev_inst *serial; + char *serialcomm; + + /* Opaque pointer passed in by the frontend. */ + void *cb_data; + + /* Runtime. */ + uint64_t num_samples; + uint8_t buf[RS_DMM_BUFSIZE]; + size_t bufoffset; + size_t buflen; +}; + +SR_PRIV int radioshack_dmm_receive_data(int fd, int revents, void *cb_data); +SR_PRIV gboolean rs_22_812_packet_valid(const struct rs_22_812_packet *rs_packet); + +#endif diff --git a/hardware/radioshack-dmm/radioshack-dmm.h b/hardware/radioshack-dmm/radioshack-dmm.h deleted file mode 100644 index 5d13e7f8..00000000 --- a/hardware/radioshack-dmm/radioshack-dmm.h +++ /dev/null @@ -1,68 +0,0 @@ -/* - * This file is part of the sigrok project. - * - * Copyright (C) 2012 Bert Vermeulen - * Copyright (C) 2012 Alexandru Gagniuc - * - * 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 . - */ - -#ifndef LIBSIGROK_HARDWARE_RADIOSHACK_DMM_RADIOSHACK_DMM_H -#define LIBSIGROK_HARDWARE_RADIOSHACK_DMM_RADIOSHACK_DMM_H - -/* Message logging helpers with driver-specific prefix string. */ -#define DRIVER_LOG_DOMAIN "radioshack-dmm: " -#define sr_log(l, s, args...) sr_log(l, DRIVER_LOG_DOMAIN s, ## args) -#define sr_spew(s, args...) sr_spew(DRIVER_LOG_DOMAIN s, ## args) -#define sr_dbg(s, args...) sr_dbg(DRIVER_LOG_DOMAIN s, ## args) -#define sr_info(s, args...) sr_info(DRIVER_LOG_DOMAIN s, ## args) -#define sr_warn(s, args...) sr_warn(DRIVER_LOG_DOMAIN s, ## args) -#define sr_err(s, args...) sr_err(DRIVER_LOG_DOMAIN s, ## args) - -#define RS_DMM_BUFSIZE 256 - -#define RS_22_812_PACKET_SIZE 9 - -struct rs_22_812_packet { - uint8_t mode; - uint8_t indicatrix1; - uint8_t indicatrix2; - uint8_t digit4; - uint8_t digit3; - uint8_t digit2; - uint8_t digit1; - uint8_t info; - uint8_t checksum; -}; - -/* Private, per-device-instance driver context. */ -struct dev_context { - uint64_t limit_samples; - struct sr_serial_dev_inst *serial; - char *serialcomm; - - /* Opaque pointer passed in by the frontend. */ - void *cb_data; - - /* Runtime. */ - uint64_t num_samples; - uint8_t buf[RS_DMM_BUFSIZE]; - size_t bufoffset; - size_t buflen; -}; - -SR_PRIV int radioshack_dmm_receive_data(int fd, int revents, void *cb_data); -SR_PRIV gboolean rs_22_812_packet_valid(const struct rs_22_812_packet *rs_packet); - -#endif diff --git a/hardware/radioshack-dmm/radioshack.c b/hardware/radioshack-dmm/radioshack.c deleted file mode 100644 index cb77339c..00000000 --- a/hardware/radioshack-dmm/radioshack.c +++ /dev/null @@ -1,476 +0,0 @@ -/* - * This file is part of the sigrok project. - * - * Copyright (C) 2012 Bert Vermeulen - * Copyright (C) 2012 Alexandru Gagniuc - * - * 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 . - */ - -#include -#include -#include -#include -#include -#include "libsigrok.h" -#include "libsigrok-internal.h" -#include "radioshack-dmm.h" - -/* Byte 1 of the packet, and the modes it represents */ -#define IND1_HZ 0x80 -#define IND1_OHM 0x40 -#define IND1_KILO 0x20 -#define IND1_MEGA 0x10 -#define IND1_FARAD 0x08 -#define IND1_AMP 0x04 -#define IND1_VOLT 0x02 -#define IND1_MILI 0x01 -/* Byte 2 of the packet, and the modes it represents */ -#define IND2_MICRO 0x80 -#define IND2_NANO 0x40 -#define IND2_DBM 0x20 -#define IND2_SEC 0x10 -#define IND2_DUTY 0x08 -#define IND2_HFE 0x04 -#define IND2_REL 0x02 -#define IND2_MIN 0x01 -/* Byte 7 of the packet, and the modes it represents */ -#define INFO_BEEP 0x80 -#define INFO_DIODE 0x30 -#define INFO_BAT 0x20 -#define INFO_HOLD 0x10 -#define INFO_NEG 0x08 -#define INFO_AC 0x04 -#define INFO_RS232 0x02 -#define INFO_AUTO 0x01 -/* Instead of a decimal point, digit 4 carries the MAX flag */ -#define DIG4_MAX 0x08 -/* Mask to remove the decimal point from a digit */ -#define DP_MASK 0x08 - -/* What the LCD values represent */ -#define LCD_0 0xd7 -#define LCD_1 0x50 -#define LCD_2 0xb5 -#define LCD_3 0xf1 -#define LCD_4 0x72 -#define LCD_5 0xe3 -#define LCD_6 0xe7 -#define LCD_7 0x51 -#define LCD_8 0xf7 -#define LCD_9 0xf3 - -#define LCD_C 0x87 -#define LCD_E -#define LCD_F -#define LCD_h 0x66 -#define LCD_H 0x76 -#define LCD_I -#define LCD_n -#define LCD_P 0x37 -#define LCD_r - -enum { - MODE_DC_V = 0, - MODE_AC_V = 1, - MODE_DC_UA = 2, - MODE_DC_MA = 3, - MODE_DC_A = 4, - MODE_AC_UA = 5, - MODE_AC_MA = 6, - MODE_AC_A = 7, - MODE_OHM = 8, - MODE_FARAD = 9, - MODE_HZ = 10, - MODE_VOLT_HZ = 11, - MODE_AMP_HZ = 12, - MODE_DUTY = 13, - MODE_VOLT_DUTY = 14, - MODE_AMP_DUTY = 15, - MODE_WIDTH = 16, - MODE_VOLT_WIDTH = 17, - MODE_AMP_WIDTH = 18, - MODE_DIODE = 19, - MODE_CONT = 20, - MODE_HFE = 21, - MODE_LOGIC = 22, - MODE_DBM = 23, - // MODE_EF = 24, - MODE_TEMP = 25, - MODE_INVALID = 26, -}; - -enum { - READ_ALL, - READ_TEMP, -}; - -static gboolean checksum_valid(const struct rs_22_812_packet *rs_packet) -{ - uint8_t *raw; - uint8_t sum = 0; - int i; - - raw = (void *)rs_packet; - - for (i = 0; i < RS_22_812_PACKET_SIZE - 1; i++) - sum += raw[i]; - - /* This is just a funky constant added to the checksum. */ - sum += 57; - sum -= rs_packet->checksum; - return (sum == 0); -} - -static gboolean selection_good(const struct rs_22_812_packet *rs_packet) -{ - int count; - - /* Does the packet have more than one multiplier ? */ - count = 0; - count += (rs_packet->indicatrix1 & IND1_KILO) ? 1 : 0; - count += (rs_packet->indicatrix1 & IND1_MEGA) ? 1 : 0; - count += (rs_packet->indicatrix1 & IND1_MILI) ? 1 : 0; - count += (rs_packet->indicatrix2 & IND2_MICRO) ? 1 : 0; - count += (rs_packet->indicatrix2 & IND2_NANO) ? 1 : 0; - if (count > 1) { - sr_err("More than one multiplier detected in packet."); - return FALSE; - } - - /* Does the packet "measure" more than one type of value? */ - count = 0; - count += (rs_packet->indicatrix1 & IND1_HZ) ? 1 : 0; - count += (rs_packet->indicatrix1 & IND1_OHM) ? 1 : 0; - count += (rs_packet->indicatrix1 & IND1_FARAD) ? 1 : 0; - count += (rs_packet->indicatrix1 & IND1_AMP) ? 1 : 0; - count += (rs_packet->indicatrix1 & IND1_VOLT) ? 1 : 0; - count += (rs_packet->indicatrix2 & IND2_DBM) ? 1 : 0; - count += (rs_packet->indicatrix2 & IND2_SEC) ? 1 : 0; - count += (rs_packet->indicatrix2 & IND2_DUTY) ? 1 : 0; - count += (rs_packet->indicatrix2 & IND2_HFE) ? 1 : 0; - if (count > 1) { - sr_err("More than one measurement type detected in packet."); - return FALSE; - } - - return TRUE; -} - -/* - * Since the 22-812 does not identify itself in any way, shape, or form, - * we really don't know for sure who is sending the data. We must use every - * possible check to filter out bad packets, especially since detection of the - * 22-812 depends on how well we can filter the packets. - */ -SR_PRIV gboolean rs_22_812_packet_valid(const struct rs_22_812_packet *rs_packet) -{ - if (!checksum_valid(rs_packet)) - return FALSE; - - if (!(rs_packet->mode < MODE_INVALID)) - return FALSE; - - if (!selection_good(rs_packet)) - return FALSE; - - return TRUE; -} - -static uint8_t decode_digit(uint8_t raw_digit) -{ - /* Take out the decimal point, so we can use a simple switch(). */ - raw_digit &= ~DP_MASK; - - switch (raw_digit) { - case 0x00: - case LCD_0: - return 0; - case LCD_1: - return 1; - case LCD_2: - return 2; - case LCD_3: - return 3; - case LCD_4: - return 4; - case LCD_5: - return 5; - case LCD_6: - return 6; - case LCD_7: - return 7; - case LCD_8: - return 8; - case LCD_9: - return 9; - default: - sr_err("Invalid digit byte: 0x%02x.", raw_digit); - return 0xff; - } -} - -static double lcd_to_double(const struct rs_22_812_packet *rs_packet, int type) -{ - double rawval, multiplier = 1; - uint8_t digit, raw_digit; - gboolean dp_reached = FALSE; - int i, end; - - /* end = 1: Don't parse last digit. end = 0: Parse all digits. */ - end = (type == READ_TEMP) ? 1 : 0; - - /* We have 4 digits, and we start from the most significant. */ - for (i = 3; i >= end; i--) { - raw_digit = *(&(rs_packet->digit4) + i); - digit = decode_digit(raw_digit); - if (digit == 0xff) { - rawval = NAN; - break; - } - /* - * Digit 1 does not have a decimal point. Instead, the decimal - * point is used to indicate MAX, so we must avoid testing it. - */ - if ((i < 3) && (raw_digit & DP_MASK)) - dp_reached = TRUE; - if (dp_reached) - multiplier /= 10; - rawval = rawval * 10 + digit; - } - rawval *= multiplier; - if (rs_packet->info & INFO_NEG) - rawval *= -1; - - /* See if we need to multiply our raw value by anything. */ - if (rs_packet->indicatrix1 & IND2_NANO) { - rawval *= 1E-9; - } else if (rs_packet->indicatrix2 & IND2_MICRO) { - rawval *= 1E-6; - } else if (rs_packet->indicatrix1 & IND1_MILI) { - rawval *= 1E-3; - } else if (rs_packet->indicatrix1 & IND1_KILO) { - rawval *= 1E3; - } else if (rs_packet->indicatrix1 & IND1_MEGA) { - rawval *= 1E6; - } - - return rawval; -} - -static gboolean is_celsius(struct rs_22_812_packet *rs_packet) -{ - return ((rs_packet->digit4 & ~DP_MASK) == LCD_C); -} - -static gboolean is_shortcirc(struct rs_22_812_packet *rs_packet) -{ - return ((rs_packet->digit2 & ~DP_MASK) == LCD_h); -} - -static gboolean is_logic_high(struct rs_22_812_packet *rs_packet) -{ - sr_spew("Digit 2: 0x%02x.", rs_packet->digit2 & ~DP_MASK); - return ((rs_packet->digit2 & ~DP_MASK) == LCD_H); -} - -static void handle_packet(struct rs_22_812_packet *rs_packet, - struct dev_context *devc) -{ - double rawval; - struct sr_datafeed_packet packet; - struct sr_datafeed_analog *analog; - - rawval = lcd_to_double(rs_packet, READ_ALL); - - /* TODO: Check malloc return value. */ - analog = g_try_malloc0(sizeof(struct sr_datafeed_analog)); - analog->num_samples = 1; - /* TODO: Check malloc return value. */ - analog->data = g_try_malloc(sizeof(float)); - *analog->data = (float)rawval; - analog->mq = -1; - - switch (rs_packet->mode) { - case MODE_DC_V: - analog->mq = SR_MQ_VOLTAGE; - analog->unit = SR_UNIT_VOLT; - analog->mqflags |= SR_MQFLAG_DC; - break; - case MODE_AC_V: - analog->mq = SR_MQ_VOLTAGE; - analog->unit = SR_UNIT_VOLT; - analog->mqflags |= SR_MQFLAG_AC; - break; - case MODE_DC_UA: - case MODE_DC_MA: - case MODE_DC_A: - analog->mq = SR_MQ_CURRENT; - analog->unit = SR_UNIT_AMPERE; - analog->mqflags |= SR_MQFLAG_DC; - break; - case MODE_AC_UA: - case MODE_AC_MA: - case MODE_AC_A: - analog->mq = SR_MQ_CURRENT; - analog->unit = SR_UNIT_AMPERE; - analog->mqflags |= SR_MQFLAG_AC; - break; - case MODE_OHM: - analog->mq = SR_MQ_RESISTANCE; - analog->unit = SR_UNIT_OHM; - break; - case MODE_FARAD: - analog->mq = SR_MQ_CAPACITANCE; - analog->unit = SR_UNIT_FARAD; - break; - case MODE_CONT: - analog->mq = SR_MQ_CONTINUITY; - analog->unit = SR_UNIT_BOOLEAN; - *analog->data = is_shortcirc(rs_packet); - break; - case MODE_DIODE: - analog->mq = SR_MQ_VOLTAGE; - analog->unit = SR_UNIT_VOLT; - analog->mqflags |= SR_MQFLAG_DIODE | SR_MQFLAG_DC; - break; - case MODE_HZ: - case MODE_VOLT_HZ: - case MODE_AMP_HZ: - analog->mq = SR_MQ_FREQUENCY; - analog->unit = SR_UNIT_HERTZ; - break; - case MODE_LOGIC: - /* - * No matter whether or not we have an actual voltage reading, - * we are measuring voltage, so we set our MQ as VOLTAGE. - */ - analog->mq = SR_MQ_VOLTAGE; - if (!isnan(rawval)) { - /* We have an actual voltage. */ - analog->unit = SR_UNIT_VOLT; - } else { - /* We have either HI or LOW. */ - analog->unit = SR_UNIT_BOOLEAN; - *analog->data = is_logic_high(rs_packet); - } - break; - case MODE_HFE: - analog->mq = SR_MQ_GAIN; - analog->unit = SR_UNIT_UNITLESS; - break; - case MODE_DUTY: - case MODE_VOLT_DUTY: - case MODE_AMP_DUTY: - analog->mq = SR_MQ_DUTY_CYCLE; - analog->unit = SR_UNIT_PERCENTAGE; - break; - case MODE_WIDTH: - case MODE_VOLT_WIDTH: - case MODE_AMP_WIDTH: - analog->mq = SR_MQ_PULSE_WIDTH; - analog->unit = SR_UNIT_SECOND; - case MODE_TEMP: - analog->mq = SR_MQ_TEMPERATURE; - /* We need to reparse. */ - *analog->data = lcd_to_double(rs_packet, READ_TEMP); - analog->unit = is_celsius(rs_packet) ? - SR_UNIT_CELSIUS : SR_UNIT_FAHRENHEIT; - break; - case MODE_DBM: - analog->mq = SR_MQ_POWER; - analog->unit = SR_UNIT_DECIBEL_MW; - analog->mqflags |= SR_MQFLAG_AC; - break; - default: - sr_err("Unknown mode: %d.", rs_packet->mode); - break; - } - - if (rs_packet->info & INFO_HOLD) - analog->mqflags |= SR_MQFLAG_HOLD; - if (rs_packet->digit4 & DIG4_MAX) - analog->mqflags |= SR_MQFLAG_MAX; - if (rs_packet->indicatrix2 & IND2_MIN) - analog->mqflags |= SR_MQFLAG_MIN; - if (rs_packet->info & INFO_AUTO) - analog->mqflags |= SR_MQFLAG_AUTORANGE; - - if (analog->mq != -1) { - /* Got a measurement. */ - sr_spew("Value: %f.", rawval); - packet.type = SR_DF_ANALOG; - packet.payload = analog; - sr_session_send(devc->cb_data, &packet); - devc->num_samples++; - } - g_free(analog->data); - g_free(analog); -} - -static void handle_new_data(struct dev_context *devc, int fd) -{ - int len; - size_t i, offset = 0; - struct rs_22_812_packet *rs_packet; - - /* Try to get as much data as the buffer can hold. */ - len = RS_DMM_BUFSIZE - devc->buflen; - len = serial_read(fd, devc->buf + devc->buflen, len); - if (len < 1) { - sr_err("Serial port read error."); - return; - } - devc->buflen += len; - - /* Now look for packets in that data. */ - while ((devc->buflen - offset) >= RS_22_812_PACKET_SIZE) { - rs_packet = (void *)(devc->buf + offset); - if (rs_22_812_packet_valid(rs_packet)) { - handle_packet(rs_packet, devc); - offset += RS_22_812_PACKET_SIZE; - } else { - offset++; - } - } - - /* If we have any data left, move it to the beginning of our buffer. */ - for (i = 0; i < devc->buflen - offset; i++) - devc->buf[i] = devc->buf[offset + i]; - devc->buflen -= offset; -} - -SR_PRIV int radioshack_dmm_receive_data(int fd, int revents, void *cb_data) -{ - struct sr_dev_inst *sdi; - struct dev_context *devc; - - if (!(sdi = cb_data)) - return TRUE; - - if (!(devc = sdi->priv)) - return TRUE; - - if (revents == G_IO_IN) { - /* Serial data arrived. */ - handle_new_data(devc, fd); - } - - if (devc->num_samples >= devc->limit_samples) { - sdi->driver->dev_acquisition_stop(sdi, cb_data); - return TRUE; - } - - return TRUE; -}