X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Fmotech-lps-30x%2Fprotocol.c;h=b31f2ee1d33ad83bcf48f33e8881a32f55290f4b;hb=a4be2b327be8b6a38fe024e2a3ee614243067762;hp=1a3c75dc591954cbd4a4dfeec3ad0b917063fabc;hpb=8aafc5e64d60ef5e91992707a8f4dbce03e901a0;p=libsigrok.git diff --git a/src/hardware/motech-lps-30x/protocol.c b/src/hardware/motech-lps-30x/protocol.c index 1a3c75dc..b31f2ee1 100644 --- a/src/hardware/motech-lps-30x/protocol.c +++ b/src/hardware/motech-lps-30x/protocol.c @@ -18,11 +18,6 @@ * along with this program. If not, see . */ -/** @file - * Motech LPS-30x series power supply driver - * @internal - */ - #include #include #include @@ -33,30 +28,41 @@ static void send_data(struct sr_dev_inst *sdi) { 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; int i; float data[MAX_CHANNELS]; devc = sdi->priv; - packet.type = SR_DF_ANALOG_OLD; + packet.type = SR_DF_ANALOG; packet.payload = &analog; - analog.channels = sdi->channels; - analog.num_samples = 1; - analog.mq = SR_MQ_VOLTAGE; - analog.unit = SR_UNIT_VOLT; - analog.mqflags = SR_MQFLAG_DC; + /* Note: digits/spec_digits will be overridden later. */ + sr_analog_init(&analog, &encoding, &meaning, &spec, 0); + + analog.meaning->channels = sdi->channels; + analog.num_samples = 1; + analog.meaning->mq = SR_MQ_VOLTAGE; + analog.meaning->unit = SR_UNIT_VOLT; + analog.meaning->mqflags = SR_MQFLAG_DC; + analog.encoding->digits = 3; + analog.spec->spec_digits = 2; analog.data = data; + for (i = 0; i < devc->model->num_channels; i++) - analog.data[i] = devc->channel_status[i].output_voltage_last; /* Value always 3.3 or 5 for channel 3, if present! */ + ((float *)analog.data)[i] = devc->channel_status[i].output_voltage_last; /* Value always 3.3 or 5 for channel 3, if present! */ sr_session_send(sdi, &packet); - analog.mq = SR_MQ_CURRENT; - analog.unit = SR_UNIT_AMPERE; - analog.mqflags = 0; + analog.meaning->mq = SR_MQ_CURRENT; + analog.meaning->unit = SR_UNIT_AMPERE; + analog.meaning->mqflags = 0; + analog.encoding->digits = 4; + analog.spec->spec_digits = 3; analog.data = data; for (i = 0; i < devc->model->num_channels; i++) - analog.data[i] = devc->channel_status[i].output_current_last; /* Value always 0 for channel 3, if present! */ + ((float *)analog.data)[i] = devc->channel_status[i].output_current_last; /* Value always 0 for channel 3, if present! */ sr_session_send(sdi, &packet); sr_sw_limits_update_samples_read(&devc->limits, 1); @@ -70,6 +76,8 @@ static void process_line(struct sr_dev_inst *sdi) int auxint; devc = sdi->priv; + if (!devc) + return; switch (devc->acq_req_pending) { case 0: /* Should not happen... */ @@ -81,13 +89,15 @@ static void process_line(struct sr_dev_inst *sdi) case AQ_U2: case AQ_I1: case AQ_I2: - if (sr_atod(devc->buf, &dbl) != SR_OK) { + dbl = 0.0; + if (sr_atod_ascii(devc->buf, &dbl) != SR_OK) { sr_err("Failed to convert '%s' to double, errno=%d %s", devc->buf, errno, g_strerror(errno)); dbl = 0.0; } break; case AQ_STATUS: + auxint = 0; if (sr_atoi(devc->buf, &auxint) != SR_OK) { sr_err("Failed to convert '%s' to int, errno=%d %s", devc->buf, errno, g_strerror(errno)); @@ -179,7 +189,7 @@ SR_PRIV int motech_lps_30x_receive_data(int fd, int revents, void *cb_data) } if (sr_sw_limits_check(&devc->limits)) - sdi->driver->dev_acquisition_stop(sdi); + sr_dev_acquisition_stop(sdi); /* Only request the next packet if required. */ if (!((sdi->status == SR_ST_ACTIVE) && (devc->acq_running)))