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