use ndarray::Array1;
use ndarray::s;
use stochastic_rs_core::simd_rng::Deterministic;
use stochastic_rs_core::simd_rng::SeedExt;
use stochastic_rs_core::simd_rng::Unseeded;
use stochastic_rs_distributions::normal::SimdNormal;
use crate::traits::FloatExt;
use crate::traits::ProcessExt;
pub struct RadialOU<T: FloatExt, S: SeedExt = Unseeded> {
pub kappa: T,
pub sigma: T,
pub n: usize,
pub x0: Option<T>,
pub t: Option<T>,
pub seed: S,
}
impl<T: FloatExt> RadialOU<T> {
pub fn new(kappa: T, sigma: T, n: usize, x0: Option<T>, t: Option<T>) -> Self {
Self {
kappa,
sigma,
n,
x0,
t,
seed: Unseeded,
}
}
}
impl<T: FloatExt> RadialOU<T, Deterministic> {
pub fn seeded(kappa: T, sigma: T, n: usize, x0: Option<T>, t: Option<T>, seed: u64) -> Self {
Self {
kappa,
sigma,
n,
x0,
t,
seed: Deterministic::new(seed),
}
}
}
impl<T: FloatExt, S: SeedExt> ProcessExt<T> for RadialOU<T, S> {
type Output = Array1<T>;
fn sample(&self) -> Self::Output {
let mut radial_ou = Array1::<T>::zeros(self.n);
if self.n == 0 {
return radial_ou;
}
radial_ou[0] = self.x0.unwrap_or(T::zero());
if self.n == 1 {
return radial_ou;
}
let n_increments = self.n - 1;
let dt = self.t.unwrap_or(T::one()) / T::from_usize_(n_increments);
let sqrt_dt = dt.sqrt();
let mut prev = radial_ou[0];
let mut tail_view = radial_ou.slice_mut(s![1..]);
let tail = tail_view
.as_slice_mut()
.expect("RadialOU output tail must be contiguous");
let normal = SimdNormal::<T>::from_seed_source(T::zero(), sqrt_dt, &self.seed);
normal.fill_slice_fast(tail);
for z in tail.iter_mut() {
let safe_prev = if prev.abs() < T::from_f64_fast(1e-12) {
T::from_f64_fast(1e-12)
} else {
prev
};
let next = prev + (self.kappa / safe_prev - prev) * dt + self.sigma * *z;
*z = next;
prev = next;
}
radial_ou
}
}
py_process_1d!(PyRadialOU, RadialOU,
sig: (kappa, sigma, n, x0=None, t=None, seed=None, dtype=None),
params: (kappa: f64, sigma: f64, n: usize, x0: Option<f64>, t: Option<f64>)
);