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
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
#![no_std]
pub mod p8e0;
pub use self::p8e0::{P8E0, Q8E0};
pub type P8 = P8E0;
pub mod p16e1;
pub use self::p16e1::P16E1;
pub type P16 = P16E1;
pub mod p32e2;
pub use self::p32e2::P32E2;
pub type P32 = P32E2;
mod convert;
trait WithSign {
fn with_sign(self, sign: bool) -> Self;
}
impl WithSign for u8 {
#[inline]
fn with_sign(self, sign: bool) -> Self {
if sign {
self.wrapping_neg()
} else {
self
}
}
}
impl WithSign for u16 {
#[inline]
fn with_sign(self, sign: bool) -> Self {
if sign {
self.wrapping_neg()
} else {
self
}
}
}
impl WithSign for u32 {
#[inline]
fn with_sign(self, sign: bool) -> Self {
if sign {
self.wrapping_neg()
} else {
self
}
}
}
fn lldiv(numer: i64, denom: i64) -> (i64, i64) {
let mut quot = numer / denom;
let mut rem = numer % denom;
if (numer >= 0) && (rem < 0) {
quot += 1;
rem -= denom;
}
(quot, rem)
}
fn div(numer: i32, denom: i32) -> (i32, i32) {
let mut quot = numer / denom;
let mut rem = numer % denom;
if (numer >= 0) && (rem < 0) {
quot += 1;
rem -= denom;
}
(quot, rem)
}
const APPROX_RECIP_SQRT0: [u16; 16] = [
0xb4c9, 0xffab, 0xaa7d, 0xf11c, 0xa1c5, 0xe4c7, 0x9a43, 0xda29, 0x93b5, 0xd0e5, 0x8ded, 0xc8b7,
0x88c6, 0xc16d, 0x8424, 0xbae1,
];
const APPROX_RECIP_SQRT1: [u16; 16] = [
0xa5a5, 0xea42, 0x8c21, 0xc62d, 0x788f, 0xaa7f, 0x6928, 0x94b6, 0x5cc7, 0x8335, 0x52a6, 0x74e2,
0x4a3e, 0x68fe, 0x432b, 0x5efd,
];
#[allow(dead_code)]
#[derive(Clone, Copy)]
enum MulAddType {
Add = 0,
SubC = 1,
SubProd = 2,
}
pub trait MathConsts {
const E: Self;
const FRAC_1_PI: Self;
const FRAC_1_SQRT_2: Self;
const FRAC_2_PI: Self;
const FRAC_2_SQRT_PI: Self;
const FRAC_PI_2: Self;
const FRAC_PI_3: Self;
const FRAC_PI_4: Self;
const FRAC_PI_6: Self;
const FRAC_PI_8: Self;
const LN_10: Self;
const LN_2: Self;
const LOG10_E: Self;
const LOG2_E: Self;
const PI: Self;
const SQRT_2: Self;
const LOG2_10: Self;
const LOG10_2: Self ;
}