From 9fe533c949dbc10bff0067257a79ec1648f92b73 Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?Ond=C5=99ej=20Hru=C5=A1ka?= Date: Sun, 27 Feb 2022 22:49:43 +0100 Subject: [PATCH] apply steve-m/librtlsdr/pull/58 --- src/librtlsdr.c | 10 ++++++++-- 1 file changed, 8 insertions(+), 2 deletions(-) diff --git a/src/librtlsdr.c b/src/librtlsdr.c index 7b35946..2a5e4ad 100644 --- a/src/librtlsdr.c +++ b/src/librtlsdr.c @@ -537,6 +537,7 @@ uint16_t rtlsdr_demod_read_reg(rtlsdr_dev_t *dev, uint8_t page, uint16_t addr, u int rtlsdr_demod_write_reg(rtlsdr_dev_t *dev, uint8_t page, uint16_t addr, uint16_t val, uint8_t len) { int r; + int retries = 2; unsigned char data[2]; uint16_t index = 0x10 | page; addr = (addr << 8) | 0x20; @@ -548,13 +549,18 @@ int rtlsdr_demod_write_reg(rtlsdr_dev_t *dev, uint8_t page, uint16_t addr, uint1 data[1] = val & 0xff; + r = libusb_control_transfer(dev->devh, CTRL_OUT, 0, addr, index, data, len, CTRL_TIMEOUT); + do { + r = libusb_control_transfer(dev->devh, CTRL_OUT, 0, addr, index, data, len, CTRL_TIMEOUT); + rtlsdr_demod_read_reg(dev, 0x0a, 0x01, 1); + retries--; + } while (retries > 0 && r < 0); + if (r < 0) fprintf(stderr, "%s failed with %d\n", __FUNCTION__, r); - rtlsdr_demod_read_reg(dev, 0x0a, 0x01, 1); - return (r == len) ? 0 : -1; }