use crate::DType;
use crate::signal::impl_generic::helpers::{DetrendMode, detrend_tensor_impl, power_spectrum_impl};
use crate::signal::impl_generic::spectral::helpers::generate_window;
use crate::signal::traits::spectral::{Detrend, PeriodogramParams, PeriodogramResult, PsdScaling};
use numr::algorithm::fft::{FftAlgorithms, FftNormalization};
use numr::error::{Error, Result};
use numr::ops::{ComplexOps, ReduceOps, ScalarOps, ShapeOps, TensorOps, UtilityOps};
use numr::runtime::{Runtime, RuntimeClient};
use numr::tensor::Tensor;
pub fn periodogram_impl<R, C>(
client: &C,
x: &Tensor<R>,
params: PeriodogramParams<R>,
) -> Result<PeriodogramResult<R>>
where
R: Runtime<DType = DType>,
C: FftAlgorithms<R>
+ ComplexOps<R>
+ ScalarOps<R>
+ TensorOps<R>
+ ReduceOps<R>
+ ShapeOps<R>
+ UtilityOps<R>
+ RuntimeClient<R>,
{
let n = x.shape()[0];
if n == 0 {
return Err(Error::InvalidArgument {
arg: "x",
reason: "Input signal cannot be empty".to_string(),
});
}
let nfft_requested = params.nfft.unwrap_or(n).max(n);
let nfft = nfft_requested.next_power_of_two();
let window = generate_window(¶ms.window, n, ¶ms.device);
let win_sq = client.mul(&window, &window)?;
let win_sum_sq_tensor = client.sum(&win_sq, &[0], false)?;
let win_sum_sq: f64 = win_sum_sq_tensor.item()?;
let detrend_mode = match params.detrend {
Detrend::None => DetrendMode::None,
Detrend::Constant => DetrendMode::Constant,
Detrend::Linear => DetrendMode::Linear,
};
let x_detrended = detrend_tensor_impl(client, x, detrend_mode)?;
let x_windowed = client.mul(&x_detrended, &window)?;
let x_padded = if nfft > n {
let pad_amount = nfft - n;
client.pad(&x_windowed, &[0, pad_amount], 0.0)?
} else {
x_windowed
};
let fft_result = client.rfft(&x_padded, FftNormalization::None)?;
let power = power_spectrum_impl(client, &fft_result)?;
let n_freqs = nfft / 2 + 1;
let scale = match params.scaling {
PsdScaling::Density => 1.0 / (params.fs * win_sum_sq),
PsdScaling::Spectrum => 1.0 / win_sum_sq,
};
let psd_scaled = client.mul_scalar(&power, scale)?;
let psd_final = if params.onesided && n_freqs > 2 {
let mut scale_factors = vec![2.0f64; n_freqs];
scale_factors[0] = 1.0; if n_freqs > 1 {
scale_factors[n_freqs - 1] = 1.0; }
let scale_tensor = Tensor::from_slice(&scale_factors, &[n_freqs], ¶ms.device);
client.mul(&psd_scaled, &scale_tensor)?
} else {
psd_scaled
};
let freqs = client.rfftfreq(nfft, 1.0 / params.fs, psd_final.dtype(), ¶ms.device)?;
Ok(PeriodogramResult {
freqs,
psd: psd_final,
})
}