diff --git a/src/si5153.rs b/src/si5153.rs index 5a98dd3..6d23f24 100644 --- a/src/si5153.rs +++ b/src/si5153.rs @@ -152,6 +152,15 @@ where pub fn set_ms_phase(&mut self, i2c: &mut I2C, synth: Multisynth, phase: u8) { self.write_byte_reg(i2c, synth.phoff_address(), phase); + + match self.ms_srcs[synth as usize] { + PLL::A => { + self.write_byte_reg(i2c, PLL_RESET, 1 << 5); + } + PLL::B => { + self.write_byte_reg(i2c, PLL_RESET, 1 << 7); + } + } } pub fn pll_reset(&mut self, i2c: &mut I2C) {