use crate::activation_simd_avx2;
use crate::activation_simd_avx512;
use core::arch::x86_64::*;
#[target_feature(enable = "avx2,fma")]
pub unsafe fn simd_softsign_avx2(x: __m256) -> __m256 {
let one = _mm256_set1_ps(1.0);
let two = _mm256_set1_ps(2.0);
let abs_x = _mm256_andnot_ps(_mm256_set1_ps(-0.0), x);
let den = _mm256_add_ps(one, abs_x);
let mut res = _mm256_rcp_ps(den);
res = _mm256_mul_ps(res, _mm256_fnmadd_ps(den, res, two));
res = _mm256_mul_ps(res, _mm256_fnmadd_ps(den, res, two));
_mm256_mul_ps(x, res)
}
#[target_feature(enable = "avx2,fma")]
pub unsafe fn simd_softsign_dual_avx2(x1: __m256, x2: __m256) -> (__m256, __m256) {
let one = _mm256_set1_ps(1.0);
let two = _mm256_set1_ps(2.0);
let zero_minus = _mm256_set1_ps(-0.0);
let abs_x1 = _mm256_andnot_ps(zero_minus, x1);
let abs_x2 = _mm256_andnot_ps(zero_minus, x2);
let den1 = _mm256_add_ps(one, abs_x1);
let den2 = _mm256_add_ps(one, abs_x2);
let mut res1 = _mm256_rcp_ps(den1);
let mut res2 = _mm256_rcp_ps(den2);
res1 = _mm256_mul_ps(res1, _mm256_fnmadd_ps(den1, res1, two));
res2 = _mm256_mul_ps(res2, _mm256_fnmadd_ps(den2, res2, two));
res1 = _mm256_mul_ps(res1, _mm256_fnmadd_ps(den1, res1, two));
res2 = _mm256_mul_ps(res2, _mm256_fnmadd_ps(den2, res2, two));
(_mm256_mul_ps(x1, res1), _mm256_mul_ps(x2, res2))
}
#[target_feature(enable = "avx512f,avx512vl,avx512dq")]
pub unsafe fn simd_softsign_avx512(x: __m512) -> __m512 {
let one = _mm512_set1_ps(1.0);
let two = _mm512_set1_ps(2.0);
let abs_x = _mm512_andnot_ps(_mm512_set1_ps(-0.0), x);
let den = _mm512_add_ps(one, abs_x);
let mut res = _mm512_rcp14_ps(den);
res = _mm512_mul_ps(res, _mm512_fnmadd_ps(den, res, two));
res = _mm512_mul_ps(res, _mm512_fnmadd_ps(den, res, two));
_mm512_mul_ps(x, res)
}
#[target_feature(enable = "avx2,fma")]
pub unsafe fn softsign_slice_avx2(slice: &mut [f32]) {
let mut i = 0;
let len = slice.len();
unsafe {
activation_simd_avx2!(
i,
len,
{
let x1 = _mm256_loadu_ps(slice.as_ptr().add(i));
let x2 = _mm256_loadu_ps(slice.as_ptr().add(i + 8));
let (y1, y2) = simd_softsign_dual_avx2(x1, x2);
_mm256_storeu_ps(slice.as_mut_ptr().add(i), y1);
_mm256_storeu_ps(slice.as_mut_ptr().add(i + 8), y2);
},
{
let x = _mm256_loadu_ps(slice.as_ptr().add(i));
let y = simd_softsign_avx2(x);
_mm256_storeu_ps(slice.as_mut_ptr().add(i), y);
}
);
}
for item in slice.iter_mut().skip(i) {
*item /= 1.0 + item.abs();
}
}
#[target_feature(enable = "avx512f,avx512vl,avx512dq")]
pub unsafe fn softsign_slice_avx512(slice: &mut [f32]) {
let mut i = 0;
let len = slice.len();
unsafe {
activation_simd_avx512!(i, len, {
let x = _mm512_loadu_ps(slice.as_ptr().add(i));
let y = simd_softsign_avx512(x);
_mm512_storeu_ps(slice.as_mut_ptr().add(i), y);
});
}
for item in slice.iter_mut().skip(i) {
*item /= 1.0 + item.abs();
}
}
#[inline(always)]
pub fn softsign(x: f32) -> f32 {
x / (1.0 + x.abs())
}