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
86
87
88
89
90
91
92
93
94
95
96

/*
 * File: phase.rs
 * Project: common
 * Created Date: 02/12/2023
 * Author: Shun Suzuki
 * -----
 * Last Modified: 30/12/2023
 * Modified By: Shun Suzuki (suzuki@hapis.k.u-tokyo.ac.jp)
 * -----
 * Copyright (c) 2023 Shun Suzuki. All rights reserved.
 *
 */

use crate::defined::{float, PI};

pub struct Rad;

#[derive(Debug, Clone, Copy, PartialEq, Eq)]
pub struct Phase {
    value: u8,
}

impl Phase {
    pub const fn new(value: u8) -> Self {
        Self { value }
    }

    pub fn from_rad(phase: float) -> Self {
        Self {
            value: (((phase / (2.0 * PI) * 256.0).round() as i32) & 0xFF) as _,
        }
    }

    pub const fn value(&self) -> u8 {
        self.value
    }

    pub fn radian(&self) -> float {
        self.value as float / 256.0 * 2.0 * PI
    }
}

impl From<u8> for Phase {
    fn from(v: u8) -> Self {
        Self::new(v)
    }
}

impl std::ops::Mul<Rad> for float {
    type Output = Phase;

    fn mul(self, _rhs: Rad) -> Self::Output {
        Self::Output::from_rad(self)
    }
}

#[cfg(test)]
mod tests {

    use super::*;
    use crate::defined::PI;

    #[test]
    fn phase_clone() {
        let a = PI * Rad;
        let b = a.clone();
        assert_eq!(a.value, b.value);
    }

    #[test]
    fn phase_from() {
        assert_eq!(Phase::from(0x90).value, 0x90);

        assert_eq!(Phase::from_rad(0.).value, 0);
        assert_eq!(Phase::from_rad(PI).value, 128);
        assert_eq!(Phase::from_rad(PI * 510.0 / 256.0).value, 255);
        assert_eq!(Phase::from_rad(2. * PI).value, 0);
    }

    #[test]
    fn phase_radian() {
        assert_eq!(Phase::from_rad(0.).radian(), 0.);
        assert_eq!(Phase::from_rad(PI).radian(), PI);
        assert_eq!(
            Phase::from_rad(PI * 510.0 / 256.0).radian(),
            PI * 510.0 / 256.0
        );
        assert_eq!(Phase::from_rad(2. * PI).radian(), 0.);
    }

    #[test]
    fn phase_debug() {
        let a = Phase::from_rad(PI);
        assert_eq!(format!("{:?}", a), "Phase { value: 128 }");
    }
}