Notes/notes-service/vendor/simd-adler32/src/imp/neon.rs

use super::Adler32Imp;

#[cfg(all(target_feature = "neon", any(target_arch = "aarch64", feature = "nightly")))]
pub fn get_imp() -> Option<Adler32Imp> {
  Some(imp::update)
}

#[cfg(not(all(target_feature = "neon", any(target_arch = "aarch64", feature = "nightly"))))]
pub fn get_imp() -> Option<Adler32Imp> {
  None
}

#[cfg(all(target_feature = "neon", any(target_arch = "aarch64", feature = "nightly")))]
mod imp {
  const MOD: u32 = 65521;
  const NMAX: usize = 5552;
  const BLOCK_SIZE: usize = 32;
  const CHUNK_SIZE: usize = NMAX / BLOCK_SIZE * BLOCK_SIZE;

  #[cfg(target_arch = "aarch64")]
  use core::arch::aarch64::*;
  #[cfg(target_arch = "arm")]
  use core::arch::arm::*;

  pub fn update(a: u16, b: u16, data: &[u8]) -> (u16, u16) {
    let mut a = a as u32;
    let mut b = b as u32;

    let chunks = data.chunks_exact(CHUNK_SIZE);
    let remainder = chunks.remainder();
    for chunk in chunks {
      update_chunk_block(&mut a, &mut b, chunk);
    }

    update_block(&mut a, &mut b, remainder);

    (a as u16, b as u16)
  }

  fn update_block(a: &mut u32, b: &mut u32, chunk: &[u8]) {
    debug_assert!(
      chunk.len() <= CHUNK_SIZE,
      "Unexpected chunk size (expected <= {}, got {})",
      CHUNK_SIZE,
      chunk.len()
    );

    for byte in reduce_add_blocks(a, b, chunk) {
      *a += *byte as u32;
      *b += *a;
    }

    *a %= MOD;
    *b %= MOD;
  }

  fn update_chunk_block(a: &mut u32, b: &mut u32, chunk: &[u8]) {
    debug_assert_eq!(
      chunk.len(),
      CHUNK_SIZE,
      "Unexpected chunk size (expected {}, got {})",
      CHUNK_SIZE,
      chunk.len()
    );

    reduce_add_blocks(a, b, chunk);
  }

  fn reduce_add_blocks<'a>(a: &mut u32, b: &mut u32, chunk: &'a [u8]) -> &'a [u8] {
    if chunk.len() < BLOCK_SIZE {
      return chunk;
    }
    let blocks = chunk.chunks_exact(BLOCK_SIZE);
    let blocks_remainder = blocks.remainder();

    // Conversion of the code from Chromium zlib:
    // https://chromium.googlesource.com/chromium/src/third_party/+/main/zlib/adler32_simd.c
    unsafe {
      // a and b accumulators are initially zero.
      let mut a_v: uint32x4_t = vdupq_n_u32(0);
      let mut b_v: uint32x4_t = vdupq_n_u32(0);
      // b_v[3] contains the last term (n) for the B part
      b_v = vsetq_lane_u32(*a * (blocks.len() as u32), b_v, 3);

      // Computing the unrolled prefix-sum
      let mut v_column_sum_1: uint16x8_t = vdupq_n_u16(0);
      let mut v_column_sum_2: uint16x8_t = vdupq_n_u16(0);
      let mut v_column_sum_3: uint16x8_t = vdupq_n_u16(0);
      let mut v_column_sum_4: uint16x8_t = vdupq_n_u16(0);

      for block in blocks {
        let block_ptr = block.as_ptr();
        // Slurp in 32 bytes
        let bytes1: uint8x16_t = vld1q_u8(block_ptr);
        let bytes2: uint8x16_t = vld1q_u8(block_ptr.add(16));

        // Wrapping-add the sums from the previous block together.
        // b_v[i] += a_v[i]
        b_v = vaddq_u32(b_v, a_v);

        // Unsigned add, accumulate long pairwise.
        // Adjacent elements in bytes1 are zipped, added, lengthened.
        a_v = vpadalq_u16(a_v, vpadalq_u8(vpaddlq_u8(bytes1), bytes2));

        // Have to oscillate between low and high elements, since vaddw's first
        // argument is already q-length.
        v_column_sum_1 = vaddw_u8(v_column_sum_1, vget_low_u8(bytes1));
        v_column_sum_2 = vaddw_u8(v_column_sum_2, vget_high_u8(bytes1));
        v_column_sum_3 = vaddw_u8(v_column_sum_3, vget_low_u8(bytes2));
        v_column_sum_4 = vaddw_u8(v_column_sum_4, vget_high_u8(bytes2));
      }

      // No more data/updates to a, so now we shake out all of the accumulated data
      // Previous block was 32 indices ago, so multiply B to start
      b_v = vshlq_n_u32(b_v, 5);

      // Then product-sum of each D column.
      let w1: [u16; 4] = [32, 31, 30, 29];
      let w2: [u16; 4] = [28, 27, 26, 25];
      let w3: [u16; 4] = [24, 23, 22, 21];
      let w4: [u16; 4] = [20, 19, 18, 17];
      let w5: [u16; 4] = [16, 15, 14, 13];
      let w6: [u16; 4] = [12, 11, 10, 9];
      let w7: [u16; 4] = [8, 7, 6, 5];
      let w8: [u16; 4] = [4, 3, 2, 1];
      b_v = vmlal_u16(b_v, vget_low_u16(v_column_sum_1), vld1_u16(w1.as_ptr()));
      b_v = vmlal_u16(b_v, vget_high_u16(v_column_sum_1), vld1_u16(w2.as_ptr()));
      b_v = vmlal_u16(b_v, vget_low_u16(v_column_sum_2), vld1_u16(w3.as_ptr()));
      b_v = vmlal_u16(b_v, vget_high_u16(v_column_sum_2), vld1_u16(w4.as_ptr()));
      b_v = vmlal_u16(b_v, vget_low_u16(v_column_sum_3), vld1_u16(w5.as_ptr()));
      b_v = vmlal_u16(b_v, vget_high_u16(v_column_sum_3), vld1_u16(w6.as_ptr()));
      b_v = vmlal_u16(b_v, vget_low_u16(v_column_sum_4), vld1_u16(w7.as_ptr()));
      b_v = vmlal_u16(b_v, vget_high_u16(v_column_sum_4), vld1_u16(w8.as_ptr()));

      // Pyramid pairwise-add to get the final output.
      // *a = vaddvq_u32(a_v) would also do the job.
      let sum1: uint32x2_t = vpadd_u32(vget_low_u32(a_v), vget_high_u32(a_v));
      let sum2: uint32x2_t = vpadd_u32(vget_low_u32(b_v), vget_high_u32(b_v));
      let sum3: uint32x2_t = vpadd_u32(sum1, sum2);
      *a += vget_lane_u32(sum3, 0);
      *b += vget_lane_u32(sum3, 1);

      *a %= MOD;
      *b %= MOD;

      blocks_remainder
    }
  }
}

#[cfg(test)]
mod tests {
  use rand::{rngs::SmallRng, Rng, SeedableRng};

  #[test]
  fn zeroes() {
    assert_sum_eq(&[]);
    assert_sum_eq(&[0]);
    assert_sum_eq(&[0, 0]);
    assert_sum_eq(&[0; 100]);
    assert_sum_eq(&[0; 1024]);
    assert_sum_eq(&[0; 1024 * 1024]);
  }

  #[test]
  fn ones() {
    assert_sum_eq(&[]);
    assert_sum_eq(&[1]);
    assert_sum_eq(&[1, 1]);
    assert_sum_eq(&[1; 100]);
    assert_sum_eq(&[1; 1024]);
    assert_sum_eq(&[1; 1024 * 1024]);
  }

  #[test]
  fn random() {
    let mut random = [0; 1024 * 1024];
    SmallRng::from_entropy().fill(&mut random[..]);

    assert_sum_eq(&random[..1]);
    assert_sum_eq(&random[..100]);
    assert_sum_eq(&random[..1024]);
    assert_sum_eq(&random[..1024 * 1024]);
  }

  /// Example calculation from https://en.wikipedia.org/wiki/Adler-32.
  #[test]
  fn wiki() {
    assert_sum_eq(b"Wikipedia");
  }

  fn assert_sum_eq(data: &[u8]) {
    if let Some(update) = super::get_imp() {
      let (a, b) = update(1, 0, data);
      let left = u32::from(b) << 16 | u32::from(a);
      let right = adler2::adler32_slice(data);

      assert_eq!(left, right, "len({})", data.len());
    }
  }
}