hardware/common/dmm/es519xx.c

   1 /*
   2  * This file is part of the libsigrok project.
   3  *
   4  * Copyright (C) 2012 Uwe Hermann <uwe@hermann-uwe.de>
   5  * Copyright (C) 2013 Aurelien Jacobs <aurel@gnuage.org>
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License
  18  * along with this program; if not, write to the Free Software
  19  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
  20  */
  21
  22 /*
  23  * Cyrustek ES519XX protocol parser.
  24  *
  25  * Communication parameters: Unidirectional, 2400/7o1 or 19230/7o1
  26  */
  27
  28 #include <string.h>
  29 #include <ctype.h>
  30 #include <math.h>
  31 #include <glib.h>
  32 #include "libsigrok.h"
  33 #include "libsigrok-internal.h"
  34
  35 /* Message logging helpers with subsystem-specific prefix string. */
  36 #define LOG_PREFIX "es519xx: "
  37 #define sr_log(l, s, args...) sr_log(l, LOG_PREFIX s, ## args)
  38 #define sr_spew(s, args...) sr_spew(LOG_PREFIX s, ## args)
  39 #define sr_dbg(s, args...) sr_dbg(LOG_PREFIX s, ## args)
  40 #define sr_info(s, args...) sr_info(LOG_PREFIX s, ## args)
  41 #define sr_warn(s, args...) sr_warn(LOG_PREFIX s, ## args)
  42 #define sr_err(s, args...) sr_err(LOG_PREFIX s, ## args)
  43
  44 /* Factors for the respective measurement mode (0 means "invalid"). */
  45 static const float factors_2400_11b[8][8] = {
  46         {1e-4,  1e-3,  1e-2,  1e-1, 1,    0,    0,    0   }, /* V */
  47         {1e-7,  1e-6,  0,     0,    0,    0,    0,    0   }, /* uA */
  48         {1e-5,  1e-4,  0,     0,    0,    0,    0,    0   }, /* mA */
  49         {1e-2,  0,     0,     0,    0,    0,    0,    0   }, /* A */
  50         {1e1,   1e2,   1e3,   1e4,  1e5,  1e6,  0,    0   }, /* RPM */
  51         {1e-1,  1,     1e1,   1e2,  1e3,  1e4,  0,    0   }, /* Resistance */
  52         {1,     1e1,   1e2,   1e3,  1e4,  1e5,  0,    0   }, /* Frequency */
  53         {1e-12, 1e-11, 1e-10, 1e-9, 1e-8, 1e-7, 1e-6, 1e-5}, /* Capacitance */
  54 };
  55 static const float factors_19200_11b_5digits[8][8] = {
  56         {1e-4,  1e-3,  1e-2,  1e-1, 1e-5, 0,    0,    0},    /* V */
  57         {1e-8,  1e-7,  0,     0,    0,    0,    0,    0},    /* uA */
  58         {1e-6,  1e-5,  0,     0,    0,    0,    0,    0},    /* mA */
  59         {0,     1e-3,  0,     0,    0,    0,    0,    0},    /* A */
  60         {1e-4,  1e-3,  1e-2,  1e-1, 1,    0,    0,    0},    /* Manual A */
  61         {1e-2,  1e-1,  1,     1e1,  1e2,  1e3,  1e4,  0},    /* Resistance */
  62         {1e-1,  0,     1,     1e1,  1e2,  1e3,  1e4,  0},    /* Frequency */
  63         {1e-12, 1e-11, 1e-10, 1e-9, 1e-8, 1e-7, 1e-6, 1e-5}, /* Capacitance */
  64 };
  65 static const float factors_19200_11b_clampmeter[8][8] = {
  66         {1e-3,  1e-2,  1e-1,  1,    1e-4, 0,    0,    0},    /* V */
  67         {1e-7,  1e-6,  0,     0,    0,    0,    0,    0},    /* uA */
  68         {1e-5,  1e-4,  0,     0,    0,    0,    0,    0},    /* mA */
  69         {1e-2,  0,     0,     0,    0,    0,    0,    0},    /* A */
  70         {1e-3,  1e-2,  1e-1,  1,    0,    0,    0,    0},    /* Manual A */
  71         {1e-1,  1,     1e1,   1e2,  1e3,  1e4,  0,    0},    /* Resistance */
  72         {1e-1,  0,     1,     1e1,  1e2,  1e3,  1e4,  0},    /* Frequency */
  73         {1e-12, 1e-11, 1e-10, 1e-9, 1e-8, 1e-7, 1e-6, 1e-5}, /* Capacitance */
  74 };
  75 static const float factors_19200_11b[8][8] = {
  76         {1e-3,  1e-2,  1e-1,  1,    1e-4, 0,    0,    0},    /* V */
  77         {1e-7,  1e-6,  0,     0,    0,    0,    0,    0},    /* uA */
  78         {1e-5,  1e-4,  0,     0,    0,    0,    0,    0},    /* mA */
  79         {1e-3,  1e-2,  0,     0,    0,    0,    0,    0},    /* A */
  80         {0,     0,     0,     0,    0,    0,    0,    0},    /* Manual A */
  81         {1e-1,  1,     1e1,   1e2,  1e3,  1e4,  0,    0},    /* Resistance */
  82         {1,     1e1,   1e2,   1e3,  1e4,  0,    0,    0},    /* Frequency */
  83         {1e-12, 1e-11, 1e-10, 1e-9, 1e-8, 1e-7, 1e-6, 0},    /* Capacitance */
  84 };
  85 static const float factors_19200_14b[8][8] = {
  86         {1e-4,  1e-3,  1e-2,  1e-1, 1e-5, 0,    0,    0},    /* V */
  87         {1e-8,  1e-7,  0,     0,    0,    0,    0,    0},    /* uA */
  88         {1e-6,  1e-5,  0,     0,    0,    0,    0,    0},    /* mA */
  89         {1e-3,  0,     0,     0,    0,    0,    0,    0},    /* A */
  90         {1e-4,  1e-3,  1e-2,  1e-1, 1,    0,    0,    0},    /* Manual A */
  91         {1e-2,  1e-1,  1,     1e1,  1e2,  1e3,  1e4,  0},    /* Resistance */
  92         {1e-2,  1e-1,  0,     1,    1e1,  1e2,  1e3,  1e4},  /* Frequency */
  93         {1e-12, 1e-11, 1e-10, 1e-9, 1e-8, 1e-7, 1e-6, 1e-5}, /* Capacitance */
  94 };
  95
  96 static int parse_value(const uint8_t *buf, struct es519xx_info *info,
  97                        float *result)
  98 {
  99         int i, intval, num_digits;
 100         float floatval;
 101
 102         num_digits = 4 + ((info->packet_size == 14) ? 1 : 0);
 103
 104         /* Bytes 1-4 (or 5): Value (4 or 5 decimal digits) */
 105         if (info->is_ol) {
 106                 sr_spew("Over limit.");
 107                 *result = INFINITY;
 108                 return SR_OK;
 109         } else if (info->is_ul) {
 110                 sr_spew("Under limit.");
 111                 *result = INFINITY;
 112                 return SR_OK;
 113         } else if (!isdigit(buf[1]) || !isdigit(buf[2]) ||
 114                    !isdigit(buf[3]) || !isdigit(buf[4]) ||
 115                    (num_digits == 5 && !isdigit(buf[5]))) {
 116                 sr_err("Value contained invalid digits: %02x %02x %02x %02x "
 117                        "(%c %c %c %c).", buf[1], buf[2], buf[3], buf[4],
 118                        buf[1], buf[2], buf[3], buf[4]);
 119                 return SR_ERR;
 120         }
 121         intval = (info->is_digit4) ? 1 : 0;
 122         for (i = 0; i < num_digits; i++)
 123                 intval = 10 * intval + (buf[i + 1] - '0');
 124
 125         /* Apply sign. */
 126         intval *= info->is_sign ? -1 : 1;
 127
 128         floatval = (float)intval;
 129
 130         /* Note: The decimal point position will be parsed later. */
 131
 132         sr_spew("The display value is %f.", floatval);
 133
 134         *result = floatval;
 135
 136         return SR_OK;
 137 }
 138
 139 static int parse_range(uint8_t b, float *floatval,
 140                        const struct es519xx_info *info)
 141 {
 142         int idx, mode;
 143         float factor = 0;
 144
 145         idx = b - '0';
 146
 147         if (idx < 0 || idx > 7) {
 148                 sr_dbg("Invalid range byte / index: 0x%02x / 0x%02x.", b, idx);
 149                 return SR_ERR;
 150         }
 151
 152         /* Parse range byte (depends on the measurement mode). */
 153         if (info->is_voltage)
 154                 mode = 0; /* V */
 155         else if (info->is_current && info->is_micro)
 156                 mode = 1; /* uA */
 157         else if (info->is_current && info->is_milli)
 158                 mode = 2; /* mA */
 159         else if (info->is_current && info->is_auto)
 160                 mode = 3; /* A */
 161         else if (info->is_current && !info->is_auto)
 162                 mode = 4; /* Manual A */
 163         else if (info->is_rpm)
 164                 /* Not a typo, it's really index 4 in factors_2400_11b[][]. */
 165                 mode = 4; /* RPM */
 166         else if (info->is_resistance)
 167                 mode = 5; /* Resistance */
 168         else if (info->is_frequency)
 169                 mode = 6; /* Frequency */
 170         else if (info->is_capacitance)
 171                 mode = 7; /* Capacitance */
 172         else {
 173                 sr_dbg("Invalid mode, range byte was: 0x%02x.", b);
 174                 return SR_ERR;
 175         }
 176
 177         if (info->is_vbar) {
 178                 if (info->is_micro)
 179                         factor = (const float[]){1e-1, 1}[idx];
 180                 else if (info->is_milli)
 181                         factor = (const float[]){1e-2, 1e-1}[idx];
 182         }
 183         else if (info->baudrate == 2400)
 184                 factor = factors_2400_11b[mode][idx];
 185         else if (info->fivedigits)
 186                 factor = factors_19200_11b_5digits[mode][idx];
 187         else if (info->clampmeter)
 188                 factor = factors_19200_11b_clampmeter[mode][idx];
 189         else if (info->packet_size == 11)
 190                 factor = factors_19200_11b[mode][idx];
 191         else if (info->packet_size == 14)
 192                 factor = factors_19200_14b[mode][idx];
 193
 194         if (factor == 0) {
 195                 sr_dbg("Invalid factor for range byte: 0x%02x.", b);
 196                 return SR_ERR;
 197         }
 198
 199         /* Apply respective factor (mode-dependent) on the value. */
 200         *floatval *= factor;
 201         sr_dbg("Applying factor %f, new value is %f.", factor, *floatval);
 202
 203         return SR_OK;
 204 }
 205
 206 static void parse_flags(const uint8_t *buf, struct es519xx_info *info)
 207 {
 208         int function, status;
 209
 210         function = 5 + ((info->packet_size == 14) ? 1 : 0);
 211         status = function + 1;
 212
 213         /* Status byte */
 214         if (info->alt_functions) {
 215                 info->is_sign  = (buf[status] & (1 << 3)) != 0;
 216                 info->is_batt  = (buf[status] & (1 << 2)) != 0; /* Bat. low */
 217                 info->is_ol    = (buf[status] & (1 << 1)) != 0; /* Overflow */
 218                 info->is_ol   |= (buf[status] & (1 << 0)) != 0; /* Overflow */
 219         } else {
 220                 info->is_judge = (buf[status] & (1 << 3)) != 0;
 221                 info->is_sign  = (buf[status] & (1 << 2)) != 0;
 222                 info->is_batt  = (buf[status] & (1 << 1)) != 0; /* Bat. low */
 223                 info->is_ol    = (buf[status] & (1 << 0)) != 0; /* Overflow */
 224         }
 225
 226         if (info->packet_size == 14) {
 227                 /* Option 1 byte */
 228                 info->is_max  = (buf[8] & (1 << 3)) != 0;
 229                 info->is_min  = (buf[8] & (1 << 2)) != 0;
 230                 info->is_rel  = (buf[8] & (1 << 1)) != 0;
 231                 info->is_rmr  = (buf[8] & (1 << 0)) != 0;
 232
 233                 /* Option 2 byte */
 234                 info->is_ul   = (buf[9] & (1 << 3)) != 0; /* Underflow */
 235                 info->is_pmax = (buf[9] & (1 << 2)) != 0; /* Max. peak value */
 236                 info->is_pmin = (buf[9] & (1 << 1)) != 0; /* Min. peak value */
 237
 238                 /* Option 3 byte */
 239                 info->is_dc   = (buf[10] & (1 << 3)) != 0;
 240                 info->is_ac   = (buf[10] & (1 << 2)) != 0;
 241                 info->is_auto = (buf[10] & (1 << 1)) != 0;
 242                 info->is_vahz = (buf[10] & (1 << 0)) != 0;
 243
 244                 /* LPF: Low-pass filter(s) */
 245                 if (info->selectable_lpf) {
 246                         /* Option 4 byte */
 247                         info->is_hold = (buf[11] & (1 << 3)) != 0;
 248                         info->is_vbar = (buf[11] & (1 << 2)) != 0;
 249                         info->is_lpf1 = (buf[11] & (1 << 1)) != 0;
 250                         info->is_lpf0 = (buf[11] & (1 << 0)) != 0;
 251                 } else {
 252                         /* Option 4 byte */
 253                         info->is_vbar = (buf[11] & (1 << 2)) != 0;
 254                         info->is_hold = (buf[11] & (1 << 1)) != 0;
 255                         info->is_lpf1 = (buf[11] & (1 << 0)) != 0;
 256                 }
 257         } else if (info->alt_functions) {
 258                 /* Option 2 byte */
 259                 info->is_dc   = (buf[8] & (1 << 3)) != 0;
 260                 info->is_auto = (buf[8] & (1 << 2)) != 0;
 261                 info->is_apo  = (buf[8] & (1 << 0)) != 0;
 262                 info->is_ac   = !info->is_dc;
 263         } else {
 264                 /* Option 1 byte */
 265                 if (info->baudrate == 2400) {
 266                         info->is_pmax   = (buf[7] & (1 << 3)) != 0;
 267                         info->is_pmin   = (buf[7] & (1 << 2)) != 0;
 268                         info->is_vahz   = (buf[7] & (1 << 0)) != 0;
 269                 } else if (info->fivedigits) {
 270                         info->is_ul     = (buf[7] & (1 << 3)) != 0;
 271                         info->is_pmax   = (buf[7] & (1 << 2)) != 0;
 272                         info->is_pmin   = (buf[7] & (1 << 1)) != 0;
 273                         info->is_digit4 = (buf[7] & (1 << 0)) != 0;
 274                 } else if (info->clampmeter) {
 275                         info->is_ul     = (buf[7] & (1 << 3)) != 0;
 276                         info->is_vasel  = (buf[7] & (1 << 2)) != 0;
 277                         info->is_vbar   = (buf[7] & (1 << 1)) != 0;
 278                 } else {
 279                         info->is_hold   = (buf[7] & (1 << 3)) != 0;
 280                         info->is_max    = (buf[7] & (1 << 2)) != 0;
 281                         info->is_min    = (buf[7] & (1 << 1)) != 0;
 282                 }
 283
 284                 /* Option 2 byte */
 285                 info->is_dc   = (buf[8] & (1 << 3)) != 0;
 286                 info->is_ac   = (buf[8] & (1 << 2)) != 0;
 287                 info->is_auto = (buf[8] & (1 << 1)) != 0;
 288                 if (info->baudrate == 2400)
 289                         info->is_apo  = (buf[8] & (1 << 0)) != 0;
 290                 else
 291                         info->is_vahz = (buf[8] & (1 << 0)) != 0;
 292         }
 293
 294         /* Function byte */
 295         if (info->alt_functions) {
 296                 switch (buf[function]) {
 297                 case 0x3f: /* A */
 298                         info->is_current = info->is_auto = TRUE;
 299                         break;
 300                 case 0x3e: /* uA */
 301                         info->is_current = info->is_micro = info->is_auto = TRUE;
 302                         break;
 303                 case 0x3d: /* mA */
 304                         info->is_current = info->is_milli = info->is_auto = TRUE;
 305                         break;
 306                 case 0x3c: /* V */
 307                         info->is_voltage = TRUE;
 308                         break;
 309                 case 0x37: /* Resistance */
 310                         info->is_resistance = TRUE;
 311                         break;
 312                 case 0x36: /* Continuity */
 313                         info->is_continuity = TRUE;
 314                         break;
 315                 case 0x3b: /* Diode */
 316                         info->is_diode = TRUE;
 317                         break;
 318                 case 0x3a: /* Frequency */
 319                         info->is_frequency = TRUE;
 320                         break;
 321                 case 0x34: /* ADP0 */
 322                 case 0x35: /* ADP0 */
 323                         info->is_adp0 = TRUE;
 324                         break;
 325                 case 0x38: /* ADP1 */
 326                 case 0x39: /* ADP1 */
 327                         info->is_adp1 = TRUE;
 328                         break;
 329                 case 0x32: /* ADP2 */
 330                 case 0x33: /* ADP2 */
 331                         info->is_adp2 = TRUE;
 332                         break;
 333                 case 0x30: /* ADP3 */
 334                 case 0x31: /* ADP3 */
 335                         info->is_adp3 = TRUE;
 336                         break;
 337                 default:
 338                         sr_err("Invalid function byte: 0x%02x.", buf[function]);
 339                         break;
 340                 }
 341         } else {
 342                 /* Note: Some of these mappings are fixed up later. */
 343                 switch (buf[function]) {
 344                 case 0x3b: /* V */
 345                         info->is_voltage = TRUE;
 346                         break;
 347                 case 0x3d: /* uA */
 348                         info->is_current = info->is_micro = info->is_auto = TRUE;
 349                         break;
 350                 case 0x3f: /* mA */
 351                         info->is_current = info->is_milli = info->is_auto = TRUE;
 352                         break;
 353                 case 0x30: /* A */
 354                         info->is_current = info->is_auto = TRUE;
 355                         break;
 356                 case 0x39: /* Manual A */
 357                         info->is_current = TRUE;
 358                         info->is_auto = FALSE; /* Manual mode */
 359                         break;
 360                 case 0x33: /* Resistance */
 361                         info->is_resistance = TRUE;
 362                         break;
 363                 case 0x35: /* Continuity */
 364                         info->is_continuity = TRUE;
 365                         break;
 366                 case 0x31: /* Diode */
 367                         info->is_diode = TRUE;
 368                         break;
 369                 case 0x32: /* Frequency / RPM / duty cycle */
 370                         if (info->packet_size == 14) {
 371                                 if (info->is_judge)
 372                                         info->is_frequency = TRUE;
 373                                 else
 374                                         info->is_duty_cycle = TRUE;
 375                         } else {
 376                                 if (info->is_judge)
 377                                         info->is_rpm = TRUE;
 378                                 else
 379                                         info->is_frequency = TRUE;
 380                         }
 381                         break;
 382                 case 0x36: /* Capacitance */
 383                         info->is_capacitance = TRUE;
 384                         break;
 385                 case 0x34: /* Temperature */
 386                         info->is_temperature = TRUE;
 387                         if (info->is_judge)
 388                                 info->is_celsius = TRUE;
 389                         else
 390                                 info->is_fahrenheit = TRUE;
 391                         /* IMPORTANT: The digits always represent Celsius! */
 392                         break;
 393                 case 0x3e: /* ADP0 */
 394                         info->is_adp0 = TRUE;
 395                         break;
 396                 case 0x3c: /* ADP1 */
 397                         info->is_adp1 = TRUE;
 398                         break;
 399                 case 0x38: /* ADP2 */
 400                         info->is_adp2 = TRUE;
 401                         break;
 402                 case 0x3a: /* ADP3 */
 403                         info->is_adp3 = TRUE;
 404                         break;
 405                 default:
 406                         sr_err("Invalid function byte: 0x%02x.", buf[function]);
 407                         break;
 408                 }
 409         }
 410
 411         if (info->is_current && (info->is_micro || info->is_milli) && info->is_vasel) {
 412                 info->is_current = info->is_auto = FALSE;
 413                 info->is_voltage = TRUE;
 414         }
 415
 416         if (info->baudrate == 2400) {
 417                 /* Inverted mapping between mA and A, and no manual A. */
 418                 if (info->is_current && (info->is_milli || !info->is_auto)) {
 419                         info->is_milli = !info->is_milli;
 420                         info->is_auto = TRUE;
 421                 }
 422         }
 423 }
 424
 425 static void handle_flags(struct sr_datafeed_analog *analog,
 426                          float *floatval, const struct es519xx_info *info)
 427 {
 428         /*
 429          * Note: is_micro etc. are not used directly to multiply/divide
 430          * floatval, this is handled via parse_range() and factors[][].
 431          */
 432
 433         /* Measurement modes */
 434         if (info->is_voltage) {
 435                 analog->mq = SR_MQ_VOLTAGE;
 436                 analog->unit = SR_UNIT_VOLT;
 437         }
 438         if (info->is_current) {
 439                 analog->mq = SR_MQ_CURRENT;
 440                 analog->unit = SR_UNIT_AMPERE;
 441         }
 442         if (info->is_resistance) {
 443                 analog->mq = SR_MQ_RESISTANCE;
 444                 analog->unit = SR_UNIT_OHM;
 445         }
 446         if (info->is_frequency) {
 447                 analog->mq = SR_MQ_FREQUENCY;
 448                 analog->unit = SR_UNIT_HERTZ;
 449         }
 450         if (info->is_capacitance) {
 451                 analog->mq = SR_MQ_CAPACITANCE;
 452                 analog->unit = SR_UNIT_FARAD;
 453         }
 454         if (info->is_temperature && info->is_celsius) {
 455                 analog->mq = SR_MQ_TEMPERATURE;
 456                 analog->unit = SR_UNIT_CELSIUS;
 457         }
 458         if (info->is_temperature && info->is_fahrenheit) {
 459                 analog->mq = SR_MQ_TEMPERATURE;
 460                 analog->unit = SR_UNIT_FAHRENHEIT;
 461         }
 462         if (info->is_continuity) {
 463                 analog->mq = SR_MQ_CONTINUITY;
 464                 analog->unit = SR_UNIT_BOOLEAN;
 465                 *floatval = (*floatval < 0.0) ? 0.0 : 1.0;
 466         }
 467         if (info->is_diode) {
 468                 analog->mq = SR_MQ_VOLTAGE;
 469                 analog->unit = SR_UNIT_VOLT;
 470         }
 471         if (info->is_rpm) {
 472                 analog->mq = SR_MQ_FREQUENCY;
 473                 analog->unit = SR_UNIT_REVOLUTIONS_PER_MINUTE;
 474         }
 475         if (info->is_duty_cycle) {
 476                 analog->mq = SR_MQ_DUTY_CYCLE;
 477                 analog->unit = SR_UNIT_PERCENTAGE;
 478         }
 479
 480         /* Measurement related flags */
 481         if (info->is_ac)
 482                 analog->mqflags |= SR_MQFLAG_AC;
 483         if (info->is_dc)
 484                 analog->mqflags |= SR_MQFLAG_DC;
 485         if (info->is_auto)
 486                 analog->mqflags |= SR_MQFLAG_AUTORANGE;
 487         if (info->is_diode)
 488                 analog->mqflags |= SR_MQFLAG_DIODE;
 489         if (info->is_hold)
 490                 /*
 491                 * Note: HOLD only affects the number displayed on the LCD,
 492                 * but not the value sent via the protocol! It also does not
 493                 * affect the bargraph on the LCD.
 494                 */
 495                 analog->mqflags |= SR_MQFLAG_HOLD;
 496         if (info->is_max)
 497                 analog->mqflags |= SR_MQFLAG_MAX;
 498         if (info->is_min)
 499                 analog->mqflags |= SR_MQFLAG_MIN;
 500         if (info->is_rel)
 501                 analog->mqflags |= SR_MQFLAG_RELATIVE;
 502
 503         /* Other flags */
 504         if (info->is_judge)
 505                 sr_spew("Judge bit is set.");
 506         if (info->is_batt)
 507                 sr_spew("Battery is low.");
 508         if (info->is_ol)
 509                 sr_spew("Input overflow.");
 510         if (info->is_ul)
 511                 sr_spew("Input underflow.");
 512         if (info->is_pmax)
 513                 sr_spew("pMAX active, LCD shows max. peak value.");
 514         if (info->is_pmin)
 515                 sr_spew("pMIN active, LCD shows min. peak value.");
 516         if (info->is_vahz)
 517                 sr_spew("VAHZ active.");
 518         if (info->is_apo)
 519                 sr_spew("Auto-Power-Off enabled.");
 520         if (info->is_vbar)
 521                 sr_spew("VBAR active.");
 522         if ((!info->selectable_lpf && info->is_lpf1) ||
 523             (info->selectable_lpf && (!info->is_lpf0 || !info->is_lpf1)))
 524                 sr_spew("Low-pass filter feature is active.");
 525 }
 526
 527 static gboolean flags_valid(const struct es519xx_info *info)
 528 {
 529         int count;
 530
 531         /* Does the packet have more than one multiplier? */
 532         count  = (info->is_micro) ? 1 : 0;
 533         count += (info->is_milli) ? 1 : 0;
 534         if (count > 1) {
 535                 sr_err("More than one multiplier detected in packet.");
 536                 return FALSE;
 537         }
 538
 539         /* Does the packet "measure" more than one type of value? */
 540         count  = (info->is_voltage) ? 1 : 0;
 541         count += (info->is_current) ? 1 : 0;
 542         count += (info->is_resistance) ? 1 : 0;
 543         count += (info->is_frequency) ? 1 : 0;
 544         count += (info->is_capacitance) ? 1 : 0;
 545         count += (info->is_temperature) ? 1 : 0;
 546         count += (info->is_continuity) ? 1 : 0;
 547         count += (info->is_diode) ? 1 : 0;
 548         count += (info->is_rpm) ? 1 : 0;
 549         if (count > 1) {
 550                 sr_err("More than one measurement type detected in packet.");
 551                 return FALSE;
 552         }
 553
 554         /* Both AC and DC set? */
 555         if (info->is_ac && info->is_dc) {
 556                 sr_err("Both AC and DC flags detected in packet.");
 557                 return FALSE;
 558         }
 559
 560         return TRUE;
 561 }
 562
 563 static gboolean sr_es519xx_packet_valid(const uint8_t *buf,
 564                                         struct es519xx_info *info)
 565 {
 566         int s;
 567
 568         s = info->packet_size;
 569
 570         if (s == 11 && memcmp(buf, buf + s, s))
 571                 return FALSE;
 572
 573         if (buf[s - 2] != '\r' || buf[s - 1] != '\n')
 574                 return FALSE;
 575
 576         parse_flags(buf, info);
 577
 578         if (!flags_valid(info))
 579                 return FALSE;
 580
 581         return TRUE;
 582 }
 583
 584 static int sr_es519xx_parse(const uint8_t *buf, float *floatval,
 585                             struct sr_datafeed_analog *analog,
 586                             struct es519xx_info *info)
 587 {
 588         int ret;
 589
 590         if (!sr_es519xx_packet_valid(buf, info))
 591                 return SR_ERR;
 592
 593         if ((ret = parse_value(buf, info, floatval)) != SR_OK) {
 594                 sr_err("Error parsing value: %d.", ret);
 595                 return ret;
 596         }
 597
 598         handle_flags(analog, floatval, info);
 599
 600         return parse_range(buf[0], floatval, info);
 601 }
 602
 603 /*
 604  * Functions for 2400 baud / 11 bytes protocols.
 605  * This includes ES51962, ES51971, ES51972, ES51978 and ES51989.
 606  */
 607 SR_PRIV gboolean sr_es519xx_2400_11b_packet_valid(const uint8_t *buf)
 608 {
 609         struct es519xx_info info = { 0 };
 610
 611         info.baudrate = 2400;
 612         info.packet_size = 11;
 613
 614         return sr_es519xx_packet_valid(buf, &info);
 615 }
 616
 617 SR_PRIV int sr_es519xx_2400_11b_parse(const uint8_t *buf, float *floatval,
 618                                 struct sr_datafeed_analog *analog, void *info)
 619 {
 620         struct es519xx_info *info_local;
 621
 622         info_local = info;
 623         memset(info_local, 0, sizeof(struct es519xx_info));
 624         info_local->baudrate = 2400;
 625         info_local->packet_size = 11;
 626
 627         return sr_es519xx_parse(buf, floatval, analog, info);
 628 }
 629
 630 /*
 631  * Functions for 2400 baud / 11 byte protocols.
 632  * This includes ES51960, ES51977 and ES51988.
 633  */
 634 SR_PRIV gboolean sr_es519xx_2400_11b_altfn_packet_valid(const uint8_t *buf)
 635 {
 636         struct es519xx_info info = { 0 };
 637
 638         info.baudrate = 2400;
 639         info.packet_size = 11;
 640         info.alt_functions = TRUE;
 641
 642         return sr_es519xx_packet_valid(buf, &info);
 643 }
 644
 645 SR_PRIV int sr_es519xx_2400_11b_altfn_parse(const uint8_t *buf,
 646                 float *floatval, struct sr_datafeed_analog *analog, void *info)
 647 {
 648         struct es519xx_info *info_local;
 649
 650         info_local = info;
 651         memset(info_local, 0, sizeof(struct es519xx_info));
 652         info_local->baudrate = 2400;
 653         info_local->packet_size = 11;
 654         info_local->alt_functions = TRUE;
 655
 656         return sr_es519xx_parse(buf, floatval, analog, info);
 657 }
 658
 659 /*
 660  * Functions for 19200 baud / 11 bytes protocols with 5 digits display.
 661  * This includes ES51911, ES51916 and ES51918.
 662  */
 663 SR_PRIV gboolean sr_es519xx_19200_11b_5digits_packet_valid(const uint8_t *buf)
 664 {
 665         struct es519xx_info info = { 0 };
 666
 667         info.baudrate = 19200;
 668         info.packet_size = 11;
 669         info.fivedigits = TRUE;
 670
 671         return sr_es519xx_packet_valid(buf, &info);
 672 }
 673
 674 SR_PRIV int sr_es519xx_19200_11b_5digits_parse(const uint8_t *buf,
 675                 float *floatval, struct sr_datafeed_analog *analog, void *info)
 676 {
 677         struct es519xx_info *info_local;
 678
 679         info_local = info;
 680         memset(info_local, 0, sizeof(struct es519xx_info));
 681         info_local->baudrate = 19200;
 682         info_local->packet_size = 11;
 683         info_local->fivedigits = TRUE;
 684
 685         return sr_es519xx_parse(buf, floatval, analog, info);
 686 }
 687
 688 /*
 689  * Functions for 19200 baud / 11 bytes protocols with clamp meter support.
 690  * This includes ES51967 and ES51969.
 691  */
 692 SR_PRIV gboolean sr_es519xx_19200_11b_clamp_packet_valid(const uint8_t *buf)
 693 {
 694         struct es519xx_info info = { 0 };
 695
 696         info.baudrate = 19200;
 697         info.packet_size = 11;
 698         info.clampmeter = TRUE;
 699
 700         return sr_es519xx_packet_valid(buf, &info);
 701 }
 702
 703 SR_PRIV int sr_es519xx_19200_11b_clamp_parse(const uint8_t *buf,
 704                 float *floatval, struct sr_datafeed_analog *analog, void *info)
 705 {
 706         struct es519xx_info *info_local;
 707
 708         info_local = info;
 709         memset(info_local, 0, sizeof(struct es519xx_info));
 710         info_local->baudrate = 19200;
 711         info_local->packet_size = 11;
 712         info_local->clampmeter = TRUE;
 713
 714         return sr_es519xx_parse(buf, floatval, analog, info);
 715 }
 716
 717 /*
 718  * Functions for 19200 baud / 11 bytes protocols.
 719  * This includes ES51981, ES51982, ES51983, ES51984 and ES51986.
 720  */
 721 SR_PRIV gboolean sr_es519xx_19200_11b_packet_valid(const uint8_t *buf)
 722 {
 723         struct es519xx_info info = { 0 };
 724
 725         info.baudrate = 19200;
 726         info.packet_size = 11;
 727
 728         return sr_es519xx_packet_valid(buf, &info);
 729 }
 730
 731 SR_PRIV int sr_es519xx_19200_11b_parse(const uint8_t *buf, float *floatval,
 732                         struct sr_datafeed_analog *analog, void *info)
 733 {
 734         struct es519xx_info *info_local;
 735
 736         info_local = info;
 737         memset(info_local, 0, sizeof(struct es519xx_info));
 738         info_local->baudrate = 19200;
 739         info_local->packet_size = 11;
 740
 741         return sr_es519xx_parse(buf, floatval, analog, info);
 742 }
 743
 744 /*
 745  * Functions for 19200 baud / 14 bytes protocols.
 746  * This includes ES51921 and ES51922.
 747  */
 748 SR_PRIV gboolean sr_es519xx_19200_14b_packet_valid(const uint8_t *buf)
 749 {
 750         struct es519xx_info info = { 0 };
 751
 752         info.baudrate = 19200;
 753         info.packet_size = 14;
 754
 755         return sr_es519xx_packet_valid(buf, &info);
 756 }
 757
 758 SR_PRIV int sr_es519xx_19200_14b_parse(const uint8_t *buf, float *floatval,
 759                         struct sr_datafeed_analog *analog, void *info)
 760 {
 761         struct es519xx_info *info_local;
 762
 763         info_local = info;
 764         memset(info_local, 0, sizeof(struct es519xx_info));
 765         info_local->baudrate = 19200;
 766         info_local->packet_size = 14;
 767
 768         return sr_es519xx_parse(buf, floatval, analog, info);
 769 }
 770
 771 /*
 772  * Functions for 19200 baud / 14 bytes protocols with selectable LPF.
 773  * This includes ES51931 and ES51932.
 774  */
 775 SR_PRIV gboolean sr_es519xx_19200_14b_sel_lpf_packet_valid(const uint8_t *buf)
 776 {
 777         struct es519xx_info info = { 0 };
 778
 779         info.baudrate = 19200;
 780         info.packet_size = 14;
 781         info.selectable_lpf = TRUE;
 782
 783         return sr_es519xx_packet_valid(buf, &info);
 784 }
 785
 786 SR_PRIV int sr_es519xx_19200_14b_sel_lpf_parse(const uint8_t *buf,
 787                 float *floatval, struct sr_datafeed_analog *analog, void *info)
 788 {
 789         struct es519xx_info *info_local;
 790
 791         info_local = info;
 792         memset(info_local, 0, sizeof(struct es519xx_info));
 793         info_local->baudrate = 19200;
 794         info_local->packet_size = 14;
 795         info_local->selectable_lpf = TRUE;
 796
 797         return sr_es519xx_parse(buf, floatval, analog, info);
 798 }