dslogic: Fixed voltage selection

[libsigrok.git] / src / hardware / dslogic / protocol.c

diff --git a/src/hardware/dslogic/protocol.c b/src/hardware/dslogic/protocol.c
index 76e82a97d151d97227e6901c30886e3e0860f2d9..85af9ba5c374af3379c429db0d4f49ebeff37da6 100644 (file)
--- a/src/hardware/dslogic/protocol.c
+++ b/src/hardware/dslogic/protocol.c
@@ -77,6 +77,30 @@ static int command_get_revid_version(struct sr_dev_inst *sdi, uint8_t *revid)
        return SR_OK;
 }
 
+SR_PRIV int dslogic_set_voltage_threshold(const struct sr_dev_inst *sdi, double threshold)
+{
+       int ret;
+       struct dev_context *const devc = sdi->priv;
+       const struct sr_usb_dev_inst *const usb = sdi->conn;
+       const uint8_t value = (threshold / 5.0) * 255;
+       const uint16_t cmd = value | (DS_ADDR_VTH << 8);
+
+       /* Send the control command. */
+       ret = libusb_control_transfer(usb->devhdl,
+                       LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_ENDPOINT_OUT,
+                       DS_CMD_WR_REG, 0x0000, 0x0000,
+                       (unsigned char *)&cmd, sizeof(cmd), 3000);
+       if (ret < 0) {
+               sr_err("Unable to set voltage-threshold register: %s.",
+               libusb_error_name(ret));
+               return SR_ERR;
+       }
+
+       devc->cur_threshold = threshold;
+
+       return SR_OK;
+}
+
 SR_PRIV int dslogic_dev_open(struct sr_dev_inst *sdi, struct sr_dev_driver *di)
 {
        libusb_device **devlist;