use core::arch::aarch64::*;
pub struct Rotate90F32 {
sign_hi: float32x2_t,
sign_both: float32x4_t,
}
impl Rotate90F32 {
pub fn new(positive: bool) -> Self {
let sign_hi = unsafe {
if positive {
vld1_f32([-0.0, 0.0].as_ptr())
} else {
vld1_f32([0.0, -0.0].as_ptr())
}
};
let sign_both = unsafe {
if positive {
vld1q_f32([-0.0, 0.0, -0.0, 0.0].as_ptr())
} else {
vld1q_f32([0.0, -0.0, 0.0, -0.0].as_ptr())
}
};
Self {
sign_hi,
sign_both,
}
}
#[inline(always)]
pub unsafe fn rotate_hi(&self, values: float32x4_t) -> float32x4_t {
vcombine_f32(
vget_low_f32(values),
vreinterpret_f32_u32(veor_u32(
vrev64_u32(vreinterpret_u32_f32(vget_high_f32(values))),
vreinterpret_u32_f32(self.sign_hi),
)),
)
}
#[inline(always)]
pub unsafe fn rotate_both(&self, values: float32x4_t) -> float32x4_t {
let temp = vrev64q_f32(values);
vreinterpretq_f32_u32(veorq_u32(
vreinterpretq_u32_f32(temp),
vreinterpretq_u32_f32(self.sign_both),
))
}
}
#[inline(always)]
pub unsafe fn extract_lo_lo_f32(left: float32x4_t, right: float32x4_t) -> float32x4_t {
vreinterpretq_f32_f64(vtrn1q_f64(
vreinterpretq_f64_f32(left),
vreinterpretq_f64_f32(right),
))
}
#[inline(always)]
pub unsafe fn extract_hi_hi_f32(left: float32x4_t, right: float32x4_t) -> float32x4_t {
vreinterpretq_f32_f64(vtrn2q_f64(
vreinterpretq_f64_f32(left),
vreinterpretq_f64_f32(right),
))
}
#[inline(always)]
pub unsafe fn extract_lo_hi_f32(left: float32x4_t, right: float32x4_t) -> float32x4_t {
vcombine_f32(vget_low_f32(left), vget_high_f32(right))
}
#[inline(always)]
pub unsafe fn extract_hi_lo_f32(left: float32x4_t, right: float32x4_t) -> float32x4_t {
vcombine_f32(vget_high_f32(left), vget_low_f32(right))
}
#[inline(always)]
pub unsafe fn reverse_complex_elements_f32(values: float32x4_t) -> float32x4_t {
vcombine_f32(vget_high_f32(values), vget_low_f32(values))
}
#[inline(always)]
pub unsafe fn reverse_complex_and_negate_hi_f32(values: float32x4_t) -> float32x4_t {
vcombine_f32(vget_high_f32(values), vneg_f32(vget_low_f32(values)))
}
#[inline(always)]
pub unsafe fn duplicate_lo_f32(values: float32x4_t) -> float32x4_t {
vreinterpretq_f32_f64(vtrn1q_f64(
vreinterpretq_f64_f32(values),
vreinterpretq_f64_f32(values),
))
}
#[inline(always)]
pub unsafe fn duplicate_hi_f32(values: float32x4_t) -> float32x4_t {
vreinterpretq_f32_f64(vtrn2q_f64(
vreinterpretq_f64_f32(values),
vreinterpretq_f64_f32(values),
))
}
#[inline(always)]
pub unsafe fn transpose_complex_2x2_f32(left: float32x4_t, right: float32x4_t) -> [float32x4_t; 2] {
let temp02 = extract_lo_lo_f32(left, right);
let temp13 = extract_hi_hi_f32(left, right);
[temp02, temp13]
}
#[inline(always)]
pub unsafe fn mul_complex_f32(left: float32x4_t, right: float32x4_t) -> float32x4_t {
let temp1 = vtrn1q_f32(right, right);
let temp2 = vtrn2q_f32(right, vnegq_f32(right));
let temp3 = vmulq_f32(temp2, left);
let temp4 = vrev64q_f32(temp3);
vfmaq_f32(temp4, temp1, left)
}
pub(crate) struct Rotate90F64 {
sign: float64x2_t,
}
impl Rotate90F64 {
pub fn new(positive: bool) -> Self {
let sign = unsafe {
if positive {
vld1q_f64([-0.0, 0.0].as_ptr())
} else {
vld1q_f64([0.0, -0.0].as_ptr())
}
};
Self { sign }
}
#[inline(always)]
pub unsafe fn rotate(&self, values: float64x2_t) -> float64x2_t {
let temp = vcombine_f64(vget_high_f64(values), vget_low_f64(values));
vreinterpretq_f64_u64(veorq_u64(
vreinterpretq_u64_f64(temp),
vreinterpretq_u64_f64(self.sign),
))
}
}
#[inline(always)]
pub unsafe fn mul_complex_f64(left: float64x2_t, right: float64x2_t) -> float64x2_t {
let temp = vcombine_f64(vneg_f64(vget_high_f64(left)), vget_low_f64(left));
let sum = vmulq_laneq_f64::<0>(left, right);
vfmaq_laneq_f64::<1>(sum, temp, right)
}
#[cfg(test)]
mod unit_tests {
use super::*;
use num_complex::Complex;
#[test]
fn test_mul_complex_f64() {
unsafe {
let right = vld1q_f64([1.0, 2.0].as_ptr());
let left = vld1q_f64([5.0, 7.0].as_ptr());
let res = mul_complex_f64(left, right);
let expected = vld1q_f64([1.0 * 5.0 - 2.0 * 7.0, 1.0 * 7.0 + 2.0 * 5.0].as_ptr());
assert_eq!(
std::mem::transmute::<float64x2_t, Complex<f64>>(res),
std::mem::transmute::<float64x2_t, Complex<f64>>(expected)
);
}
}
#[test]
fn test_mul_complex_f32() {
unsafe {
let val1 = Complex::<f32>::new(1.0, 2.5);
let val2 = Complex::<f32>::new(3.2, 4.75);
let val3 = Complex::<f32>::new(5.75, 6.25);
let val4 = Complex::<f32>::new(7.4, 8.5);
let nbr2 = vld1q_f32([val3, val4].as_ptr() as *const f32);
let nbr1 = vld1q_f32([val1, val2].as_ptr() as *const f32);
let res = mul_complex_f32(nbr1, nbr2);
let res = std::mem::transmute::<float32x4_t, [Complex<f32>; 2]>(res);
let expected = [val1 * val3, val2 * val4];
assert_eq!(res, expected);
}
}
#[test]
fn test_pack() {
unsafe {
let nbr2 = vld1q_f32([5.0, 6.0, 7.0, 8.0].as_ptr());
let nbr1 = vld1q_f32([1.0, 2.0, 3.0, 4.0].as_ptr());
let first = extract_lo_lo_f32(nbr1, nbr2);
let second = extract_hi_hi_f32(nbr1, nbr2);
let first = std::mem::transmute::<float32x4_t, [Complex<f32>; 2]>(first);
let second = std::mem::transmute::<float32x4_t, [Complex<f32>; 2]>(second);
let first_expected = [Complex::new(1.0, 2.0), Complex::new(5.0, 6.0)];
let second_expected = [Complex::new(3.0, 4.0), Complex::new(7.0, 8.0)];
assert_eq!(first, first_expected);
assert_eq!(second, second_expected);
}
}
}