signal_processing 0.3.0

A signal processing library.
Documentation 
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
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85

use core::{iter::Sum, ops::{AddAssign, SubAssign}};

use num::{traits::FloatConst, Complex, Float, NumCast};
use option_trait::Maybe;

use crate::{quantities::{ContainerOrSingle, List, ListOrSingle, Lists, MaybeLists, OwnedList, OwnedListOrSingle}, analysis::{PhaseUnwrapReference, RealFreqZ}, System};

pub trait RealPhaseZ<'a, H, W, N>: System<Set: Float + FloatConst>
where
    H: Lists<Self::Set>,
    W: List<Self::Set>,
    N: Maybe<usize>,
{
    fn real_phasez(&'a self, n: N, reference: PhaseUnwrapReference) -> (H, W);
}

impl<'a, S, T, H, W, N> RealPhaseZ<'a, H, W, N> for S
where
    T: Float + FloatConst + Sum + AddAssign + SubAssign,
    S: RealFreqZ<'a, H::Mapped<Complex<T>>, W, N> + System<Set = T>,
    H: Lists<T>,
    H::Mapped<Complex<T>>: Lists<Complex<T>, RowOwned: OwnedList<Complex<T>, Mapped<T>: OwnedList<T>>, RowsMapped<<<H::Mapped<Complex<T>> as MaybeLists<Complex<T>>>::RowOwned as ContainerOrSingle<Complex<T>>>::Mapped<T>>: Into<H>>,
    W: List<T>,
    N: Maybe<usize>,
{
    fn real_phasez(&'a self, n: N, reference: PhaseUnwrapReference) -> (H, W)
    {
        let (h, w) = self.real_freqz(n);

        let theta = h.map_rows_into_owned(|mut z| {
            let mut prev_theta = T::zero();

            let l = z.as_view_slice().len();

            if reference == PhaseUnwrapReference::Nyq
            {
                z.as_mut_slice()
                    .reverse()
            }

            let mut theta = z.map_into_owned(|z| {
                let mut theta = (z.arg() - prev_theta) % T::TAU() + prev_theta;
                while theta - prev_theta > T::PI()
                {
                    theta -= T::TAU()
                }
                while theta - prev_theta < -T::PI()
                {
                    theta += T::TAU()
                }
                prev_theta = theta;
                theta
            });

            match reference
            {
                PhaseUnwrapReference::Zero => (),
                PhaseUnwrapReference::Nyq => {
                    theta.as_mut_slice()
                        .reverse()
                },
                PhaseUnwrapReference::Mean => {
                    let mean = theta.as_view_slice()
                        .iter()
                        .map(|&theta| theta)
                        .sum::<T>()/NumCast::from(l).unwrap();

                    let o = (mean/T::TAU()).round()*T::TAU();
                    if !o.is_zero()
                    {
                        for theta in theta.as_mut_slice()
                            .iter_mut()
                        {
                            *theta -= o
                        }
                    }
                }
            }

            theta
        }).into();

        (theta, w)
    }
}