#![cfg(all(feature = "simd-neon", target_arch = "aarch64"))]
use core::arch::aarch64::*;
use crate::error::{QuantError, QuantResult};
use crate::traits::QuantKernel;
use crate::types::QuantTensor;
pub const BLOCK_SIZE: usize = 256;
pub const BLOCK_BYTES: usize = 144;
#[allow(non_camel_case_types)]
pub struct Q4_KNeon;
#[inline(always)]
fn f16_to_f32(bytes: &[u8]) -> f32 {
let bits = u16::from_le_bytes([bytes[0], bytes[1]]);
half::f16::from_bits(bits).to_f32()
}
#[inline(always)]
unsafe fn hsum_f32x4(v: float32x4_t) -> f32 {
unsafe { vaddvq_f32(v) }
}
fn decode_scales_mins(scales_raw: &[u8]) -> ([u8; 8], [u8; 8]) {
let mut sc = [0u8; 8];
let mut mn = [0u8; 8];
for j in 0..4 {
sc[j] = scales_raw[j] & 0x3F;
mn[j] = scales_raw[j + 4] & 0x3F;
}
for j in 4..8 {
let lo_sc = scales_raw[j + 4] & 0x0F;
let hi_sc = (scales_raw[j - 4] >> 6) & 0x03;
sc[j] = lo_sc | (hi_sc << 4);
let lo_mn = (scales_raw[j + 4] >> 4) & 0x0F;
let hi_mn = (scales_raw[j] >> 6) & 0x03;
mn[j] = lo_mn | (hi_mn << 4);
}
(sc, mn)
}
#[inline(always)]
unsafe fn nibbles_low_to_f32(nibbles: uint8x16_t) -> float32x4_t {
unsafe {
let u16_8 = vmovl_u8(vget_low_u8(nibbles));
let u32_4 = vmovl_u16(vget_low_u16(u16_8));
vcvtq_f32_u32(u32_4)
}
}
#[inline(always)]
unsafe fn nibbles_mid_to_f32(nibbles: uint8x16_t) -> float32x4_t {
unsafe {
let u16_8 = vmovl_u8(vget_low_u8(nibbles));
let u32_4 = vmovl_high_u16(u16_8);
vcvtq_f32_u32(u32_4)
}
}
#[inline(always)]
unsafe fn nibbles_hi_low_to_f32(nibbles: uint8x16_t) -> float32x4_t {
unsafe {
let u16_8 = vmovl_u8(vget_high_u8(nibbles));
let u32_4 = vmovl_u16(vget_low_u16(u16_8));
vcvtq_f32_u32(u32_4)
}
}
#[inline(always)]
unsafe fn nibbles_hi_high_to_f32(nibbles: uint8x16_t) -> float32x4_t {
unsafe {
let u16_8 = vmovl_u8(vget_high_u8(nibbles));
let u32_4 = vmovl_high_u16(u16_8);
vcvtq_f32_u32(u32_4)
}
}
#[inline(always)]
unsafe fn scale_nibbles(q: float32x4_t, a: float32x4_t, b: float32x4_t) -> float32x4_t {
unsafe { vfmaq_f32(vnegq_f32(b), a, q) }
}
unsafe fn dequant_block_neon(block: &[u8], output: &mut [f32]) {
let d = f16_to_f32(block);
let dmin = f16_to_f32(&block[2..]);
let (sc, mn) = decode_scales_mins(&block[4..16]);
let qs = &block[16..144];
let mask_lo = unsafe { vdupq_n_u8(0x0F) };
let mut is = 0usize;
let mut qs_off = 0usize;
let mut out_off = 0usize;
for _group in 0..4 {
let a_lo = d * sc[is] as f32;
let b_lo = dmin * mn[is] as f32;
let a_hi = d * sc[is + 1] as f32;
let b_hi = dmin * mn[is + 1] as f32;
let va_lo = unsafe { vdupq_n_f32(a_lo) };
let vb_lo = unsafe { vdupq_n_f32(b_lo) };
let va_hi = unsafe { vdupq_n_f32(a_hi) };
let vb_hi = unsafe { vdupq_n_f32(b_hi) };
let raw_lo = unsafe { vld1q_u8(qs.as_ptr().add(qs_off)) };
let raw_hi = unsafe { vld1q_u8(qs.as_ptr().add(qs_off + 16)) };
let lo0 = unsafe { vandq_u8(raw_lo, mask_lo) };
let lo1 = unsafe { vandq_u8(raw_hi, mask_lo) };
let hi0 = unsafe { vshrq_n_u8::<4>(raw_lo) };
let hi1 = unsafe { vshrq_n_u8::<4>(raw_hi) };
let w0 = unsafe { scale_nibbles(nibbles_low_to_f32(lo0), va_lo, vb_lo) };
let w1 = unsafe { scale_nibbles(nibbles_mid_to_f32(lo0), va_lo, vb_lo) };
let w2 = unsafe { scale_nibbles(nibbles_hi_low_to_f32(lo0), va_lo, vb_lo) };
let w3 = unsafe { scale_nibbles(nibbles_hi_high_to_f32(lo0), va_lo, vb_lo) };
let w4 = unsafe { scale_nibbles(nibbles_low_to_f32(lo1), va_lo, vb_lo) };
let w5 = unsafe { scale_nibbles(nibbles_mid_to_f32(lo1), va_lo, vb_lo) };
let w6 = unsafe { scale_nibbles(nibbles_hi_low_to_f32(lo1), va_lo, vb_lo) };
let w7 = unsafe { scale_nibbles(nibbles_hi_high_to_f32(lo1), va_lo, vb_lo) };
let ptr = output.as_mut_ptr().add(out_off);
unsafe {
vst1q_f32(ptr, w0);
vst1q_f32(ptr.add(4), w1);
vst1q_f32(ptr.add(8), w2);
vst1q_f32(ptr.add(12), w3);
vst1q_f32(ptr.add(16), w4);
vst1q_f32(ptr.add(20), w5);
vst1q_f32(ptr.add(24), w6);
vst1q_f32(ptr.add(28), w7);
}
let wh0 = unsafe { scale_nibbles(nibbles_low_to_f32(hi0), va_hi, vb_hi) };
let wh1 = unsafe { scale_nibbles(nibbles_mid_to_f32(hi0), va_hi, vb_hi) };
let wh2 = unsafe { scale_nibbles(nibbles_hi_low_to_f32(hi0), va_hi, vb_hi) };
let wh3 = unsafe { scale_nibbles(nibbles_hi_high_to_f32(hi0), va_hi, vb_hi) };
let wh4 = unsafe { scale_nibbles(nibbles_low_to_f32(hi1), va_hi, vb_hi) };
let wh5 = unsafe { scale_nibbles(nibbles_mid_to_f32(hi1), va_hi, vb_hi) };
let wh6 = unsafe { scale_nibbles(nibbles_hi_low_to_f32(hi1), va_hi, vb_hi) };
let wh7 = unsafe { scale_nibbles(nibbles_hi_high_to_f32(hi1), va_hi, vb_hi) };
let ptr2 = output.as_mut_ptr().add(out_off + 32);
unsafe {
vst1q_f32(ptr2, wh0);
vst1q_f32(ptr2.add(4), wh1);
vst1q_f32(ptr2.add(8), wh2);
vst1q_f32(ptr2.add(12), wh3);
vst1q_f32(ptr2.add(16), wh4);
vst1q_f32(ptr2.add(20), wh5);
vst1q_f32(ptr2.add(24), wh6);
vst1q_f32(ptr2.add(28), wh7);
}
is += 2;
qs_off += 32;
out_off += 64;
}
}
unsafe fn gemv_row_neon(
row_data: &[u8],
input: &[f32],
blocks_per_row: usize,
n_cols: usize,
) -> f32 {
let mut row_sum = 0.0f32;
for blk in 0..blocks_per_row {
let block_offset = blk * BLOCK_BYTES;
let block = &row_data[block_offset..block_offset + BLOCK_BYTES];
let input_offset = blk * BLOCK_SIZE;
let remaining = n_cols.saturating_sub(input_offset);
let d = f16_to_f32(block);
let dmin = f16_to_f32(&block[2..]);
let (sc, mn) = decode_scales_mins(&block[4..16]);
if remaining >= BLOCK_SIZE {
let qs = &block[16..144];
let mask_lo = unsafe { vdupq_n_u8(0x0F) };
let mut block_acc = unsafe { vdupq_n_f32(0.0f32) };
let mut is = 0usize;
let mut qs_off = 0usize;
let mut w_off = input_offset;
for _group in 0..4 {
let a_lo = d * sc[is] as f32;
let b_lo = dmin * mn[is] as f32;
let a_hi = d * sc[is + 1] as f32;
let b_hi = dmin * mn[is + 1] as f32;
let va_lo = unsafe { vdupq_n_f32(a_lo) };
let vb_lo = unsafe { vdupq_n_f32(b_lo) };
let va_hi = unsafe { vdupq_n_f32(a_hi) };
let vb_hi = unsafe { vdupq_n_f32(b_hi) };
let raw_lo = unsafe { vld1q_u8(qs.as_ptr().add(qs_off)) };
let raw_hi = unsafe { vld1q_u8(qs.as_ptr().add(qs_off + 16)) };
let lo0 = unsafe { vandq_u8(raw_lo, mask_lo) };
let lo1 = unsafe { vandq_u8(raw_hi, mask_lo) };
let hi0 = unsafe { vshrq_n_u8::<4>(raw_lo) };
let hi1 = unsafe { vshrq_n_u8::<4>(raw_hi) };
let inp_lo = input.as_ptr().add(w_off);
let inp_hi = input.as_ptr().add(w_off + 32);
let i0 = unsafe { vld1q_f32(inp_lo) };
let i1 = unsafe { vld1q_f32(inp_lo.add(4)) };
let i2 = unsafe { vld1q_f32(inp_lo.add(8)) };
let i3 = unsafe { vld1q_f32(inp_lo.add(12)) };
let i4 = unsafe { vld1q_f32(inp_lo.add(16)) };
let i5 = unsafe { vld1q_f32(inp_lo.add(20)) };
let i6 = unsafe { vld1q_f32(inp_lo.add(24)) };
let i7 = unsafe { vld1q_f32(inp_lo.add(28)) };
let w0 = unsafe { scale_nibbles(nibbles_low_to_f32(lo0), va_lo, vb_lo) };
let w1 = unsafe { scale_nibbles(nibbles_mid_to_f32(lo0), va_lo, vb_lo) };
let w2 = unsafe { scale_nibbles(nibbles_hi_low_to_f32(lo0), va_lo, vb_lo) };
let w3 = unsafe { scale_nibbles(nibbles_hi_high_to_f32(lo0), va_lo, vb_lo) };
let w4 = unsafe { scale_nibbles(nibbles_low_to_f32(lo1), va_lo, vb_lo) };
let w5 = unsafe { scale_nibbles(nibbles_mid_to_f32(lo1), va_lo, vb_lo) };
let w6 = unsafe { scale_nibbles(nibbles_hi_low_to_f32(lo1), va_lo, vb_lo) };
let w7 = unsafe { scale_nibbles(nibbles_hi_high_to_f32(lo1), va_lo, vb_lo) };
block_acc = unsafe { vfmaq_f32(block_acc, w0, i0) };
block_acc = unsafe { vfmaq_f32(block_acc, w1, i1) };
block_acc = unsafe { vfmaq_f32(block_acc, w2, i2) };
block_acc = unsafe { vfmaq_f32(block_acc, w3, i3) };
block_acc = unsafe { vfmaq_f32(block_acc, w4, i4) };
block_acc = unsafe { vfmaq_f32(block_acc, w5, i5) };
block_acc = unsafe { vfmaq_f32(block_acc, w6, i6) };
block_acc = unsafe { vfmaq_f32(block_acc, w7, i7) };
let i8 = unsafe { vld1q_f32(inp_hi) };
let i9 = unsafe { vld1q_f32(inp_hi.add(4)) };
let i10 = unsafe { vld1q_f32(inp_hi.add(8)) };
let i11 = unsafe { vld1q_f32(inp_hi.add(12)) };
let i12 = unsafe { vld1q_f32(inp_hi.add(16)) };
let i13 = unsafe { vld1q_f32(inp_hi.add(20)) };
let i14 = unsafe { vld1q_f32(inp_hi.add(24)) };
let i15 = unsafe { vld1q_f32(inp_hi.add(28)) };
let wh0 = unsafe { scale_nibbles(nibbles_low_to_f32(hi0), va_hi, vb_hi) };
let wh1 = unsafe { scale_nibbles(nibbles_mid_to_f32(hi0), va_hi, vb_hi) };
let wh2 = unsafe { scale_nibbles(nibbles_hi_low_to_f32(hi0), va_hi, vb_hi) };
let wh3 = unsafe { scale_nibbles(nibbles_hi_high_to_f32(hi0), va_hi, vb_hi) };
let wh4 = unsafe { scale_nibbles(nibbles_low_to_f32(hi1), va_hi, vb_hi) };
let wh5 = unsafe { scale_nibbles(nibbles_mid_to_f32(hi1), va_hi, vb_hi) };
let wh6 = unsafe { scale_nibbles(nibbles_hi_low_to_f32(hi1), va_hi, vb_hi) };
let wh7 = unsafe { scale_nibbles(nibbles_hi_high_to_f32(hi1), va_hi, vb_hi) };
block_acc = unsafe { vfmaq_f32(block_acc, wh0, i8) };
block_acc = unsafe { vfmaq_f32(block_acc, wh1, i9) };
block_acc = unsafe { vfmaq_f32(block_acc, wh2, i10) };
block_acc = unsafe { vfmaq_f32(block_acc, wh3, i11) };
block_acc = unsafe { vfmaq_f32(block_acc, wh4, i12) };
block_acc = unsafe { vfmaq_f32(block_acc, wh5, i13) };
block_acc = unsafe { vfmaq_f32(block_acc, wh6, i14) };
block_acc = unsafe { vfmaq_f32(block_acc, wh7, i15) };
is += 2;
qs_off += 32;
w_off += 64;
}
row_sum += unsafe { hsum_f32x4(block_acc) };
} else if remaining > 0 {
let qs = &block[16..144];
let mut partial_sum = 0.0f32;
let mut is = 0usize;
let mut qs_off = 0usize;
let mut w_off = input_offset;
for _group in 0..4 {
let d1 = d * sc[is] as f32;
let m1 = dmin * mn[is] as f32;
let d2 = d * sc[is + 1] as f32;
let m2 = dmin * mn[is + 1] as f32;
for l in 0..32 {
let idx = w_off + l;
if idx < n_cols {
let q = (unsafe { *qs.get_unchecked(qs_off + l) } & 0x0F) as f32;
partial_sum += (d1 * q - m1) * input[idx];
}
}
for l in 0..32 {
let idx = w_off + 32 + l;
if idx < n_cols {
let q = ((unsafe { *qs.get_unchecked(qs_off + l) } >> 4) & 0x0F) as f32;
partial_sum += (d2 * q - m2) * input[idx];
}
}
is += 2;
qs_off += 32;
w_off += 64;
}
row_sum += partial_sum;
}
}
row_sum
}
impl QuantKernel for Q4_KNeon {
fn dequant_block(&self, block: &[u8], output: &mut [f32]) -> QuantResult<()> {
if block.len() < BLOCK_BYTES {
return Err(QuantError::BufferTooSmall {
needed: BLOCK_BYTES,
available: block.len(),
});
}
if output.len() < BLOCK_SIZE {
return Err(QuantError::BufferTooSmall {
needed: BLOCK_SIZE,
available: output.len(),
});
}
unsafe { dequant_block_neon(block, output) }
Ok(())
}
fn gemv(
&self,
quant_matrix: &QuantTensor,
input: &[f32],
output: &mut [f32],
) -> QuantResult<()> {
let n_rows = quant_matrix.shape[0];
let n_cols = if quant_matrix.shape.len() > 1 {
quant_matrix.shape[1]
} else {
quant_matrix.n_elements() / n_rows
};
if input.len() < n_cols {
return Err(QuantError::DimensionMismatch {
expected: n_cols,
got: input.len(),
});
}
if output.len() < n_rows {
return Err(QuantError::DimensionMismatch {
expected: n_rows,
got: output.len(),
});
}
let blocks_per_row = n_cols.div_ceil(BLOCK_SIZE);
let row_bytes = blocks_per_row * BLOCK_BYTES;
for (row, out) in output.iter_mut().enumerate().take(n_rows) {
let row_start = row * row_bytes;
*out = unsafe {
gemv_row_neon(
&quant_matrix.data[row_start..row_start + row_bytes],
input,
blocks_per_row,
n_cols,
)
};
}
Ok(())
}
fn gemm(
&self,
quant_matrix: &QuantTensor,
input: &[f32],
output: &mut [f32],
m: usize,
n: usize,
k: usize,
) -> QuantResult<()> {
for row in 0..m {
let input_row = &input[row * k..(row + 1) * k];
let output_row = &mut output[row * n..(row + 1) * n];
self.gemv(quant_matrix, input_row, output_row)?;
}
Ok(())
}
fn matvec_q8_fused(
&self,
weights: &[u8],
acts_q8: &[u8],
out: &mut [f32],
n_rows: usize,
n_cols: usize,
) -> QuantResult<()> {
if out.len() < n_rows {
return Err(QuantError::DimensionMismatch {
expected: n_rows,
got: out.len(),
});
}
let blocks_per_row = n_cols.div_ceil(BLOCK_SIZE);
let row_bytes = blocks_per_row * BLOCK_BYTES;
let q8_blocks_per_row = blocks_per_row * 8;
let acts_needed = q8_blocks_per_row * Q8_0_BLOCK_BYTES;
if weights.len() < n_rows * row_bytes {
return Err(QuantError::BufferTooSmall {
needed: n_rows * row_bytes,
available: weights.len(),
});
}
if acts_q8.len() < acts_needed {
return Err(QuantError::BufferTooSmall {
needed: acts_needed,
available: acts_q8.len(),
});
}
for (row, out_val) in out.iter_mut().enumerate().take(n_rows) {
let row_start = row * row_bytes;
let row_sum = unsafe {
fused_q4k_q8_0_row_neon(
&weights[row_start..row_start + row_bytes],
acts_q8,
blocks_per_row,
n_cols,
)
};
*out_val += row_sum; }
Ok(())
}
fn block_size(&self) -> usize {
BLOCK_SIZE
}
fn block_bytes(&self) -> usize {
BLOCK_BYTES
}
fn name(&self) -> &'static str {
"Q4_K_NEON"
}
}
const Q8_0_BLOCK_BYTES: usize = 34;
unsafe fn fused_q4k_q8_0_row_neon(
row_data: &[u8],
acts_q8: &[u8],
blocks_per_row: usize,
n_cols: usize,
) -> f32 {
let mut row_sum = 0.0f32;
for blk in 0..blocks_per_row {
let block_offset = blk * BLOCK_BYTES;
let block = &row_data[block_offset..block_offset + BLOCK_BYTES];
let input_offset = blk * BLOCK_SIZE;
let remaining = n_cols.saturating_sub(input_offset);
let d = f16_to_f32(block);
let dmin = f16_to_f32(&block[2..]);
let (sc, mn) = decode_scales_mins(&block[4..16]);
if remaining >= BLOCK_SIZE {
let qs = &block[16..144];
let mask_lo = unsafe { vdupq_n_u8(0x0F) };
let mut block_sum = 0.0f32;
let mut is = 0usize;
let mut qs_off = 0usize;
for _group in 0..4 {
let a_idx_lo = blk * 8 + is;
let a_start_lo = a_idx_lo * Q8_0_BLOCK_BYTES;
let a_block_lo = &acts_q8[a_start_lo..a_start_lo + Q8_0_BLOCK_BYTES];
let d_a_lo = f16_to_f32(a_block_lo);
let q8_lo_ptr = a_block_lo.as_ptr().add(2) as *const i8;
let a_idx_hi = blk * 8 + is + 1;
let a_start_hi = a_idx_hi * Q8_0_BLOCK_BYTES;
let a_block_hi = &acts_q8[a_start_hi..a_start_hi + Q8_0_BLOCK_BYTES];
let d_a_hi = f16_to_f32(a_block_hi);
let q8_hi_ptr = a_block_hi.as_ptr().add(2) as *const i8;
let da_lo = d * sc[is] as f32;
let m_lo = dmin * mn[is] as f32;
let da_hi = d * sc[is + 1] as f32;
let m_hi = dmin * mn[is + 1] as f32;
let raw_lo = unsafe { vld1q_u8(qs.as_ptr().add(qs_off)) };
let raw_hi = unsafe { vld1q_u8(qs.as_ptr().add(qs_off + 16)) };
let lo0 = unsafe { vandq_u8(raw_lo, mask_lo) }; let lo1 = unsafe { vandq_u8(raw_hi, mask_lo) }; let hi0 = unsafe { vshrq_n_u8::<4>(raw_lo) }; let hi1 = unsafe { vshrq_n_u8::<4>(raw_hi) };
let qa_lo_0 = unsafe { vld1q_s8(q8_lo_ptr) };
let qa_lo_1 = unsafe { vld1q_s8(q8_lo_ptr.add(16)) };
let dot_lo = {
let w0 = unsafe { vreinterpretq_s16_u16(vmovl_u8(vget_low_u8(lo0))) };
let w1 = unsafe { vreinterpretq_s16_u16(vmovl_u8(vget_high_u8(lo0))) };
let w2 = unsafe { vreinterpretq_s16_u16(vmovl_u8(vget_low_u8(lo1))) };
let w3 = unsafe { vreinterpretq_s16_u16(vmovl_u8(vget_high_u8(lo1))) };
let a0 = unsafe { vmovl_s8(vget_low_s8(qa_lo_0)) };
let a1 = unsafe { vmovl_s8(vget_high_s8(qa_lo_0)) };
let a2 = unsafe { vmovl_s8(vget_low_s8(qa_lo_1)) };
let a3 = unsafe { vmovl_s8(vget_high_s8(qa_lo_1)) };
let p0 = unsafe { vmull_s16(vget_low_s16(w0), vget_low_s16(a0)) };
let p1 = unsafe { vmlal_s16(p0, vget_high_s16(w0), vget_high_s16(a0)) };
let p2 = unsafe { vmlal_s16(p1, vget_low_s16(w1), vget_low_s16(a1)) };
let p3 = unsafe { vmlal_s16(p2, vget_high_s16(w1), vget_high_s16(a1)) };
let p4 = unsafe { vmlal_s16(p3, vget_low_s16(w2), vget_low_s16(a2)) };
let p5 = unsafe { vmlal_s16(p4, vget_high_s16(w2), vget_high_s16(a2)) };
let p6 = unsafe { vmlal_s16(p5, vget_low_s16(w3), vget_low_s16(a3)) };
let p7 = unsafe { vmlal_s16(p6, vget_high_s16(w3), vget_high_s16(a3)) };
unsafe { vaddvq_s32(p7) }
};
let sum_a_lo = {
let a_i16_0 = unsafe { vmovl_s8(vget_low_s8(qa_lo_0)) };
let a_i16_1 = unsafe { vmovl_s8(vget_high_s8(qa_lo_0)) };
let a_i16_2 = unsafe { vmovl_s8(vget_low_s8(qa_lo_1)) };
let a_i16_3 = unsafe { vmovl_s8(vget_high_s8(qa_lo_1)) };
let s0 = unsafe { vaddl_s16(vget_low_s16(a_i16_0), vget_high_s16(a_i16_0)) };
let s1 = unsafe { vaddl_s16(vget_low_s16(a_i16_1), vget_high_s16(a_i16_1)) };
let s2 = unsafe { vaddl_s16(vget_low_s16(a_i16_2), vget_high_s16(a_i16_2)) };
let s3 = unsafe { vaddl_s16(vget_low_s16(a_i16_3), vget_high_s16(a_i16_3)) };
let sum_i32 = unsafe { vaddq_s32(vaddq_s32(s0, s1), vaddq_s32(s2, s3)) };
unsafe { vaddvq_s32(sum_i32) }
};
block_sum += (da_lo * dot_lo as f32 - m_lo * sum_a_lo as f32) * d_a_lo;
let qa_hi_0 = unsafe { vld1q_s8(q8_hi_ptr) };
let qa_hi_1 = unsafe { vld1q_s8(q8_hi_ptr.add(16)) };
let dot_hi = {
let w0 = unsafe { vreinterpretq_s16_u16(vmovl_u8(vget_low_u8(hi0))) };
let w1 = unsafe { vreinterpretq_s16_u16(vmovl_u8(vget_high_u8(hi0))) };
let w2 = unsafe { vreinterpretq_s16_u16(vmovl_u8(vget_low_u8(hi1))) };
let w3 = unsafe { vreinterpretq_s16_u16(vmovl_u8(vget_high_u8(hi1))) };
let a0 = unsafe { vmovl_s8(vget_low_s8(qa_hi_0)) };
let a1 = unsafe { vmovl_s8(vget_high_s8(qa_hi_0)) };
let a2 = unsafe { vmovl_s8(vget_low_s8(qa_hi_1)) };
let a3 = unsafe { vmovl_s8(vget_high_s8(qa_hi_1)) };
let p0 = unsafe { vmull_s16(vget_low_s16(w0), vget_low_s16(a0)) };
let p1 = unsafe { vmlal_s16(p0, vget_high_s16(w0), vget_high_s16(a0)) };
let p2 = unsafe { vmlal_s16(p1, vget_low_s16(w1), vget_low_s16(a1)) };
let p3 = unsafe { vmlal_s16(p2, vget_high_s16(w1), vget_high_s16(a1)) };
let p4 = unsafe { vmlal_s16(p3, vget_low_s16(w2), vget_low_s16(a2)) };
let p5 = unsafe { vmlal_s16(p4, vget_high_s16(w2), vget_high_s16(a2)) };
let p6 = unsafe { vmlal_s16(p5, vget_low_s16(w3), vget_low_s16(a3)) };
let p7 = unsafe { vmlal_s16(p6, vget_high_s16(w3), vget_high_s16(a3)) };
unsafe { vaddvq_s32(p7) }
};
let sum_a_hi = {
let a_i16_0 = unsafe { vmovl_s8(vget_low_s8(qa_hi_0)) };
let a_i16_1 = unsafe { vmovl_s8(vget_high_s8(qa_hi_0)) };
let a_i16_2 = unsafe { vmovl_s8(vget_low_s8(qa_hi_1)) };
let a_i16_3 = unsafe { vmovl_s8(vget_high_s8(qa_hi_1)) };
let s0 = unsafe { vaddl_s16(vget_low_s16(a_i16_0), vget_high_s16(a_i16_0)) };
let s1 = unsafe { vaddl_s16(vget_low_s16(a_i16_1), vget_high_s16(a_i16_1)) };
let s2 = unsafe { vaddl_s16(vget_low_s16(a_i16_2), vget_high_s16(a_i16_2)) };
let s3 = unsafe { vaddl_s16(vget_low_s16(a_i16_3), vget_high_s16(a_i16_3)) };
let sum_i32 = unsafe { vaddq_s32(vaddq_s32(s0, s1), vaddq_s32(s2, s3)) };
unsafe { vaddvq_s32(sum_i32) }
};
block_sum += (da_hi * dot_hi as f32 - m_hi * sum_a_hi as f32) * d_a_hi;
is += 2;
qs_off += 32;
}
row_sum += block_sum;
} else if remaining > 0 {
let qs = &block[16..144];
let mut partial_sum = 0.0f32;
let mut is = 0usize;
let mut qs_off = 0usize;
let mut w_off = input_offset;
for _group in 0..4 {
let a_idx_lo = blk * 8 + is;
let a_start_lo = a_idx_lo * Q8_0_BLOCK_BYTES;
let a_block_lo = &acts_q8[a_start_lo..a_start_lo + Q8_0_BLOCK_BYTES];
let d_a_lo = f16_to_f32(a_block_lo);
let q8_lo = &a_block_lo[2..];
let a_idx_hi = blk * 8 + is + 1;
let a_start_hi = a_idx_hi * Q8_0_BLOCK_BYTES;
let a_block_hi = &acts_q8[a_start_hi..a_start_hi + Q8_0_BLOCK_BYTES];
let d_a_hi = f16_to_f32(a_block_hi);
let q8_hi = &a_block_hi[2..];
let da_lo = d * sc[is] as f32;
let m_lo = dmin * mn[is] as f32;
let da_hi = d * sc[is + 1] as f32;
let m_hi = dmin * mn[is + 1] as f32;
let mut dot_lo = 0.0f32;
let mut sum_a_lo = 0.0f32;
for l in 0..32 {
let idx = w_off + l;
if idx < n_cols {
let q_w = (qs[qs_off + l] & 0x0F) as f32;
let q_a = q8_lo[l] as i8 as f32;
dot_lo += q_w * q_a;
sum_a_lo += q_a;
}
}
partial_sum += (da_lo * dot_lo - m_lo * sum_a_lo) * d_a_lo;
let mut dot_hi = 0.0f32;
let mut sum_a_hi = 0.0f32;
for l in 0..32 {
let idx = w_off + 32 + l;
if idx < n_cols {
let q_w = ((qs[qs_off + l] >> 4) & 0x0F) as f32;
let q_a = q8_hi[l] as i8 as f32;
dot_hi += q_w * q_a;
sum_a_hi += q_a;
}
}
partial_sum += (da_hi * dot_hi - m_hi * sum_a_hi) * d_a_hi;
is += 2;
qs_off += 32;
w_off += 64;
}
row_sum += partial_sum;
}
}
row_sum
}
#[cfg(all(test, feature = "simd-neon", target_arch = "aarch64"))]
mod tests {
use super::*;
use crate::reference::q4_k::Q4KRef;
fn make_q4_k_block(d: f32, dmin: f32, scales: &[u8; 12], qs: &[u8; 128]) -> Vec<u8> {
let mut block = Vec::with_capacity(BLOCK_BYTES);
block.extend_from_slice(&half::f16::from_f32(d).to_bits().to_le_bytes());
block.extend_from_slice(&half::f16::from_f32(dmin).to_bits().to_le_bytes());
block.extend_from_slice(scales);
block.extend_from_slice(qs);
block
}
fn make_tensor(block: Vec<u8>, n_cols: usize) -> QuantTensor {
QuantTensor::new(block, vec![1, n_cols], oxillama_gguf::GgufTensorType::Q4K)
}
#[test]
fn test_dequant_matches_reference() {
let mut scales = [0u8; 12];
scales[0] = 5;
scales[1] = 3;
scales[2] = 7;
scales[3] = 2;
scales[4] = 4;
scales[5] = 6;
scales[6] = 1;
scales[7] = 3;
scales[8] = 9;
scales[9] = 11;
scales[10] = 13;
scales[11] = 15;
let qs = [0xA5u8; 128];
let block = make_q4_k_block(0.5, 0.1, &scales, &qs);
let mut out_neon = vec![0.0f32; 256];
let mut out_ref = vec![0.0f32; 256];
Q4_KNeon
.dequant_block(&block, &mut out_neon)
.expect("neon dequant");
Q4KRef
.dequant_block(&block, &mut out_ref)
.expect("ref dequant");
for (i, (&a, &r)) in out_neon.iter().zip(out_ref.iter()).enumerate() {
assert!(
(a - r).abs() < 1e-3,
"dequant mismatch at index {i}: neon={a}, ref={r}"
);
}
}
#[test]
fn test_dequant_all_nibbles_8() {
let mut scales = [0u8; 12];
scales[..4].fill(1);
scales[8..12].fill(1);
let qs = [0x88u8; 128];
let block = make_q4_k_block(1.0, 0.0, &scales, &qs);
let mut out_neon = vec![0.0f32; 256];
let mut out_ref = vec![0.0f32; 256];
Q4_KNeon
.dequant_block(&block, &mut out_neon)
.expect("neon dequant");
Q4KRef
.dequant_block(&block, &mut out_ref)
.expect("ref dequant");
let max_err = out_neon
.iter()
.zip(out_ref.iter())
.map(|(a, b)| (a - b).abs())
.fold(0.0f32, f32::max);
assert!(max_err < 1e-3, "dequant max error {max_err}");
}
#[test]
fn test_gemv_matches_reference() {
let mut scales = [0u8; 12];
scales[..4].fill(1);
scales[8..12].fill(1);
let qs = [0x88u8; 128];
let block = make_q4_k_block(1.0, 0.0, &scales, &qs);
let tensor_neon = make_tensor(block.clone(), 256);
let tensor_ref = make_tensor(block, 256);
let input: Vec<f32> = (0..256).map(|i| (i as f32) * 0.01 - 1.0).collect();
let mut out_neon = vec![0.0f32; 1];
let mut out_ref = vec![0.0f32; 1];
Q4_KNeon
.gemv(&tensor_neon, &input, &mut out_neon)
.expect("neon gemv");
Q4KRef
.gemv(&tensor_ref, &input, &mut out_ref)
.expect("ref gemv");
let err = (out_neon[0] - out_ref[0]).abs();
assert!(
err < 1e-3,
"gemv mismatch: neon={}, ref={}, err={}",
out_neon[0],
out_ref[0],
err
);
}
#[test]
fn test_gemv_uniform_all_ones() {
let mut scales = [0u8; 12];
scales[..4].fill(1);
scales[8..12].fill(1);
let qs = [0x11u8; 128];
let block = make_q4_k_block(1.0, 0.0, &scales, &qs);
let tensor = make_tensor(block, 256);
let input = vec![1.0f32; 256];
let mut out = vec![0.0f32; 1];
Q4_KNeon.gemv(&tensor, &input, &mut out).expect("neon gemv");
assert!(
(out[0] - 256.0).abs() < 1.0,
"expected ~256.0, got {}",
out[0]
);
}
#[test]
fn test_gemv_partial_block() {
let mut scales = [0u8; 12];
scales[..4].fill(1);
scales[8..12].fill(1);
let qs = [0x11u8; 128];
let block = make_q4_k_block(1.0, 0.0, &scales, &qs);
let tensor_neon = make_tensor(block.clone(), 200);
let tensor_ref = make_tensor(block, 200);
let input = vec![1.0f32; 200];
let mut out_neon = vec![0.0f32; 1];
let mut out_ref = vec![0.0f32; 1];
Q4_KNeon
.gemv(&tensor_neon, &input, &mut out_neon)
.expect("neon gemv");
Q4KRef
.gemv(&tensor_ref, &input, &mut out_ref)
.expect("ref gemv");
let err = (out_neon[0] - out_ref[0]).abs();
assert!(
err < 0.1,
"partial gemv mismatch: neon={}, ref={}, err={}",
out_neon[0],
out_ref[0],
err
);
}
#[test]
fn test_gemv_multi_row() {
let n_rows = 3usize;
let n_cols = 512usize;
let mut scales = [0u8; 12];
scales[..4].fill(2);
scales[4..8].fill(1);
scales[8..12].fill(3);
let qs: Vec<u8> = (0..128u8).collect();
let qs_arr: [u8; 128] = qs.try_into().expect("slice conversion");
let block = make_q4_k_block(0.5, 0.05, &scales, &qs_arr);
let blocks_per_row = n_cols.div_ceil(BLOCK_SIZE);
let mut data = Vec::new();
for _ in 0..n_rows {
for _ in 0..blocks_per_row {
data.extend_from_slice(&block);
}
}
let input: Vec<f32> = (0..n_cols).map(|i| (i as f32) * 0.001).collect();
let tensor_neon = QuantTensor::new(
data.clone(),
vec![n_rows, n_cols],
oxillama_gguf::GgufTensorType::Q4K,
);
let tensor_ref = QuantTensor::new(
data,
vec![n_rows, n_cols],
oxillama_gguf::GgufTensorType::Q4K,
);
let mut out_neon = vec![0.0f32; n_rows];
let mut out_ref = vec![0.0f32; n_rows];
Q4_KNeon
.gemv(&tensor_neon, &input, &mut out_neon)
.expect("neon gemv");
Q4KRef
.gemv(&tensor_ref, &input, &mut out_ref)
.expect("ref gemv");
for i in 0..n_rows {
let err = (out_neon[i] - out_ref[i]).abs();
assert!(
err < 1e-3,
"gemv row {i}: neon={} ref={} err={}",
out_neon[i],
out_ref[i],
err
);
}
}
fn make_q8_0_block(scale: f32, qs: &[i8; 32]) -> Vec<u8> {
let mut block = Vec::with_capacity(34);
let d_bits = half::f16::from_f32(scale).to_bits();
block.extend_from_slice(&d_bits.to_le_bytes());
for &q in qs {
block.push(q as u8);
}
block
}
#[test]
fn neon_fused_matches_reference_q4k() {
let n_cols = 256usize;
let mut scales = [0u8; 12];
scales[0] = 5;
scales[1] = 3;
scales[2] = 7;
scales[3] = 2;
scales[4] = 4;
scales[5] = 6;
scales[6] = 1;
scales[7] = 3;
scales[8] = 9;
scales[9] = 11;
scales[10] = 13;
scales[11] = 15;
let qs_nibbles = [0xA5u8; 128];
let d_w = 0.5f32;
let dmin_w = 0.1f32;
let w_block = make_q4_k_block(d_w, dmin_w, &scales, &qs_nibbles);
let d_a = 0.25f32;
let q8_vals: [i8; 32] = [
1, -2, 3, -4, 5, -6, 7, -8, 9, -10, 11, -12, 13, -14, 15, -16, -1, 2, -3, 4, -5, 6, -7,
8, -9, 10, -11, 12, -13, 14, -15, 16,
];
let mut acts: Vec<u8> = Vec::new();
for _ in 0..8 {
acts.extend_from_slice(&make_q8_0_block(d_a, &q8_vals));
}
let mut out_neon = vec![0.0f32; 1];
let mut out_ref = vec![0.0f32; 1];
Q4_KNeon
.matvec_q8_fused(&w_block, &acts, &mut out_neon, 1, n_cols)
.expect("neon fused q4k");
Q4KRef
.matvec_q8_fused(&w_block, &acts, &mut out_ref, 1, n_cols)
.expect("ref fused q4k");
let err = (out_neon[0] - out_ref[0]).abs();
assert!(
err < 1e-3,
"neon_fused_matches_reference_q4k: neon={} ref={} err={}",
out_neon[0],
out_ref[0],
err
);
}
#[test]
fn neon_fused_q4k_accumulates() {
let w_block = make_q4_k_block(0.0, 0.0, &[0u8; 12], &[0u8; 128]);
let mut acts: Vec<u8> = Vec::new();
for _ in 0..8 {
acts.extend_from_slice(&make_q8_0_block(1.0, &[0i8; 32]));
}
let mut out = vec![42.0f32; 1];
Q4_KNeon
.matvec_q8_fused(&w_block, &acts, &mut out, 1, 256)
.expect("neon fused q4k accumulate");
assert!(
(out[0] - 42.0).abs() < 1e-5,
"accumulation broken: got {}",
out[0]
);
}
#[test]
fn neon_fused_q4k_multi_row() {
let n_rows = 4usize;
let n_cols = 256usize;
let mut scales = [0u8; 12];
scales[..4].fill(1);
scales[8..12].fill(1);
let qs = [0x55u8; 128];
let d_a = 0.5f32;
let q8_vals: [i8; 32] = [
2, -1, 4, -3, 6, -5, 8, -7, 1, -2, 3, -4, 5, -6, 7, -8, -2, 1, -4, 3, -6, 5, -8, 7, -1,
2, -3, 4, -5, 6, -7, 8,
];
let scales_w = [0.5f32, 1.0f32, 0.25f32, 0.1f32];
let mut weights: Vec<u8> = Vec::new();
for &s in &scales_w {
weights.extend_from_slice(&make_q4_k_block(s, 0.0, &scales, &qs));
}
let mut acts: Vec<u8> = Vec::new();
for _ in 0..8 {
acts.extend_from_slice(&make_q8_0_block(d_a, &q8_vals));
}
let mut out_neon = vec![0.0f32; n_rows];
let mut out_ref = vec![0.0f32; n_rows];
Q4_KNeon
.matvec_q8_fused(&weights, &acts, &mut out_neon, n_rows, n_cols)
.expect("neon fused q4k multi-row");
Q4KRef
.matvec_q8_fused(&weights, &acts, &mut out_ref, n_rows, n_cols)
.expect("ref fused q4k multi-row");
for i in 0..n_rows {
let err = (out_neon[i] - out_ref[i]).abs();
assert!(
err < 1e-3,
"row {i}: neon={} ref={} err={}",
out_neon[i],
out_ref[i],
err
);
}
}
}