use super::super::{broadcast_words, check_elements, swap_mask_avx2};
use crate::kernel::gf16::Coeffs;
use crate::kernel::tables::TowerCoeff;
use crate::kernel::x86::peel_to_align;
use super::scale_gfni;
use super::single::mul_add_gfni;
#[cfg(target_arch = "x86")]
use core::arch::x86::*;
#[cfg(target_arch = "x86_64")]
use core::arch::x86_64::*;
#[allow(unsafe_code)]
#[archmage::arcane(import_intrinsics)]
pub fn mul_add_scatter_gfni(
token: archmage::X64V3GfniCryptoToken,
rows: &mut [u8],
row_len: usize,
coeffs: &(impl Coeffs + ?Sized),
src: &[u8],
) {
check_elements("gf16::mul_add_scatter_gfni", row_len);
assert_eq!(
row_len,
src.len(),
"gf16::mul_add_scatter_gfni: row_len is {row_len} bytes but src is {} bytes",
src.len(),
);
let used = coeffs
.count()
.checked_mul(row_len)
.expect("gf16::mul_add_scatter_gfni: row geometry overflows");
assert!(
rows.len() >= used,
"gf16::mul_add_scatter_gfni: rows is {} bytes but {} rows of {row_len} bytes need {used}",
rows.len(),
coeffs.count(),
);
if row_len == 0 || coeffs.count() == 0 {
return;
}
let base = rows.as_mut_ptr();
let swap = swap_mask_avx2();
let mut j = 0;
while j + 4 <= coeffs.count() {
let group: [TowerCoeff; 4] = core::array::from_fn(|slot| coeffs.compact(j + slot));
unsafe { scatter_group(token, base.add(j * row_len), row_len, group, src, swap) };
j += 4;
}
if j + 2 <= coeffs.count() {
let group: [TowerCoeff; 2] = core::array::from_fn(|slot| coeffs.compact(j + slot));
unsafe { scatter_group(token, base.add(j * row_len), row_len, group, src, swap) };
j += 2;
}
if j < coeffs.count() {
unsafe {
let row = core::slice::from_raw_parts_mut(base.add(j * row_len), row_len);
mul_add_gfni(token, row, coeffs.compact(j), src);
}
}
}
#[allow(unsafe_code)]
#[archmage::rite(v3_gfni_crypto)]
unsafe fn scatter_group<const N: usize>(
token: archmage::X64V3GfniCryptoToken,
base: *mut u8,
row_len: usize,
coeffs: [TowerCoeff; N],
src: &[u8],
swap: __m256i,
) {
let mut rows = [core::ptr::null_mut::<u8>(); N];
for (k, row) in rows.iter_mut().enumerate() {
*row = unsafe { base.add(k * row_len) };
}
let mut same = [_mm256_setzero_si256(); N];
let mut cross = [_mm256_setzero_si256(); N];
for (k, coeff) in coeffs.iter().enumerate() {
let (same_word, cross_word) = broadcast_words(*coeff);
same[k] = _mm256_set1_epi16(same_word);
cross[k] = _mm256_set1_epi16(cross_word);
}
let src_ptr = src.as_ptr();
let head = peel_to_align(rows[0], row_len, 2);
for (k, coeff) in coeffs.iter().enumerate() {
let lead = unsafe { core::slice::from_raw_parts_mut(rows[k], head) };
mul_add_gfni(token, lead, *coeff, &src[..head]);
}
let mut offset = head;
while offset + 32 <= row_len {
unsafe {
let x = _mm256_loadu_si256(src_ptr.add(offset).cast());
let swapped = _mm256_shuffle_epi8(x, swap);
for (k, &row) in rows.iter().enumerate() {
let p = row.add(offset);
let d = _mm256_loadu_si256(p.cast());
let scaled = scale_gfni(x, swapped, same[k], cross[k]);
_mm256_storeu_si256(p.cast(), _mm256_xor_si256(d, scaled));
}
}
offset += 32;
}
if offset < row_len {
for (k, coeff) in coeffs.iter().enumerate() {
let tail =
unsafe { core::slice::from_raw_parts_mut(rows[k].add(offset), row_len - offset) };
mul_add_gfni(token, tail, *coeff, &src[offset..]);
}
}
}