BLAHAJ
/
libsigrok
10
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

radioshack-dmm: Separate protocol parser from driver 

Move the parsing part of radioshack-dmm into a separate protocol
parser, following the model from hardware/common/dmm.

Signed-off-by: Alexandru Gagniuc <mr.nuke.me@gmail.com>
This commit is contained in:
Alexandru Gagniuc 2012-12-02 12:58:30 -06:00 committed by Uwe Hermann
parent ae95ffebfa
commit 05f134abc2
6 changed files with 462 additions and 396 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
hardware/common/dmm/Makefile.am
View File

@ -23,7 +23,8 @@ noinst_LTLIBRARIES = libsigrok_hw_common_dmm.la
libsigrok_hw_common_dmm_la_SOURCES = \
fs9721.c \
fs9922.c \
metex14.c
metex14.c \
rs9lcd.c
libsigrok_hw_common_dmm_la_CFLAGS = \
-I$(top_srcdir)

443
hardware/common/dmm/rs9lcd.c Normal file
View File

@ -0,0 +1,443 @@
/*
* This file is part of the sigrok project.
*
* Copyright (C) 2012 Alexandru Gagniuc <mr.nuke.me@gmail.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/>.
*/
/*
* RadioShack 22-812 protocol parser.
*
* This protocol is currently encountered on the RadioShack 22-812 DMM.
* It is a 9-byte packet representing a 1:1 mapping of the LCD segments, hence
* the name rs9lcd.
*
* The chip is a bare die covered by a plastic blob. It is unclear if this chip
* and protocol is used on any other device.
*/
#include <string.h>
#include <ctype.h>
#include <math.h>
#include <glib.h>
#include "libsigrok.h"
#include "libsigrok-internal.h"
/* Message logging helpers with driver-specific prefix string. */
#define DRIVER_LOG_DOMAIN "rs9lcd: "
#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)
/* 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,
};
struct rs9lcd_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;
};
static gboolean checksum_valid(const struct rs9lcd_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 rs9lcd_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 sr_rs9lcd_packet_valid(const uint8_t *buf)
{
const struct rs9lcd_packet *rs_packet = (void *)buf;
/*
* Check for valid mode first, before calculating the checksum. No
* point calculating the checksum, if we know we'll reject the packet.
*/
if (!(rs_packet->mode < MODE_INVALID))
return FALSE;
if (!checksum_valid(rs_packet)) {
sr_spew("Packet with invalid checksum. Discarding.");
return FALSE;
}
if (!selection_good(rs_packet)) {
sr_spew("Packet with invalid selection bits. Discarding.");
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 rs9lcd_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(const struct rs9lcd_packet *rs_packet)
{
return ((rs_packet->digit4 & ~DP_MASK) == LCD_C);
}
static gboolean is_shortcirc(const struct rs9lcd_packet *rs_packet)
{
return ((rs_packet->digit2 & ~DP_MASK) == LCD_h);
}
static gboolean is_logic_high(const struct rs9lcd_packet *rs_packet)
{
sr_spew("Digit 2: 0x%02x.", rs_packet->digit2 & ~DP_MASK);
return ((rs_packet->digit2 & ~DP_MASK) == LCD_H);
}
SR_PRIV int sr_rs9lcd_parse(const uint8_t *buf, float *floatval,
struct sr_datafeed_analog *analog, void *info)
{
const struct rs9lcd_packet *rs_packet = (void *)buf;
double rawval;
(void)info;
rawval = lcd_to_double(rs_packet, READ_ALL);
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;
*floatval = rawval;
return SR_OK;
}

2
hardware/radioshack-dmm/api.c
View File

@ -94,7 +94,7 @@ static int hw_init(void)
static gboolean packet_valid_wrap(const uint8_t *buf)
{
return rs_22_812_packet_valid((void*)buf);
return sr_rs9lcd_packet_valid((void*)buf);
}
static GSList *rs_22_812_scan(const char *conn, const char *serialcomm)

387
hardware/radioshack-dmm/protocol.c
View File

@ -27,393 +27,23 @@
#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)
{
/*
* Check for valid mode first, before calculating the checksum.
* No point calculating the checksum, if we know we'll reject the packet
* */
if (!(rs_packet->mode < MODE_INVALID))
return FALSE;
if (!checksum_valid(rs_packet)) {
sr_spew("Packet with invalid checksum. Discarding.");
return FALSE;
}
if (!selection_good(rs_packet)) {
sr_spew("Packet with invalid selection bits. Discarding.");
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,
static void handle_packet(const uint8_t *rs_packet,
struct dev_context *devc)
{
double rawval;
float 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->num_samples = 1;
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;
sr_rs9lcd_parse(rs_packet, &rawval, analog, NULL);
analog->data = &rawval;
if (analog->mq != -1) {
/* Got a measurement. */
@ -423,7 +53,6 @@ static void handle_packet(struct rs_22_812_packet *rs_packet,
sr_session_send(devc->cb_data, &packet);
devc->num_samples++;
}
g_free(analog->data);
g_free(analog);
}
@ -431,7 +60,7 @@ static void handle_new_data(struct dev_context *devc)
{
int len;
size_t i, offset = 0;
struct rs_22_812_packet *rs_packet;
uint8_t *rs_packet;
/* Try to get as much data as the buffer can hold. */
len = RS_DMM_BUFSIZE - devc->buflen;
@ -445,7 +74,7 @@ static void handle_new_data(struct dev_context *devc)
/* 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)) {
if (sr_rs9lcd_packet_valid(rs_packet)) {
handle_packet(rs_packet, devc);
offset += RS_22_812_PACKET_SIZE;
} else {

15
hardware/radioshack-dmm/protocol.h
View File

@ -32,20 +32,6 @@
#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;
@ -62,6 +48,5 @@ struct dev_context {
};
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

8
libsigrok-internal.h
View File

@ -205,4 +205,12 @@ SR_PRIV gboolean sr_metex14_packet_valid(const uint8_t *buf);
SR_PRIV int sr_metex14_parse(const uint8_t *buf, float *floatval,
struct sr_datafeed_analog *analog, void *info);
/*--- hardware/common/dmm/rs9lcd.c ------------------------------------------*/
#define RS_22_812_PACKET_SIZE 9
SR_PRIV gboolean sr_rs9lcd_packet_valid(const uint8_t *buf);
SR_PRIV int sr_rs9lcd_parse(const uint8_t *buf, float *floatval,
struct sr_datafeed_analog *analog, void *info);
#endif