chaotic_semantic_memory 0.3.6

//! Incremental bundle accumulator for streaming/sliding-window memory.

#[cfg(all(not(target_arch = "wasm32"), target_arch = "x86_64"))]
use crate::bundle_simd::{finalize_simd_avx2, update_counts_simd_avx2};
#[cfg(all(not(target_arch = "wasm32"), target_arch = "aarch64"))]
use crate::bundle_simd::{finalize_simd_neon, update_counts_simd_neon};
use crate::error::{MemoryError, Result};
use crate::hyperdim::HVec10240;

/// Incremental bundle accumulator for streaming/sliding-window memory.
///
/// Maintains signed bit counts for efficient add/remove operations.
/// Finalize applies majority threshold to produce a bundled hypervector.
#[derive(Debug, Clone)]
pub struct BundleAccumulator {
    counts: Box<[i32; HVec10240::DIMENSION]>,
    n: u32,
}

impl Default for BundleAccumulator {
    fn default() -> Self {
        Self {
            counts: Box::new([0i32; HVec10240::DIMENSION]),
            n: 0,
        }
    }
}

impl BundleAccumulator {
    /// Create a new empty accumulator.
    pub fn new() -> Self {
        Self {
            counts: Box::new([0i32; HVec10240::DIMENSION]),
            n: 0,
        }
    }

    /// Add a hypervector to the accumulator.
    pub fn add(&mut self, hv: &HVec10240) {
        #[cfg(all(not(target_arch = "wasm32"), target_arch = "x86_64"))]
        {
            if is_x86_feature_detected!("avx2") {
                // SAFETY: AVX2 feature detected at runtime.
                unsafe { update_counts_simd_avx2(&mut self.counts, &hv.data, 1) };
                self.n += 1;
                return;
            }
        }

        #[cfg(all(not(target_arch = "wasm32"), target_arch = "aarch64"))]
        {
            // SAFETY: update_counts_simd_neon is safe on aarch64.
            unsafe { update_counts_simd_neon(&mut self.counts, &hv.data, 1) };
            self.n += 1;
        }

        #[cfg(not(all(not(target_arch = "wasm32"), target_arch = "aarch64")))]
        {
            for i in 0..80 {
                let mut val = hv.data[i];
                while val != 0 {
                    let j = val.trailing_zeros() as usize;
                    self.counts[i * 128 + j] += 1;
                    val &= val - 1;
                }
            }
            self.n += 1;
        }
    }

    /// Remove a hypervector from the accumulator.
    ///
    /// Saturates at zero: removing from an empty accumulator is a no-op.
    /// Use [`Self::try_remove`] if you need to detect underflow.
    pub fn remove(&mut self, hv: &HVec10240) {
        if self.n == 0 {
            return;
        }

        #[cfg(all(not(target_arch = "wasm32"), target_arch = "x86_64"))]
        {
            if is_x86_feature_detected!("avx2") {
                // SAFETY: AVX2 feature detected at runtime.
                unsafe { update_counts_simd_avx2(&mut self.counts, &hv.data, -1) };
                self.n -= 1;
                return;
            }
        }

        #[cfg(all(not(target_arch = "wasm32"), target_arch = "aarch64"))]
        {
            // SAFETY: update_counts_simd_neon is safe on aarch64.
            unsafe { update_counts_simd_neon(&mut self.counts, &hv.data, -1) };
            self.n -= 1;
        }

        #[cfg(not(all(not(target_arch = "wasm32"), target_arch = "aarch64")))]
        {
            for i in 0..80 {
                let mut val = hv.data[i];
                while val != 0 {
                    let j = val.trailing_zeros() as usize;
                    self.counts[i * 128 + j] -= 1;
                    val &= val - 1;
                }
            }
            self.n -= 1;
        }
    }

    /// Remove a hypervector from the accumulator, returning an error if empty.
    ///
    /// Returns `Err(MemoryError::InvalidInput)` when the accumulator is empty.
    pub fn try_remove(&mut self, hv: &HVec10240) -> Result<()> {
        if self.n == 0 {
            return Err(MemoryError::InvalidInput {
                field: "accumulator".to_string(),
                reason: "cannot remove from empty BundleAccumulator".to_string(),
            });
        }

        #[cfg(all(not(target_arch = "wasm32"), target_arch = "x86_64"))]
        {
            if is_x86_feature_detected!("avx2") {
                // SAFETY: AVX2 feature detected at runtime.
                unsafe { update_counts_simd_avx2(&mut self.counts, &hv.data, -1) };
                self.n -= 1;
                return Ok(());
            }
        }

        #[cfg(all(not(target_arch = "wasm32"), target_arch = "aarch64"))]
        {
            // SAFETY: update_counts_simd_neon is safe on aarch64.
            unsafe { update_counts_simd_neon(&mut self.counts, &hv.data, -1) };
            self.n -= 1;
        }

        #[cfg(not(all(not(target_arch = "wasm32"), target_arch = "aarch64")))]
        {
            for i in 0..80 {
                let mut val = hv.data[i];
                while val != 0 {
                    let j = val.trailing_zeros() as usize;
                    self.counts[i * 128 + j] -= 1;
                    val &= val - 1;
                }
            }
            self.n -= 1;
            Ok(())
        }

        #[cfg(all(not(target_arch = "wasm32"), target_arch = "aarch64"))]
        Ok(())
    }

    /// Finalize the accumulator into a bundled hypervector.
    ///
    /// Applies majority threshold: bits with count > 0 are set to 1.
    /// Returns zero vector if accumulator is empty.
    pub fn finalize(&self) -> HVec10240 {
        if self.n == 0 {
            return HVec10240::zero();
        }

        let threshold = (self.n / 2) as i32;

        #[cfg(all(not(target_arch = "wasm32"), target_arch = "x86_64"))]
        {
            if is_x86_feature_detected!("avx2") {
                // SAFETY: AVX2 feature detected at runtime.
                return HVec10240 {
                    data: unsafe { finalize_simd_avx2(&self.counts, threshold) },
                };
            }
        }

        #[cfg(all(not(target_arch = "wasm32"), target_arch = "aarch64"))]
        {
            // SAFETY: finalize_simd_neon is safe on aarch64.
            return HVec10240 {
                data: unsafe { finalize_simd_neon(&self.counts, threshold) },
            };
        }

        #[cfg(not(all(not(target_arch = "wasm32"), target_arch = "aarch64")))]
        {
            let mut data = [0u128; 80];

            for (i, word) in data.iter_mut().enumerate() {
                let offset = i * 128;
                for j in 0..128 {
                    // Branchless bit construction to reduce misprediction penalties
                    let condition = self.counts[offset + j] > threshold;
                    *word |= (condition as u128) << j;
                }
            }

            HVec10240 { data }
        }
    }

    /// Get the number of hypervectors in the accumulator.
    pub const fn len(&self) -> u32 {
        self.n
    }

    /// Check if the accumulator is empty.
    pub const fn is_empty(&self) -> bool {
        self.n == 0
    }

    /// Clear the accumulator.
    pub fn clear(&mut self) {
        *self.counts = [0i32; HVec10240::DIMENSION];
        self.n = 0;
    }
}

#[cfg(test)]
mod tests {
    use super::*;

    #[test]
    fn test_bundle_accumulator_add_finalize() {
        let v1 = HVec10240::random();
        let v2 = HVec10240::random();
        let v3 = HVec10240::random();

        let mut acc = BundleAccumulator::new();
        acc.add(&v1);
        acc.add(&v2);
        acc.add(&v3);

        let bundled = acc.finalize();
        // Bundle should be valid (not zero)
        assert_ne!(bundled, HVec10240::zero());
        // Should have 3 vectors
        assert_eq!(acc.len(), 3);
    }

    #[test]
    fn test_bundle_accumulator_remove() {
        let v1 = HVec10240::random();
        let v2 = HVec10240::random();

        let mut acc = BundleAccumulator::new();
        acc.add(&v1);
        acc.add(&v2);
        acc.remove(&v2);

        assert_eq!(acc.len(), 1);
        let bundled = acc.finalize();
        // Single vector bundle should be close to the original
        assert!(bundled.cosine_similarity(&v1) > 0.9);
    }

    #[test]
    fn test_bundle_accumulator_empty() {
        let acc = BundleAccumulator::new();
        assert!(acc.is_empty());
        assert_eq!(acc.finalize(), HVec10240::zero());
    }

    #[test]
    fn test_bundle_accumulator_clear() {
        let mut acc = BundleAccumulator::new();
        acc.add(&HVec10240::random());
        acc.clear();
        assert!(acc.is_empty());
    }
}