Implement set_sample_rate()HEADmaster

1 files changed, 14 insertions, 1 deletions

diff --git a/src/usb.rs b/src/usb.rs
index d32956b..a83c853 100644
--- a/src/usb.rs
+++ b/src/usb.rs
@@ -251,7 +251,6 @@ impl RtlSdrDeviceHandle {
     }
 
     pub fn set_sample_rate(&self, samp_rate: u32) {
-        let _tmp: u16;
         let real_rsamp_ratio: u32;
 
         // check if the rate is supported by the resampler
@@ -270,9 +269,23 @@ impl RtlSdrDeviceHandle {
         info!("Exact sample rate is: {} Hz", real_rate);
 
         self.set_i2c_repeater(true);
+        self.tuner.set_bw(self.handle);
         self.set_i2c_repeater(false);
+
+        let mut tmp: u16 = rsamp_ratio >> 16;
+        self.handle.demod_write_reg(1, 0x9f, tmp, 2);
+        tmp = rsamp_ratio & 0xffff;
+        self.handle.demod_write_reg(1, 0xa1, tmp, 2);
+        // self.set_sample_freq_corr();
+
+        // reset demod (bit 3, soft_rst)
+        self.handle.demod_write_reg(1, 0x01, 0x14, 1);
+        self.handle.demod_write_reg(1, 0x01, 0x10, 1);
+        
+        // self.set_offset_tuning();
     }
 
+
     pub fn reset_buffer(&self) {
         self.write_reg(BLOCK_USBB, ADDR_USB_EPA_CTL, 0x1002, 2);
         self.write_reg(BLOCK_USBB, ADDR_USB_EPA_CTL, 0x0000, 2);