X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=hardware%2Fcolead-slm%2Fprotocol.c;h=d14a382bae8cbcec3f9db76691ae3be8a9a915b0;hb=365f04d61f54908013021be83450d38fff67964f;hp=b749646e9de87c414056f622d9eda637ff1ae658;hpb=4d729ddcaf395de1d04af93dd5ea569cfbc17de4;p=libsigrok.git diff --git a/hardware/colead-slm/protocol.c b/hardware/colead-slm/protocol.c index b749646e..d14a382b 100644 --- a/hardware/colead-slm/protocol.c +++ b/hardware/colead-slm/protocol.c @@ -22,11 +22,169 @@ #include "libsigrok.h" #include "libsigrok-internal.h" #include "protocol.h" +#include +#include + + +static void process_packet(const struct sr_dev_inst *sdi) +{ + struct dev_context *devc; + struct sr_datafeed_packet packet; + struct sr_datafeed_analog analog; + GString *dbg; + float fvalue; + int checksum, mode, i; + + devc = sdi->priv; + if (sr_log_loglevel_get() >= SR_LOG_SPEW) { + dbg = g_string_sized_new(128); + g_string_printf(dbg, "received packet:"); + for (i = 0; i < 10; i++) + g_string_append_printf(dbg, " %.2x", (devc->buf)[i]); + sr_spew("%s", dbg->str); + g_string_free(dbg, TRUE); + } + + if (devc->buf[0] != 0x08 || devc->buf[1] != 0x04) { + sr_dbg("invalid packet header."); + return; + } + + if (devc->buf[8] != 0x01) { + sr_dbg("invalid measurement."); + return; + } + + checksum = 0; + for (i = 0; i < 9; i++) + checksum += devc->buf[i]; + if ((checksum & 0xff) != devc->buf[9]) { + sr_dbg("invalid packet checksum."); + return; + } + + fvalue = 0.0; + for (i = 3; i < 8; i++) { + if (devc->buf[i] > 0x09) + continue; + fvalue *= 10; + fvalue += devc->buf[i]; + } + fvalue /= 10; + + memset(&analog, 0, sizeof(struct sr_datafeed_analog)); + analog.mq = SR_MQ_SOUND_PRESSURE_LEVEL; + analog.unit = SR_UNIT_DECIBEL_SPL; + analog.probes = sdi->probes; + analog.num_samples = 1; + analog.data = &fvalue; + + /* High nibble should only have 0x01 or 0x02. */ + mode = (devc->buf[2] >> 4) & 0x0f; + if (mode == 0x02) + analog.mqflags |= SR_MQFLAG_HOLD; + else if (mode != 0x01) { + sr_dbg("unknown measurement mode 0x%.2x", mode); + return; + } + + /* Low nibble has 14 combinations of direct/long-term average, + * time scale of that average, frequency weighting, and time + * weighting. */ + mode = devc->buf[2] & 0x0f; + switch (mode) { + case 0x0: + analog.mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_A \ + | SR_MQFLAG_SPL_TIME_WEIGHT_F; + break; + case 0x1: + analog.mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_A \ + | SR_MQFLAG_SPL_TIME_WEIGHT_S; + break; + case 0x2: + analog.mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_C \ + | SR_MQFLAG_SPL_TIME_WEIGHT_F; + break; + case 0x3: + analog.mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_C \ + | SR_MQFLAG_SPL_TIME_WEIGHT_S; + break; + case 0x4: + analog.mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_FLAT \ + | SR_MQFLAG_SPL_TIME_WEIGHT_F; + break; + case 0x5: + analog.mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_FLAT \ + | SR_MQFLAG_SPL_TIME_WEIGHT_S; + break; + case 0x6: + analog.mqflags |= SR_MQFLAG_SPL_PCT_OVER_ALARM \ + | SR_MQFLAG_SPL_FREQ_WEIGHT_A \ + | SR_MQFLAG_SPL_TIME_WEIGHT_F; + break; + case 0x7: + analog.mqflags |= SR_MQFLAG_SPL_PCT_OVER_ALARM \ + | SR_MQFLAG_SPL_FREQ_WEIGHT_A \ + | SR_MQFLAG_SPL_TIME_WEIGHT_S; + break; + case 0x8: + /* 10-second mean, but we don't have MQ flags to express it. */ + analog.mqflags |= SR_MQFLAG_SPL_LAT \ + | SR_MQFLAG_SPL_FREQ_WEIGHT_A \ + | SR_MQFLAG_SPL_TIME_WEIGHT_F; + break; + case 0x9: + /* Mean over a time period between 11 seconds and 24 hours. + * Which is so silly that there's no point in expressing + * either this or the previous case. */ + analog.mqflags |= SR_MQFLAG_SPL_LAT \ + | SR_MQFLAG_SPL_FREQ_WEIGHT_A \ + | SR_MQFLAG_SPL_TIME_WEIGHT_F; + break; + case 0xa: + /* 10-second mean. */ + analog.mqflags |= SR_MQFLAG_SPL_LAT \ + | SR_MQFLAG_SPL_FREQ_WEIGHT_A \ + | SR_MQFLAG_SPL_TIME_WEIGHT_S; + break; + case 0xb: + /* Mean over a time period between 11 seconds and 24 hours. */ + analog.mqflags |= SR_MQFLAG_SPL_LAT \ + | SR_MQFLAG_SPL_FREQ_WEIGHT_A \ + | SR_MQFLAG_SPL_TIME_WEIGHT_S; + break; + case 0xc: + /* Internal calibration on 1kHz sine at 94dB, not useful + * to anything but the device. */ + analog.mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_FLAT; + break; + case 0xd: + /* Internal calibration on 1kHz sine at 94dB, not useful + * to anything but the device. */ + analog.mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_FLAT; + break; + default: + sr_dbg("unknown configuration 0x%.2x", mode); + return; + break; + } + + packet.type = SR_DF_ANALOG; + packet.payload = &analog; + sr_session_send(devc->cb_data, &packet); + + devc->num_samples++; + +} SR_PRIV int colead_slm_receive_data(int fd, int revents, void *cb_data) { const struct sr_dev_inst *sdi; struct dev_context *devc; + int len; + char buf[128]; + + (void)fd; if (!(sdi = cb_data)) return TRUE; @@ -34,9 +192,42 @@ SR_PRIV int colead_slm_receive_data(int fd, int revents, void *cb_data) if (!(devc = sdi->priv)) return TRUE; - if (revents == G_IO_IN) { - /* TODO */ + if (revents != G_IO_IN) + /* Timeout event. */ + return TRUE; + + if (devc->state == IDLE) { + if (serial_read(devc->serial, buf, 128) != 1 || buf[0] != 0x10) + /* Nothing there, or caught the tail end of a previous packet, + * or some garbage. Unless it's a single "data ready" byte, + * we don't want it. */ + return TRUE; + /* Got 0x10, "measurement ready". */ + if (serial_write(devc->serial, "\x20", 1) == -1) + sr_err("unable to send command: %s", strerror(errno)); + else { + devc->state = COMMAND_SENT; + devc->buflen = 0; + } + } else { + len = serial_read(devc->serial, devc->buf + devc->buflen, + 10 - devc->buflen); + if (len < 1) + return TRUE; + devc->buflen += len; + if (devc->buflen > 10) { + sr_dbg("buffer overrun"); + devc->state = IDLE; + return TRUE; + } + if (devc->buflen == 10) { + /* If we got here, we're sure the device sent a "data ready" + * notification, we asked for data, and got it. */ + process_packet(sdi); + devc->state = IDLE; + } } return TRUE; } +