X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=hardware%2Fgmc-mh-1x-2x%2Fprotocol.c;h=66a73e9f639965d0e5e86b3be2352275ac11bccb;hb=c2b988bd4a1986c15a0ffc8a38b3aa56d1a68c89;hp=0583b2b2e81a94e04e2b82a4306710e0ad7249a5;hpb=f57924179d08dee9d24099233ffbee2123613a22;p=libsigrok.git diff --git a/hardware/gmc-mh-1x-2x/protocol.c b/hardware/gmc-mh-1x-2x/protocol.c index 0583b2b2..66a73e9f 100644 --- a/hardware/gmc-mh-1x-2x/protocol.c +++ b/hardware/gmc-mh-1x-2x/protocol.c @@ -19,7 +19,6 @@ #include #include - #include "protocol.h" /** Set or clear flags in devc->mqflags. */ @@ -31,9 +30,8 @@ static void setmqf(struct dev_context *devc, uint64_t flags, gboolean set) devc->mqflags &= ~flags; } -/** Decode current type and measured value, Metrahit 12-16. - */ -static void decode_ctmv_16(guchar ctmv, struct dev_context *devc) +/** Decode current type and measured value, Metrahit 12-16. */ +static void decode_ctmv_16(uint8_t ctmv, struct dev_context *devc) { devc->mq = 0; devc->unit = 0; @@ -53,9 +51,9 @@ static void decode_ctmv_16(guchar ctmv, struct dev_context *devc) devc->mqflags |= SR_MQFLAG_DC; if (ctmv >= 0x03) { devc->mqflags |= SR_MQFLAG_AC; - if (devc->model >= SR_METRAHIT_16S) + if (devc->model >= METRAHIT_16S) devc->mqflags |= SR_MQFLAG_RMS; - } + } break; case 0x05: /* 0101 Hz (15S/16S only) */ case 0x06: /* 0110 kHz (15S/16S only) */ @@ -94,25 +92,27 @@ static void decode_ctmv_16(guchar ctmv, struct dev_context *devc) case 0x0f: /* A */ devc->mq = SR_MQ_CURRENT; devc->unit = SR_UNIT_AMPERE; - if (devc->model == SR_METRAHIT_16S) + if (devc->model == METRAHIT_16S) devc->mqflags |= SR_MQFLAG_RMS; /* 16I A only with clamp, RMS questionable. */ break; } } -/** Decode range/sign/acdc byte special chars (Metrahit 12-16). - * \param[in] spc Special characters 1 and 2 (s1 | (s2<<4)). +/** + * Decode range/sign/acdc byte special chars (Metrahit 12-16). + * + * @param[in] rs Range and sign byte. */ -static void decode_rs_16(guchar rs, struct dev_context *devc) +static void decode_rs_16(uint8_t rs, struct dev_context *devc) { sr_spew("decode_rs_16(%d) scale = %f", rs, devc->scale); - if (rs & 0x08) /* Sign */ + if (rs & 0x04) /* Sign */ devc->scale *= -1.0; if (devc->mq == SR_MQ_CURRENT) { - if (rs & 0x04) /* Current is AC */ + if (rs & 0x08) /* Current is AC */ devc->mqflags |= SR_MQFLAG_AC; else devc->mqflags |= SR_MQFLAG_DC; @@ -120,7 +120,7 @@ static void decode_rs_16(guchar rs, struct dev_context *devc) switch (rs & 0x03) { case 0: - if (devc->mq == SR_MQ_VOLTAGE) /* V */ + if (devc->mq == SR_MQ_VOLTAGE) /* V */ devc->scale *= 0.1; else if (devc->mq == SR_MQ_CURRENT) /* 000.0 µA */ devc->scale *= 0.0000001; /* Untested! */ @@ -130,8 +130,7 @@ static void decode_rs_16(guchar rs, struct dev_context *devc) devc->mq = SR_MQ_TEMPERATURE; devc->unit = SR_UNIT_CELSIUS; devc->scale *= 0.01; - } - else if ((devc->scale1000 == 2)) { + } else if (devc->scale1000 == 2) { /* 16I Iso 500/1000V 3 GOhm */ devc->scale *= 0.1; } @@ -149,10 +148,12 @@ static void decode_rs_16(guchar rs, struct dev_context *devc) } } -/** Decode special chars, Metrahit 12-16. - * \param[in] spc Special characters 1 and 2 (s1 | (s2<<4)). +/** + * Decode special chars, Metrahit 12-16. + * + * @param[in] spc Special characters 1 and 2 (s1 | (s2 << 4)). */ -static void decode_spc_16(guchar spc, struct dev_context *devc) +static void decode_spc_16(uint8_t spc, struct dev_context *devc) { /* xxxx1xxx ON */ /* TODO: What does that mean? Power on? The 16I sets this. */ @@ -172,9 +173,8 @@ static void decode_spc_16(guchar spc, struct dev_context *devc) setmqf(devc, SR_MQFLAG_MAX, spc & 0x10); } -/** Decode current type and measured value, Metrahit 18. - */ -static void decode_ctmv_18(guchar ctmv, struct dev_context *devc) +/** Decode current type and measured value, Metrahit 18. */ +static void decode_ctmv_18(uint8_t ctmv, struct dev_context *devc) { devc->mq = 0; devc->unit = 0; @@ -197,7 +197,7 @@ static void decode_ctmv_18(guchar ctmv, struct dev_context *devc) devc->mq = SR_MQ_RESISTANCE; devc->unit = SR_UNIT_OHM; break; - case 0x05: /* 0101 Diode/Diode with buzzer*/ + case 0x05: /* 0101 Diode/Diode with buzzer */ devc->mq = SR_MQ_VOLTAGE; devc->unit = SR_UNIT_VOLT; devc->mqflags |= SR_MQFLAG_DIODE; @@ -245,10 +245,12 @@ static void decode_ctmv_18(guchar ctmv, struct dev_context *devc) } } -/** Decode range/sign/acdc byte special chars, Metrahit 18. - * \param[in] rs Rance/sign byte +/** + * Decode range/sign/acdc byte special chars, Metrahit 18. + * + * @param[in] rs Rance/sign byte. */ -static void decode_rs_18(guchar rs, struct dev_context *devc) +static void decode_rs_18(uint8_t rs, struct dev_context *devc) { int range; @@ -263,7 +265,8 @@ static void decode_rs_18(guchar rs, struct dev_context *devc) case SR_MQ_VOLTAGE: if (devc->unit == SR_UNIT_DECIBEL_VOLT) { devc->scale *= pow(10.0, -2); - /* When entering relative mode, the device switches + /* + * When entering relative mode, the device switches * from 10 byte to 6 byte msg format. Unfortunately * it switches back to 10 byte when the second value * is measured, so that's not sufficient to @@ -297,10 +300,12 @@ static void decode_rs_18(guchar rs, struct dev_context *devc) } } -/** Decode special chars, Metrahit 18. - * \param[in] spc Special characters 1 and 2 (s1 | (s2<<4)). +/** + * Decode special chars, Metrahit 18. + * + * @param[in] spc Special characters 1 and 2 (s1 | (s2 << 4)). */ -static void decode_spc_18(guchar spc, struct dev_context *devc) +static void decode_spc_18(uint8_t spc, struct dev_context *devc) { /* xxxx1xxx ZERO */ /* xxxxx1xx BEEP */ @@ -310,8 +315,7 @@ static void decode_spc_18(guchar spc, struct dev_context *devc) if (devc->mq == SR_MQ_TIME) { /* xxx1xxxx Clock running: 1; stop: 0 */ sr_spew("Clock running: %d", spc >> 4); - } - else { + } else { /* 1xxxxxxx MAN */ setmqf(devc, SR_MQFLAG_AUTORANGE, !(spc & 0x80)); @@ -326,13 +330,15 @@ static void decode_spc_18(guchar spc, struct dev_context *devc) } } -/** Decode current type and measured value, Metrahit 2x. - * \param[in] ctmv Current type and measured value (v1 | (v2<<4)). +/** + * Decode current type and measured value, Metrahit 2x. + * + * @param[in] ctmv Current type and measured value (v1 | (v2 << 4)). */ -static void decode_ctmv_2x(guchar ctmv, struct dev_context *devc) +static void decode_ctmv_2x(uint8_t ctmv, struct dev_context *devc) { if ((ctmv > 0x1c) || (!devc)) { - sr_err("decode_ct_mv_2x(%d): invalid param(s)!", ctmv); + sr_err("decode_ctmv_2x(%d): invalid param(s)!", ctmv); return; } @@ -351,7 +357,7 @@ static void decode_ctmv_2x(guchar ctmv, struct dev_context *devc) devc->mqflags |= SR_MQFLAG_DC; if (ctmv >= 0x02) { devc->mqflags |= SR_MQFLAG_AC; - if (devc->model >= SR_METRAHIT_24S) + if (devc->model >= METRAHIT_24S) devc->model |= SR_MQFLAG_RMS; } break; @@ -365,7 +371,7 @@ static void decode_ctmv_2x(guchar ctmv, struct dev_context *devc) devc->mqflags |= SR_MQFLAG_DC; if ((ctmv == 0x05) || (ctmv == 0x07)) { devc->mqflags |= SR_MQFLAG_AC; - if (devc->model >= SR_METRAHIT_24S) + if (devc->model >= METRAHIT_24S) devc->mqflags |= SR_MQFLAG_RMS; } break; @@ -404,8 +410,7 @@ static void decode_ctmv_2x(guchar ctmv, struct dev_context *devc) devc->mq = SR_MQ_VOLTAGE; devc->mqflags |= SR_MQFLAG_DIODE; devc->scale *= 0.1; - } - else { + } else { devc->mq = SR_MQ_CONTINUITY; devc->scale *= 0.00001; } @@ -466,15 +471,18 @@ static void decode_ctmv_2x(guchar ctmv, struct dev_context *devc) break; default: sr_err("decode_ctmv_2x(%d, ...): Unknown ctmv!"); + break; } } -/** Decode range/sign/acdc byte special chars, Metrahit 2x. - * \param[in] rs Rance/sign byte +/** + * Decode range/sign/acdc byte special chars, Metrahit 2x. + * + * @param[in] rs Rance/sign byte. */ -static void decode_rs_2x(guchar rs, struct dev_context *devc) +static void decode_rs_2x(uint8_t rs, struct dev_context *devc) { - int range; + int range; /* Sign */ if (((devc->scale > 0) && (rs & 0x08)) || @@ -485,9 +493,8 @@ static void decode_rs_2x(guchar rs, struct dev_context *devc) range = rs & 0x07; switch (devc->mq) { case SR_MQ_VOLTAGE: - if (devc->unit == SR_UNIT_DECIBEL_VOLT) { + if (devc->unit == SR_UNIT_DECIBEL_VOLT) devc->scale *= pow(10.0, -3); - } else if (devc->vmains_29S) devc->scale *= pow(10.0, range - 2); else if(devc->mqflags & SR_MQFLAG_AC) @@ -509,10 +516,8 @@ static void decode_rs_2x(guchar rs, struct dev_context *devc) devc->scale *= pow(10.0, range - 3); break; case SR_MQ_TEMPERATURE: - if (range == 4) { /* Indicator for °F */ + if (range == 4) /* Indicator for °F */ devc->unit = SR_UNIT_FAHRENHEIT; - } - devc->scale *= pow(10.0, - 2); break; case SR_MQ_CAPACITANCE: @@ -522,10 +527,12 @@ static void decode_rs_2x(guchar rs, struct dev_context *devc) } } -/** Decode special chars (Metrahit 2x). - * \param[in] spc Special characters 1 and 2 (s1 | (s2<<4)). +/** + * Decode special chars (Metrahit 2x). + * + * @param[in] spc Special characters 1 and 2 (s1 | (s2 << 4)). */ -static void decode_spc_2x(guchar spc, struct dev_context *devc) +static void decode_spc_2x(uint8_t spc, struct dev_context *devc) { /* xxxxxxx1 Fuse */ @@ -591,20 +598,18 @@ static void process_msg_dta_6(struct sr_dev_inst *sdi) { struct dev_context *devc; int cnt; - guchar dgt; + uint8_t dgt; devc = sdi->priv; clean_rs_v(devc); /* Byte 0, range and sign */ - if (devc->model <= SR_METRAHIT_16X) { + if (devc->model <= METRAHIT_16X) decode_rs_16(bc(devc->buf[0]), devc); - } - else if (devc->model < SR_METRAHIT_2X){ + else if (devc->model < METRAHIT_2X) decode_rs_18(bc(devc->buf[0]), devc); - } else { + else decode_rs_2x(bc(devc->buf[0]), devc); - } /* Bytes 1-5, digits (ls first). */ for (cnt = 0; cnt < 5; cnt++) { @@ -637,25 +642,22 @@ static void process_msg_inf_5(struct sr_dev_inst *sdi) clean_ctmv_rs_v(devc); /* Process byte 0 */ - model = sr_gmc_decode_model_sm(bc(devc->buf[0])); + model = gmc_decode_model_sm(bc(devc->buf[0])); if (model != devc->model) { sr_warn("Model mismatch in data: Detected %s, now %s", - sr_gmc_model_str(devc->model), - sr_gmc_model_str(model)); + gmc_model_str(devc->model), gmc_model_str(model)); } /* Process bytes 1-4 */ - if (devc->model <= SR_METRAHIT_16X) { + if (devc->model <= METRAHIT_16X) { decode_ctmv_16(bc(devc->buf[1]), devc); decode_spc_16(bc(devc->buf[2]) | (bc(devc->buf[3]) << 4), devc); decode_rs_16(bc(devc->buf[4]), devc); - } - else if (devc->model <= SR_METRAHIT_18S) { + } else if (devc->model <= METRAHIT_18S) { decode_ctmv_18(bc(devc->buf[1]), devc); decode_spc_18(bc(devc->buf[2]) | (bc(devc->buf[3]) << 4), devc); decode_rs_18(bc(devc->buf[4]), devc); - } - else { /* Must be Metrahit 2x */ + } else { /* Must be Metrahit 2x */ decode_ctmv_2x(bc(devc->buf[1]), devc); decode_spc_2x(bc(devc->buf[2]) | (bc(devc->buf[3]) << 4), devc); decode_rs_2x(bc(devc->buf[4]), devc); @@ -667,7 +669,7 @@ static void process_msg_inf_10(struct sr_dev_inst *sdi) { struct dev_context *devc; int cnt; - guchar dgt; + uint8_t dgt; devc = sdi->priv; @@ -694,26 +696,43 @@ static void process_msg_inf_10(struct sr_dev_inst *sdi) } /** Decode send interval (Metrahit 2x only). */ -static const char* decode_send_interval(guchar si) +static const char *decode_send_interval(uint8_t si) { switch (si) { - case 0x00: return "0.05"; - case 0x01: return "0.1"; - case 0x02: return "0.2"; - case 0x03: return "0.5"; - case 0x04: return "00:01"; - case 0x05: return "00:02"; - case 0x06: return "00:05"; - case 0x07: return "00:10"; - case 0x08: return "00:20"; - case 0x09: return "00:30"; - case 0x0a: return "01:00"; - case 0x0b: return "02:00"; - case 0x0c: return "05:00"; - case 0x0d: return "10:00"; - case 0x0e: return "----"; - case 0x0f: return "data"; - default: return "Unknown value"; + case 0x00: + return "0.05"; + case 0x01: + return "0.1"; + case 0x02: + return "0.2"; + case 0x03: + return "0.5"; + case 0x04: + return "00:01"; + case 0x05: + return "00:02"; + case 0x06: + return "00:05"; + case 0x07: + return "00:10"; + case 0x08: + return "00:20"; + case 0x09: + return "00:30"; + case 0x0a: + return "01:00"; + case 0x0b: + return "02:00"; + case 0x0c: + return "05:00"; + case 0x0d: + return "10:00"; + case 0x0e: + return "----"; + case 0x0f: + return "data"; + default: + return "Unknown value"; } } @@ -723,18 +742,17 @@ static void process_msg_inf_13(struct sr_dev_inst *sdi) struct dev_context *devc; enum model model; int cnt; - guchar dgt; + uint8_t dgt; devc = sdi->priv; clean_ctmv_rs_v(devc); /* Byte 0, model. */ - model = sr_gmc_decode_model_sm(bc(devc->buf[0])); + model = gmc_decode_model_sm(bc(devc->buf[0])); if (model != devc->model) { sr_warn("Model mismatch in data: Detected %s, now %s", - sr_gmc_model_str(devc->model), - sr_gmc_model_str(model)); + gmc_model_str(devc->model), gmc_model_str(model)); } /* Bytes 1-4, 11. */ @@ -765,14 +783,14 @@ static void process_msg_inf_13(struct sr_dev_inst *sdi) send_value(sdi); } - SR_PRIV int gmc_mh_1x_2x_receive_data(int fd, int revents, void *cb_data) { struct sr_dev_inst *sdi; struct dev_context *devc; struct sr_serial_dev_inst *serial; - unsigned char buf, msgt; + uint8_t buf, msgt; int len; + gdouble elapsed_s; (void)fd; @@ -793,8 +811,10 @@ SR_PRIV int gmc_mh_1x_2x_receive_data(int fd, int revents, void *cb_data) sr_spew("read 0x%02x/%d/%d", buf, buf, buf & MSGC_MASK); devc->buflen += len; if (!devc->settings_ok) { - /* If no device type/settings record processed - * yet, wait for one. */ + /* + * If no device type/settings record processed + * yet, wait for one. + */ if ((devc->buf[0] & MSGID_MASK) != MSGID_INF) { devc->buflen = 0; continue; @@ -809,20 +829,22 @@ SR_PRIV int gmc_mh_1x_2x_receive_data(int fd, int revents, void *cb_data) process_msg_inf_13(sdi); devc->buflen = 0; continue; - } - else if ((devc->buflen == 10) && - (devc->model <= SR_METRAHIT_18S)) { + } else if ((devc->buflen == 10) && + (devc->model <= METRAHIT_18S)) { process_msg_inf_10(sdi); devc->buflen = 0; continue; } else if ((devc->buflen >= 5) && - (devc->buf[devc->buflen-1] & + (devc->buf[devc->buflen - 1] & MSGID_MASK) != MSGID_DATA) { - /* Char just received is beginning - * of next message */ + /* + * Char just received is beginning + * of next message. + */ process_msg_inf_5(sdi); - devc->buf[0] =devc->buf[devc->buflen-1]; + devc->buf[0] = + devc->buf[devc->buflen - 1]; devc->buflen = 1; continue; } @@ -843,117 +865,123 @@ SR_PRIV int gmc_mh_1x_2x_receive_data(int fd, int revents, void *cb_data) } /* If number of samples or time limit reached, stop aquisition. */ - if (devc->limit_samples && (devc->num_samples >= devc->limit_samples)) { + if (devc->limit_samples && (devc->num_samples >= devc->limit_samples)) sdi->driver->dev_acquisition_stop(sdi, cb_data); - } if (devc->limit_msec) { - gdouble elapsed_s = g_timer_elapsed(devc->elapsed_msec, NULL); - if ((elapsed_s * 1000) >= devc->limit_msec) { + elapsed_s = g_timer_elapsed(devc->elapsed_msec, NULL); + if ((elapsed_s * 1000) >= devc->limit_msec) sdi->driver->dev_acquisition_stop(sdi, cb_data); - } } return TRUE; } - -/** Decode model in "send mode" */ -SR_PRIV int sr_gmc_decode_model_sm(guchar mcode) +/** Decode model in "send mode". */ +SR_PRIV int gmc_decode_model_sm(uint8_t mcode) { if (mcode > 0xf) { sr_err("decode_model(%d): Model code 0..15 expected!", mcode); - return SR_METRAHIT_NONE; + return METRAHIT_NONE; } switch(mcode) { - case 0x04: /* 0100b */ - return SR_METRAHIT_12S; - case 0x08: /* 1000b */ - return SR_METRAHIT_13S14A; - case 0x09: /* 1001b */ - return SR_METRAHIT_14S; - case 0x0A: /* 1010b */ - return SR_METRAHIT_15S; - case 0x0B: /* 1011b */ - return SR_METRAHIT_16S; - case 0x06: /* 0110b (undocumented by GMC!) */ - return SR_METRAHIT_16I; - case 0x0D: /* 1101b */ - return SR_METRAHIT_18S; - case 0x02: /* 0010b */ - return SR_METRAHIT_22SM; - case 0x03: /* 0011b */ - return SR_METRAHIT_23S; - case 0x0f: /* 1111b */ - return SR_METRAHIT_24S; - case 0x05: /* 0101b */ - return SR_METRAHIT_25SM; - case 0x01: /* 0001b */ - return SR_METRAHIT_26S; - case 0x0c: /* 1100b */ - return SR_METRAHIT_28S; - case 0x0e: /* 1110b */ - return SR_METRAHIT_29S; + case 0x04: /* 0100b */ + return METRAHIT_12S; + case 0x08: /* 1000b */ + return METRAHIT_13S14A; + case 0x09: /* 1001b */ + return METRAHIT_14S; + case 0x0A: /* 1010b */ + return METRAHIT_15S; + case 0x0B: /* 1011b */ + return METRAHIT_16S; + case 0x06: /* 0110b (undocumented by GMC!) */ + return METRAHIT_16I; + case 0x0D: /* 1101b */ + return METRAHIT_18S; + case 0x02: /* 0010b */ + return METRAHIT_22SM; + case 0x03: /* 0011b */ + return METRAHIT_23S; + case 0x0f: /* 1111b */ + return METRAHIT_24S; + case 0x05: /* 0101b */ + return METRAHIT_25SM; + case 0x01: /* 0001b */ + return METRAHIT_26S; + case 0x0c: /* 1100b */ + return METRAHIT_28S; + case 0x0e: /* 1110b */ + return METRAHIT_29S; default: sr_err("Unknown model code %d!", mcode); - return SR_METRAHIT_NONE; + return METRAHIT_NONE; } } -/** Decode model in bidirectional mode. - \param[in] mcode Model code. - - \return Model code -*/ -SR_PRIV int sr_gmc_decode_model_bidi(guchar mcode) +/** + * Decode model in bidirectional mode. + * + * @param[in] mcode Model code. + * + * @return Model code. + */ +SR_PRIV int gmc_decode_model_bidi(uint8_t mcode) { - switch(mcode) { - case 2: return SR_METRAHIT_22SM; - case 3: return SR_METRAHIT_23S; - case 4: return SR_METRAHIT_24S; - case 5: return SR_METRAHIT_25SM; - case 1: return SR_METRAHIT_26S; - case 12: return SR_METRAHIT_28S; - case 14: return SR_METRAHIT_29S; + switch (mcode) { + case 2: + return METRAHIT_22SM; + case 3: + return METRAHIT_23S; + case 4: + return METRAHIT_24S; + case 5: + return METRAHIT_25SM; + case 1: + return METRAHIT_26S; + case 12: + return METRAHIT_28S; + case 14: + return METRAHIT_29S; default: sr_err("Unknown model code %d!", mcode); - return SR_METRAHIT_NONE; + return METRAHIT_NONE; } } -SR_PRIV const char* sr_gmc_model_str(enum model mcode) +SR_PRIV const char *gmc_model_str(enum model mcode) { switch (mcode) { - case SR_METRAHIT_NONE: + case METRAHIT_NONE: return "-uninitialized model variable-"; - case SR_METRAHIT_12S: + case METRAHIT_12S: return "METRAHit 12S"; - case SR_METRAHIT_13S14A: + case METRAHIT_13S14A: return "METRAHit 13S/14A"; - case SR_METRAHIT_14S: + case METRAHIT_14S: return "METRAHit 14S"; - case SR_METRAHIT_15S: + case METRAHIT_15S: return "METRAHit 15S"; - case SR_METRAHIT_16S: + case METRAHIT_16S: return "METRAHit 16S"; - case SR_METRAHIT_16I: + case METRAHIT_16I: return "METRAHit 16I"; - case SR_METRAHIT_18S: + case METRAHIT_18S: return "METRAHit 18S"; - case SR_METRAHIT_22SM: + case METRAHIT_22SM: return "METRAHit 22S/M"; - case SR_METRAHIT_23S: + case METRAHIT_23S: return "METRAHit 23S"; - case SR_METRAHIT_24S: + case METRAHIT_24S: return "METRAHit 24S"; - case SR_METRAHIT_25SM: + case METRAHIT_25SM: return "METRAHit 25S/M"; - case SR_METRAHIT_26S: + case METRAHIT_26S: return "METRAHit 26S"; - case SR_METRAHIT_28S: + case METRAHIT_28S: return "METRAHit 28S"; - case SR_METRAHIT_29S: + case METRAHIT_29S: return "METRAHit 29S"; default: return "Unknown model code";