X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Ftesto%2Fprotocol.c;h=def73d42b5d1e6376002e57658b17802518a9e4c;hb=8cd15dd4ce2fdbefbcc6e64632c8006e5404f253;hp=89f5bc9c2ff063383acb5c4f91285ae01d2f8a5e;hpb=a52e2a0b37a7615b289b813c19329193345b766a;p=libsigrok.git diff --git a/src/hardware/testo/protocol.c b/src/hardware/testo/protocol.c index 89f5bc9c..def73d42 100644 --- a/src/hardware/testo/protocol.c +++ b/src/hardware/testo/protocol.c @@ -27,26 +27,26 @@ SR_PRIV int testo_set_serial_params(struct sr_usb_dev_inst *usb) if ((ret = libusb_control_transfer(usb->devhdl, 0x40, FTDI_SET_BAUDRATE, FTDI_BAUDRATE_115200, FTDI_INDEX, NULL, 0, 10)) < 0) { - sr_err("Failed to set baudrate: %s", libusb_error_name(ret)); - return SR_ERR; + sr_err("Failed to set baudrate: %s", libusb_error_name(ret)); + return SR_ERR; } if ((ret = libusb_control_transfer(usb->devhdl, 0x40, FTDI_SET_PARAMS, FTDI_PARAMS_8N1, FTDI_INDEX, NULL, 0, 10)) < 0) { - sr_err("Failed to set comm parameters: %s", libusb_error_name(ret)); - return SR_ERR; + sr_err("Failed to set comm parameters: %s", libusb_error_name(ret)); + return SR_ERR; } if ((ret = libusb_control_transfer(usb->devhdl, 0x40, FTDI_SET_FLOWCTRL, FTDI_FLOW_NONE, FTDI_INDEX, NULL, 0, 10)) < 0) { - sr_err("Failed to set flow control: %s", libusb_error_name(ret)); - return SR_ERR; + sr_err("Failed to set flow control: %s", libusb_error_name(ret)); + return SR_ERR; } if ((ret = libusb_control_transfer(usb->devhdl, 0x40, FTDI_SET_MODEMCTRL, FTDI_MODEM_ALLHIGH, FTDI_INDEX, NULL, 0, 10)) < 0) { - sr_err("Failed to set modem control: %s", libusb_error_name(ret)); - return SR_ERR; + sr_err("Failed to set modem control: %s", libusb_error_name(ret)); + return SR_ERR; } return SR_OK; @@ -67,7 +67,7 @@ SR_PRIV int testo_probe_channels(struct sr_dev_inst *sdi) usb = sdi->conn; sr_dbg("Probing for channels."); - if (sdi->driver->dev_open(sdi) != SR_OK) + if (sr_dev_open(sdi) != SR_OK) return SR_ERR; if (testo_set_serial_params(usb) != SR_OK) return SR_ERR; @@ -108,7 +108,7 @@ SR_PRIV int testo_probe_channels(struct sr_dev_inst *sdi) /* Got a complete packet. */ break; } - sdi->driver->dev_close(sdi); + sr_dev_close(sdi); if (packet[6] > MAX_CHANNELS) { sr_err("Device says it has %d channels!", packet[6]); @@ -158,7 +158,7 @@ SR_PRIV int testo_request_packet(const struct sr_dev_inst *sdi) receive_transfer, (void *)sdi, 100); if ((ret = libusb_submit_transfer(devc->out_transfer) != 0)) { sr_err("Failed to request packet: %s.", libusb_error_name(ret)); - sdi->driver->dev_acquisition_stop((struct sr_dev_inst *)sdi); + sr_dev_acquisition_stop((struct sr_dev_inst *)sdi); return SR_ERR; } sr_dbg("Requested new packet."); @@ -170,8 +170,8 @@ SR_PRIV int testo_request_packet(const struct sr_dev_inst *sdi) * Testo 175/177/400/650/950/435/635/735/445/645/945/946/545. */ SR_PRIV gboolean testo_check_packet_prefix(unsigned char *buf, int len) { + static const unsigned char check[] = { 0x21, 0, 0, 0, 1 }; int i; - unsigned char check[] = { 0x21, 0, 0, 0, 1 }; if (len < 5) return FALSE; @@ -222,7 +222,10 @@ SR_PRIV void testo_receive_packet(const 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; struct sr_channel *ch; GString *dbg; float value; @@ -241,10 +244,12 @@ SR_PRIV void testo_receive_packet(const struct sr_dev_inst *sdi) g_string_free(dbg, TRUE); } - packet.type = SR_DF_ANALOG_OLD; + packet.type = SR_DF_ANALOG; packet.payload = &analog; + /* TODO: Use proper 'digits' value for this device (and its modes). */ + sr_analog_init(&analog, &encoding, &meaning, &spec, 2); analog.num_samples = 1; - analog.mqflags = 0; + analog.meaning->mqflags = 0; analog.data = &value; /* Decode 7-byte values */ for (i = 0; i < devc->reply[6]; i++) { @@ -252,20 +257,20 @@ SR_PRIV void testo_receive_packet(const struct sr_dev_inst *sdi) value = binary32_le_to_float(buf); switch (buf[4]) { case 1: - analog.mq = SR_MQ_TEMPERATURE; - analog.unit = SR_UNIT_CELSIUS; + analog.meaning->mq = SR_MQ_TEMPERATURE; + analog.meaning->unit = SR_UNIT_CELSIUS; break; case 3: - analog.mq = SR_MQ_RELATIVE_HUMIDITY; - analog.unit = SR_UNIT_HUMIDITY_293K; + analog.meaning->mq = SR_MQ_RELATIVE_HUMIDITY; + analog.meaning->unit = SR_UNIT_HUMIDITY_293K; break; case 5: - analog.mq = SR_MQ_WIND_SPEED; - analog.unit = SR_UNIT_METER_SECOND; + analog.meaning->mq = SR_MQ_WIND_SPEED; + analog.meaning->unit = SR_UNIT_METER_SECOND; break; case 24: - analog.mq = SR_MQ_PRESSURE; - analog.unit = SR_UNIT_HECTOPASCAL; + analog.meaning->mq = SR_MQ_PRESSURE; + analog.meaning->unit = SR_UNIT_HECTOPASCAL; break; default: sr_dbg("Unsupported measurement unit %d.", buf[4]); @@ -283,8 +288,8 @@ SR_PRIV void testo_receive_packet(const struct sr_dev_inst *sdi) return; } ch = g_slist_nth_data(sdi->channels, i); - analog.channels = g_slist_append(NULL, ch); + analog.meaning->channels = g_slist_append(NULL, ch); sr_session_send(sdi, &packet); - g_slist_free(analog.channels); + g_slist_free(analog.meaning->channels); } }