X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Fmotech-lps-30x%2Fprotocol.c;h=b31f2ee1d33ad83bcf48f33e8881a32f55290f4b;hb=f6129c8f0c92e45de5d70b4101bf2bd759a5fdf7;hp=751d2d261a3df742033922916fbb68557571808b;hpb=7237e91262251a138cf150f9fcfe7b05d0e5904b;p=libsigrok.git diff --git a/src/hardware/motech-lps-30x/protocol.c b/src/hardware/motech-lps-30x/protocol.c index 751d2d26..b31f2ee1 100644 --- a/src/hardware/motech-lps-30x/protocol.c +++ b/src/hardware/motech-lps-30x/protocol.c @@ -18,11 +18,7 @@ * along with this program. If not, see . */ -/** @file - * Motech LPS-30x series power supply driver - * @internal - */ - +#include #include #include #include "protocol.h" @@ -33,32 +29,43 @@ static void send_data(struct sr_dev_inst *sdi) struct dev_context *devc; struct sr_datafeed_packet packet; 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; 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); - devc->num_samples++; + sr_sw_limits_update_samples_read(&devc->limits, 1); } /** Process a complete line (without CR/LF) in buf. */ @@ -69,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... */ @@ -80,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)); @@ -139,7 +150,6 @@ SR_PRIV int motech_lps_30x_receive_data(int fd, int revents, void *cb_data) struct dev_context *devc; struct sr_serial_dev_inst *serial; int len; - gdouble elapsed_s; (void)fd; @@ -178,24 +188,18 @@ SR_PRIV int motech_lps_30x_receive_data(int fd, int revents, void *cb_data) } } - /* If number of samples or time limit reached, stop acquisition. */ - if (devc->limit_samples && (devc->num_samples >= devc->limit_samples)) - sdi->driver->dev_acquisition_stop(sdi, cb_data); - - if (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); - } + if (sr_sw_limits_check(&devc->limits)) + sr_dev_acquisition_stop(sdi); /* Only request the next packet if required. */ if (!((sdi->status == SR_ST_ACTIVE) && (devc->acq_running))) return TRUE; if (devc->acq_req_pending) { - gint64 elapsed_us = g_get_monotonic_time() - devc->req_sent_at; + int64_t elapsed_us = g_get_monotonic_time() - devc->req_sent_at; if (elapsed_us > (REQ_TIMEOUT_MS * 1000)) { - sr_spew("Request timeout: req=%d t=%lldus", (int)devc->acq_req, elapsed_us); + sr_spew("Request timeout: req=%d t=%" PRIi64 "us", + (int)devc->acq_req, elapsed_us); devc->acq_req_pending = 0; } }