1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43

use crate::blocks::signal_source::FixedPointPhase;

/// Numerically Controlled Oscillator
#[derive(Debug, Clone, Copy)]
pub struct NCO {
    /// Phase
    pub phase: FixedPointPhase,
    phase_inc: FixedPointPhase,
}

impl NCO {
    /// Create NCO
    pub fn new(phase: f32, phase_inc: f32) -> NCO {
        NCO {
            phase: FixedPointPhase::new(phase),
            phase_inc: FixedPointPhase::new(phase_inc),
        }
    }
    /// `angle` in radians
    pub fn set_phase(&mut self, angle: f32) {
        self.phase = FixedPointPhase::new(angle);
    }
    /// Adjust phase in radians
    pub fn adjust_phase(&mut self, delta_phase: f32) {
        self.phase += FixedPointPhase::new(delta_phase);
    }
    /// `angle_rate` is in radians / step
    pub fn set_freq(&mut self, angle_rate: f32) {
        self.phase_inc = FixedPointPhase::new(angle_rate);
    }
    /// Adjust frequency
    pub fn adjust_freq(&mut self, delta_angle_rate: f32) {
        self.phase_inc += FixedPointPhase::new(delta_angle_rate);
    }
    /// Do one step forward
    pub fn step(&mut self) {
        self.phase += self.phase_inc;
    }
    /// Do multiple steps forward
    pub fn steps(&mut self, n: i32) {
        self.phase += self.phase_inc * n;
    }
}