X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Flascar-el-usb%2Fprotocol.c;h=44f4be82f350cca5d1e33b4d03c5c5fef8cb3a20;hb=3782e57129fa661a773be337c9f548708f593eb0;hp=1b6a0ad55e5ddf60992a72607d0323129fff1efd;hpb=bee2b0168c087676c1b365861d8c2d4714afa9b9;p=libsigrok.git diff --git a/src/hardware/lascar-el-usb/protocol.c b/src/hardware/lascar-el-usb/protocol.c index 1b6a0ad5..44f4be82 100644 --- a/src/hardware/lascar-el-usb/protocol.c +++ b/src/hardware/lascar-el-usb/protocol.c @@ -298,51 +298,53 @@ static struct sr_dev_inst *lascar_identify(unsigned char *config) modelid = config[0]; sdi = NULL; - if (modelid) { - profile = NULL; - for (i = 0; profiles[i].modelid; i++) { - if (profiles[i].modelid == modelid) { - profile = &profiles[i]; - break; - } - } - if (!profile) { - sr_dbg("unknown EL-USB modelid %d", modelid); - return NULL; - } - i = config[52] | (config[53] << 8); - memcpy(firmware, config + 0x30, 4); - firmware[4] = '\0'; - sr_dbg("found %s with firmware version %s serial %d", - profile->modelname, firmware, i); + if (!modelid) + return sdi; - if (profile->logformat == LOG_UNSUPPORTED) { - sr_dbg("unsupported EL-USB logformat for %s", profile->modelname); - return NULL; + profile = NULL; + for (i = 0; profiles[i].modelid; i++) { + if (profiles[i].modelid == modelid) { + profile = &profiles[i]; + break; } + } + if (!profile) { + sr_dbg("unknown EL-USB modelid %d", modelid); + return NULL; + } - sdi = g_malloc0(sizeof(struct sr_dev_inst)); - sdi->status = SR_ST_INACTIVE; - sdi->vendor = g_strdup(LASCAR_VENDOR); - sdi->model = g_strdup(profile->modelname); - sdi->version = g_strdup(firmware); - - if (profile->logformat == LOG_TEMP_RH) { - /* Model this as two channels: temperature and humidity. */ - sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "Temp"); - sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "Hum"); - } else if (profile->logformat == LOG_CO) { - sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "CO"); - } else { - sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "P1"); - } + i = config[52] | (config[53] << 8); + memcpy(firmware, config + 0x30, 4); + firmware[4] = '\0'; + sr_dbg("found %s with firmware version %s serial %d", + profile->modelname, firmware, i); - devc = g_malloc0(sizeof(struct dev_context)); - sdi->priv = devc; - devc->profile = profile; + if (profile->logformat == LOG_UNSUPPORTED) { + sr_dbg("unsupported EL-USB logformat for %s", profile->modelname); + return NULL; + } + + sdi = g_malloc0(sizeof(struct sr_dev_inst)); + sdi->status = SR_ST_INACTIVE; + sdi->vendor = g_strdup("Lascar"); + sdi->model = g_strdup(profile->modelname); + sdi->version = g_strdup(firmware); + + if (profile->logformat == LOG_TEMP_RH) { + /* Model this as two channels: temperature and humidity. */ + sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "Temp"); + sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "Hum"); + } else if (profile->logformat == LOG_CO) { + sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "CO"); + } else { + sr_channel_new(sdi, 0, SR_CHANNEL_ANALOG, TRUE, "P1"); } + devc = g_malloc0(sizeof(struct dev_context)); + sdi->priv = devc; + devc->profile = profile; + return sdi; } @@ -387,7 +389,10 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, { struct dev_context *devc; struct sr_datafeed_packet packet; - struct sr_datafeed_analog_old analog; + struct sr_datafeed_analog analog; + struct sr_analog_encoding encoding; + struct sr_analog_meaning meaning; + struct sr_analog_spec spec; struct sr_channel *ch; float *temp, *rh; uint16_t s; @@ -395,15 +400,18 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, devc = sdi->priv; + /* Note: digits/spec_digits will be overridden later. */ + sr_analog_init(&analog, &encoding, &meaning, &spec, 0); + samples = buflen / devc->sample_size; samples_left = devc->logged_samples - devc->rcvd_samples; if (samples_left < samples) samples = samples_left; switch (devc->profile->logformat) { case LOG_TEMP_RH: - packet.type = SR_DF_ANALOG_OLD; + packet.type = SR_DF_ANALOG; packet.payload = &analog; - analog.mqflags = 0; + analog.meaning->mqflags = 0; if (!(temp = g_try_malloc(sizeof(float) * samples))) break; if (!(rh = g_try_malloc(sizeof(float) * samples))) @@ -427,45 +435,52 @@ static void lascar_el_usb_dispatch(struct sr_dev_inst *sdi, unsigned char *buf, ch = sdi->channels->data; if (ch->enabled) { - analog.channels = g_slist_append(NULL, ch); - analog.mq = SR_MQ_TEMPERATURE; - if (devc->temp_unit == 1) - analog.unit = SR_UNIT_FAHRENHEIT; - else - analog.unit = SR_UNIT_CELSIUS; - analog.data = temp; + analog.meaning->channels = g_slist_append(NULL, ch); + analog.meaning->mq = SR_MQ_TEMPERATURE; + if (devc->temp_unit == 1) { + analog.meaning->unit = SR_UNIT_FAHRENHEIT; + analog.encoding->digits = 0; + analog.spec->spec_digits = 0; + } else { + analog.meaning->unit = SR_UNIT_CELSIUS; + analog.encoding->digits = 1; + analog.spec->spec_digits = 1; + } + analog.data = (void *)temp; sr_session_send(sdi, &packet); - g_slist_free(analog.channels); + g_slist_free(analog.meaning->channels); } ch = sdi->channels->next->data; if (ch->enabled) { - analog.channels = g_slist_append(NULL, ch); - analog.mq = SR_MQ_RELATIVE_HUMIDITY; - analog.unit = SR_UNIT_PERCENTAGE; - analog.data = rh; + analog.meaning->channels = g_slist_append(NULL, ch); + analog.meaning->mq = SR_MQ_RELATIVE_HUMIDITY; + analog.meaning->unit = SR_UNIT_PERCENTAGE; + analog.encoding->digits = 1; + analog.spec->spec_digits = 1; + analog.data = (void *)rh; sr_session_send(sdi, &packet); - g_slist_free(analog.channels); + g_slist_free(analog.meaning->channels); } g_free(temp); g_free(rh); break; case LOG_CO: - packet.type = SR_DF_ANALOG_OLD; + packet.type = SR_DF_ANALOG; packet.payload = &analog; - analog.channels = sdi->channels; + analog.meaning->channels = sdi->channels; analog.num_samples = samples; - analog.mq = SR_MQ_CARBON_MONOXIDE; - analog.unit = SR_UNIT_CONCENTRATION; - analog.mqflags = 0; + analog.meaning->mq = SR_MQ_CARBON_MONOXIDE; + analog.meaning->unit = SR_UNIT_CONCENTRATION; + analog.meaning->mqflags = 0; if (!(analog.data = g_try_malloc(sizeof(float) * samples))) break; for (i = 0; i < samples; i++) { s = (buf[i * 2] << 8) | buf[i * 2 + 1]; - analog.data[i] = (s * devc->co_high + devc->co_low) / (1000 * 1000); - if (analog.data[i] < 0.0) - analog.data[i] = 0.0; + ((float *)analog.data)[i] = (s * devc->co_high + devc->co_low) / (1000 * 1000); + if (((float *)analog.data)[i] < 0.0) + ((float *)analog.data)[i] = 0.0; } sr_session_send(sdi, &packet); g_free(analog.data); @@ -515,7 +530,7 @@ SR_PRIV void LIBUSB_CALL lascar_el_usb_receive_transfer(struct libusb_transfer * switch (transfer->status) { case LIBUSB_TRANSFER_NO_DEVICE: /* USB device was unplugged. */ - dev_acquisition_stop(sdi); + sr_dev_acquisition_stop(sdi); return; case LIBUSB_TRANSFER_COMPLETED: case LIBUSB_TRANSFER_TIMED_OUT: /* We may have received some data though */ @@ -534,7 +549,7 @@ SR_PRIV void LIBUSB_CALL lascar_el_usb_receive_transfer(struct libusb_transfer * devc->rcvd_bytes, devc->log_size, devc->rcvd_samples, devc->logged_samples); if (devc->rcvd_bytes >= devc->log_size) - dev_acquisition_stop(sdi); + sr_dev_acquisition_stop(sdi); } if (sdi->status == SR_ST_ACTIVE) { @@ -544,7 +559,7 @@ SR_PRIV void LIBUSB_CALL lascar_el_usb_receive_transfer(struct libusb_transfer * libusb_error_name(ret)); g_free(transfer->buffer); libusb_free_transfer(transfer); - dev_acquisition_stop(sdi); + sr_dev_acquisition_stop(sdi); } } else { /* This was the last transfer we're going to receive, so