use g_math::fixed_point::imperative::OverflowDetected;
use crate::FixedPoint;
use super::constants::sqrt_nth_prime;
use super::wrapping::{wrapping_add, wrapping_from_int, wrapping_mul};
use crate::ToponError;
pub struct WeylAccumulator {
pub state: FixedPoint,
pub irrational: FixedPoint,
}
impl WeylAccumulator {
pub fn new(dim_index: usize) -> Result<Self, ToponError> {
Ok(Self::with_constant(sqrt_nth_prime(dim_index)?, dim_index))
}
pub fn with_constant(irrational: FixedPoint, dim_index: usize) -> Self {
let dim_fp = wrapping_from_int((dim_index as i32).wrapping_add(1));
WeylAccumulator {
state: wrapping_mul(irrational, dim_fp),
irrational,
}
}
#[inline]
pub fn absorb(&mut self, contribution: FixedPoint) {
self.state = wrapping_add(wrapping_mul(self.state, self.irrational), contribution);
}
#[inline]
pub fn absorb_with_periodic_fold(
&mut self,
contribution: FixedPoint,
step: usize,
period: usize,
) -> Result<(), OverflowDetected> {
self.absorb(contribution);
if (step + 1).is_multiple_of(period) {
self.state = self.state.try_sin()?;
}
Ok(())
}
#[inline]
pub fn fold(&self) -> Result<FixedPoint, OverflowDetected> {
self.state.try_sin()
}
}
#[inline]
pub fn wave_fold(x: FixedPoint) -> Result<FixedPoint, OverflowDetected> {
x.try_sin()
}
#[inline]
pub fn frac(x: FixedPoint) -> FixedPoint {
x - FixedPoint::from_int(x.to_int())
}