use crate::image::{BufferPool, ImageF};
#[must_use]
pub fn compute_separable5_weights(sigma: f32) -> [f32; 3] {
let kernel = compute_kernel(sigma);
assert_eq!(kernel.len(), 5, "Separable5 requires kernel size 5");
let sum: f32 = kernel.iter().sum();
let scale = 1.0 / sum;
[
kernel[2] * scale, kernel[1] * scale, kernel[0] * scale, ]
}
#[must_use]
pub fn compute_kernel(sigma: f32) -> Vec<f32> {
const M: f32 = 2.25; let scaler = -1.0 / (2.0 * sigma * sigma);
let diff = (M * sigma.abs()).max(1.0) as i32;
let size = (2 * diff + 1) as usize;
let mut kernel = vec![0.0f32; size];
for i in -diff..=diff {
let weight = (scaler * (i * i) as f32).exp();
kernel[(i + diff) as usize] = weight;
}
kernel
}
#[allow(clippy::inline_always)]
#[inline(always)]
fn convolve_horizontal_transpose<F>(
input: &ImageF,
kernel: &[f32],
border_ratio: f32,
pool: &BufferPool,
interior_fn: F,
) -> ImageF
where
F: Fn(&ImageF, &[f32], usize, usize, usize, &mut ImageF),
{
let width = input.width();
let height = input.height();
let half = kernel.len() / 2;
let mut output = ImageF::from_pool_dirty(height, width, pool);
let weight_no_border: f32 = kernel.iter().sum();
let scale_no_border = 1.0 / weight_no_border;
let scaled_kernel: Vec<f32> = kernel.iter().map(|&k| k * scale_no_border).collect();
let border1 = if width <= half { width } else { half };
let border2 = if width > half { width - half } else { 0 };
if border1 > 0 {
convolve_border_columns(
input,
kernel,
weight_no_border,
border_ratio,
0,
border1,
&mut output,
);
}
if border2 > border1 {
interior_fn(input, &scaled_kernel, border1, border2, half, &mut output);
}
if border2 < width {
convolve_border_columns(
input,
kernel,
weight_no_border,
border_ratio,
border2,
width,
&mut output,
);
}
output
}
#[cfg(target_arch = "x86_64")]
#[archmage::rite]
fn convolve_interior_v4(
token: archmage::X64V4Token,
input: &ImageF,
scaled_kernel: &[f32],
border1: usize,
border2: usize,
half: usize,
output: &mut ImageF,
) {
use magetypes::simd::f32x16;
let height = input.height();
let kernel_len = scaled_kernel.len();
let simd_chunks = (border2 - border1) / 16;
for y in 0..height {
let row_in = input.row(y);
for chunk_idx in 0..simd_chunks {
let x = border1 + chunk_idx * 16;
let d = x - half;
let base = &row_in[d..d + kernel_len + 15];
let mut sum = f32x16::zero(token);
for (j, &k) in scaled_kernel.iter().enumerate() {
let loaded = f32x16::from_slice(token, &base[j..]);
sum = loaded.mul_add(f32x16::splat(token, k), sum);
}
let results = sum.to_array();
for (i, &val) in results.iter().enumerate() {
output.set(y, x + i, val);
}
}
let simd_end = border1 + simd_chunks * 16;
for x in simd_end..border2 {
let d = x - half;
let base = &row_in[d..d + kernel_len];
let sum: f32 = base
.iter()
.zip(scaled_kernel)
.fold(0.0f32, |acc, (&r, &k)| r.mul_add(k, acc));
output.set(y, x, sum);
}
}
}
#[cfg(target_arch = "x86_64")]
#[archmage::rite]
fn convolve_interior_v3(
token: archmage::X64V3Token,
input: &ImageF,
scaled_kernel: &[f32],
border1: usize,
border2: usize,
half: usize,
output: &mut ImageF,
) {
use magetypes::simd::f32x8;
let height = input.height();
let kernel_len = scaled_kernel.len();
let simd_chunks = (border2 - border1) / 8;
for y in 0..height {
let row_in = input.row(y);
for chunk_idx in 0..simd_chunks {
let x = border1 + chunk_idx * 8;
let d = x - half;
let base = &row_in[d..d + kernel_len + 7];
let mut sum = f32x8::zero(token);
for (j, &k) in scaled_kernel.iter().enumerate() {
let loaded = f32x8::from_slice(token, &base[j..]);
sum = loaded.mul_add(f32x8::splat(token, k), sum);
}
let results = sum.to_array();
for (i, &val) in results.iter().enumerate() {
output.set(y, x + i, val);
}
}
let simd_end = border1 + simd_chunks * 8;
for x in simd_end..border2 {
let d = x - half;
let base = &row_in[d..d + kernel_len];
let sum: f32 = base
.iter()
.zip(scaled_kernel)
.fold(0.0f32, |acc, (&r, &k)| r.mul_add(k, acc));
output.set(y, x, sum);
}
}
}
#[allow(clippy::inline_always)]
#[inline(always)]
fn convolve_interior_scalar(
input: &ImageF,
scaled_kernel: &[f32],
border1: usize,
border2: usize,
half: usize,
output: &mut ImageF,
) {
let height = input.height();
let kernel_len = scaled_kernel.len();
for y in 0..height {
let row_in = input.row(y);
for x in border1..border2 {
let d = x - half;
let base = &row_in[d..d + kernel_len];
let sum: f32 = base
.iter()
.zip(scaled_kernel)
.fold(0.0f32, |acc, (&r, &k)| r.mul_add(k, acc));
output.set(y, x, sum);
}
}
}
fn convolve_border_columns(
input: &ImageF,
kernel: &[f32],
weight_no_border: f32,
border_ratio: f32,
x_start: usize,
x_end: usize,
output: &mut ImageF,
) {
let width = input.width();
let height = input.height();
let half = kernel.len() / 2;
let num_cols = x_end - x_start;
let mut col_info: Vec<(usize, usize, usize)> = Vec::with_capacity(num_cols);
let mut scaled_kernels: Vec<f32> = Vec::new();
for x in x_start..x_end {
let minx = x.saturating_sub(half);
let maxx = (x + half).min(width - 1);
let k_start = minx + half - x;
let k_end = maxx + half - x + 1;
let kernel_slice = &kernel[k_start..k_end];
let weight: f32 = kernel_slice.iter().sum();
let effective_weight = (1.0 - border_ratio) * weight + border_ratio * weight_no_border;
let scale = 1.0 / effective_weight;
let offset = scaled_kernels.len();
scaled_kernels.extend(kernel_slice.iter().map(|&k| k * scale));
col_info.push((minx, offset, kernel_slice.len()));
}
for (xi, &(minx, k_offset, klen)) in col_info.iter().enumerate() {
let x = x_start + xi;
let k_slice = &scaled_kernels[k_offset..k_offset + klen];
for y in 0..height {
let row_slice = &input.row(y)[minx..minx + klen];
let sum: f32 = row_slice.iter().zip(k_slice).map(|(&r, &k)| r * k).sum();
output.set(y, x, sum);
}
}
}
pub fn gaussian_blur(input: &ImageF, sigma: f32, pool: &BufferPool) -> ImageF {
if sigma <= 0.0 {
return input.clone();
}
archmage::incant!(gaussian_blur_dispatch(input, sigma, pool))
}
#[cfg(target_arch = "x86_64")]
#[archmage::arcane]
fn gaussian_blur_dispatch_v4(
token: archmage::X64V4Token,
input: &ImageF,
sigma: f32,
pool: &BufferPool,
) -> ImageF {
let kernel = compute_kernel(sigma);
let interior = |inp: &ImageF, sk: &[f32], b1: usize, b2: usize, h: usize, out: &mut ImageF| {
convolve_interior_v4(token, inp, sk, b1, b2, h, out);
};
let temp = convolve_horizontal_transpose(input, &kernel, 0.0, pool, interior);
let result = convolve_horizontal_transpose(&temp, &kernel, 0.0, pool, interior);
temp.recycle(pool);
result
}
#[cfg(target_arch = "x86_64")]
#[archmage::arcane]
fn gaussian_blur_dispatch_v3(
token: archmage::X64V3Token,
input: &ImageF,
sigma: f32,
pool: &BufferPool,
) -> ImageF {
let kernel = compute_kernel(sigma);
let interior = |inp: &ImageF, sk: &[f32], b1: usize, b2: usize, h: usize, out: &mut ImageF| {
convolve_interior_v3(token, inp, sk, b1, b2, h, out);
};
let temp = convolve_horizontal_transpose(input, &kernel, 0.0, pool, interior);
let result = convolve_horizontal_transpose(&temp, &kernel, 0.0, pool, interior);
temp.recycle(pool);
result
}
fn gaussian_blur_dispatch_scalar(
_token: archmage::ScalarToken,
input: &ImageF,
sigma: f32,
pool: &BufferPool,
) -> ImageF {
let kernel = compute_kernel(sigma);
let temp = convolve_horizontal_transpose(input, &kernel, 0.0, pool, convolve_interior_scalar);
let result = convolve_horizontal_transpose(&temp, &kernel, 0.0, pool, convolve_interior_scalar);
temp.recycle(pool);
result
}
pub fn blur_with_border(
input: &ImageF,
sigma: f32,
border_ratio: f32,
pool: &BufferPool,
) -> ImageF {
if sigma <= 0.0 {
return input.clone();
}
archmage::incant!(blur_with_border_dispatch(input, sigma, border_ratio, pool))
}
#[cfg(target_arch = "x86_64")]
#[archmage::arcane]
fn blur_with_border_dispatch_v4(
token: archmage::X64V4Token,
input: &ImageF,
sigma: f32,
border_ratio: f32,
pool: &BufferPool,
) -> ImageF {
let kernel = compute_kernel(sigma);
let interior = |inp: &ImageF, sk: &[f32], b1: usize, b2: usize, h: usize, out: &mut ImageF| {
convolve_interior_v4(token, inp, sk, b1, b2, h, out);
};
let temp = convolve_horizontal_transpose(input, &kernel, border_ratio, pool, interior);
let result = convolve_horizontal_transpose(&temp, &kernel, border_ratio, pool, interior);
temp.recycle(pool);
result
}
#[cfg(target_arch = "x86_64")]
#[archmage::arcane]
fn blur_with_border_dispatch_v3(
token: archmage::X64V3Token,
input: &ImageF,
sigma: f32,
border_ratio: f32,
pool: &BufferPool,
) -> ImageF {
let kernel = compute_kernel(sigma);
let interior = |inp: &ImageF, sk: &[f32], b1: usize, b2: usize, h: usize, out: &mut ImageF| {
convolve_interior_v3(token, inp, sk, b1, b2, h, out);
};
let temp = convolve_horizontal_transpose(input, &kernel, border_ratio, pool, interior);
let result = convolve_horizontal_transpose(&temp, &kernel, border_ratio, pool, interior);
temp.recycle(pool);
result
}
fn blur_with_border_dispatch_scalar(
_token: archmage::ScalarToken,
input: &ImageF,
sigma: f32,
border_ratio: f32,
pool: &BufferPool,
) -> ImageF {
let kernel = compute_kernel(sigma);
let temp =
convolve_horizontal_transpose(input, &kernel, border_ratio, pool, convolve_interior_scalar);
let result =
convolve_horizontal_transpose(&temp, &kernel, border_ratio, pool, convolve_interior_scalar);
temp.recycle(pool);
result
}
pub fn gaussian_blur_inplace(image: &mut ImageF, sigma: f32, pool: &BufferPool) {
if sigma <= 0.0 {
return;
}
let blurred = gaussian_blur(image, sigma, pool);
image.copy_from(&blurred);
blurred.recycle(pool);
}
#[inline]
fn mirror(mut x: i32, size: i32) -> usize {
while x < 0 || x >= size {
if x < 0 {
x = -x - 1;
} else {
x = 2 * size - 1 - x;
}
}
x as usize
}
pub fn blur_mirrored_5x5(input: &ImageF, weights: &[f32; 3], pool: &BufferPool) -> ImageF {
archmage::incant!(blur_mirrored_5x5(input, weights, pool))
}
#[cfg(target_arch = "x86_64")]
#[archmage::arcane]
fn blur_mirrored_5x5_v4(
token: archmage::X64V4Token,
input: &ImageF,
weights: &[f32; 3],
pool: &BufferPool,
) -> ImageF {
use magetypes::simd::f32x16;
let width = input.width();
let height = input.height();
let w0 = weights[0];
let w1 = weights[1];
let w2 = weights[2];
let w0_v = f32x16::splat(token, w0);
let w1_v = f32x16::splat(token, w1);
let w2_v = f32x16::splat(token, w2);
let iwidth = width as i32;
let iheight = height as i32;
let mut temp = ImageF::from_pool_dirty(width, height, pool);
let border = 2.min(width);
let interior_end = if width > 4 { width - 2 } else { 0 };
for y in 0..height {
let row = input.row(y);
let out_row = temp.row_mut(y);
for x in 0..border {
let ix = x as i32;
let v_m2 = row[mirror(ix - 2, iwidth)];
let v_m1 = row[mirror(ix - 1, iwidth)];
let v_0 = row[x];
let v_p1 = row[mirror(ix + 1, iwidth)];
let v_p2 = row[mirror(ix + 2, iwidth)];
out_row[x] = v_0 * w0 + (v_m1 + v_p1) * w1 + (v_m2 + v_p2) * w2;
}
let mut x = border;
while x + 16 <= interior_end {
let v_m2 = f32x16::load(token, (&row[x - 2..x + 14]).try_into().unwrap());
let v_m1 = f32x16::load(token, (&row[x - 1..x + 15]).try_into().unwrap());
let v_0 = f32x16::load(token, (&row[x..x + 16]).try_into().unwrap());
let v_p1 = f32x16::load(token, (&row[x + 1..x + 17]).try_into().unwrap());
let v_p2 = f32x16::load(token, (&row[x + 2..x + 18]).try_into().unwrap());
let sum = v_0 * w0_v + (v_m1 + v_p1) * w1_v + (v_m2 + v_p2) * w2_v;
sum.store((&mut out_row[x..x + 16]).try_into().unwrap());
x += 16;
}
while x < interior_end {
let v_m2 = row[x - 2];
let v_m1 = row[x - 1];
let v_0 = row[x];
let v_p1 = row[x + 1];
let v_p2 = row[x + 2];
out_row[x] = v_0 * w0 + (v_m1 + v_p1) * w1 + (v_m2 + v_p2) * w2;
x += 1;
}
for x in interior_end..width {
let ix = x as i32;
let v_m2 = row[mirror(ix - 2, iwidth)];
let v_m1 = row[mirror(ix - 1, iwidth)];
let v_0 = row[x];
let v_p1 = row[mirror(ix + 1, iwidth)];
let v_p2 = row[mirror(ix + 2, iwidth)];
out_row[x] = v_0 * w0 + (v_m1 + v_p1) * w1 + (v_m2 + v_p2) * w2;
}
}
let mut output = ImageF::from_pool_dirty(width, height, pool);
let v_border = 2.min(height);
let v_interior_end = if height > 4 { height - 2 } else { 0 };
for y in 0..v_border {
let iy = y as i32;
let rm2 = temp.row(mirror(iy - 2, iheight));
let rm1 = temp.row(mirror(iy - 1, iheight));
let r0 = temp.row(y);
let rp1 = temp.row(mirror(iy + 1, iheight));
let rp2 = temp.row(mirror(iy + 2, iheight));
let out = output.row_mut(y);
let mut x = 0;
while x + 16 <= width {
let vm2 = f32x16::load(token, (&rm2[x..x + 16]).try_into().unwrap());
let vm1 = f32x16::load(token, (&rm1[x..x + 16]).try_into().unwrap());
let v0 = f32x16::load(token, (&r0[x..x + 16]).try_into().unwrap());
let vp1 = f32x16::load(token, (&rp1[x..x + 16]).try_into().unwrap());
let vp2 = f32x16::load(token, (&rp2[x..x + 16]).try_into().unwrap());
let sum = v0 * w0_v + (vm1 + vp1) * w1_v + (vm2 + vp2) * w2_v;
sum.store((&mut out[x..x + 16]).try_into().unwrap());
x += 16;
}
while x < width {
out[x] = r0[x] * w0 + (rm1[x] + rp1[x]) * w1 + (rm2[x] + rp2[x]) * w2;
x += 1;
}
}
for y in v_border..v_interior_end {
let rm2 = temp.row(y - 2);
let rm1 = temp.row(y - 1);
let r0 = temp.row(y);
let rp1 = temp.row(y + 1);
let rp2 = temp.row(y + 2);
let out = output.row_mut(y);
let mut x = 0;
while x + 16 <= width {
let vm2 = f32x16::load(token, (&rm2[x..x + 16]).try_into().unwrap());
let vm1 = f32x16::load(token, (&rm1[x..x + 16]).try_into().unwrap());
let v0 = f32x16::load(token, (&r0[x..x + 16]).try_into().unwrap());
let vp1 = f32x16::load(token, (&rp1[x..x + 16]).try_into().unwrap());
let vp2 = f32x16::load(token, (&rp2[x..x + 16]).try_into().unwrap());
let sum = v0 * w0_v + (vm1 + vp1) * w1_v + (vm2 + vp2) * w2_v;
sum.store((&mut out[x..x + 16]).try_into().unwrap());
x += 16;
}
while x < width {
out[x] = r0[x] * w0 + (rm1[x] + rp1[x]) * w1 + (rm2[x] + rp2[x]) * w2;
x += 1;
}
}
for y in v_interior_end..height {
let iy = y as i32;
let rm2 = temp.row(mirror(iy - 2, iheight));
let rm1 = temp.row(mirror(iy - 1, iheight));
let r0 = temp.row(y);
let rp1 = temp.row(mirror(iy + 1, iheight));
let rp2 = temp.row(mirror(iy + 2, iheight));
let out = output.row_mut(y);
let mut x = 0;
while x + 16 <= width {
let vm2 = f32x16::load(token, (&rm2[x..x + 16]).try_into().unwrap());
let vm1 = f32x16::load(token, (&rm1[x..x + 16]).try_into().unwrap());
let v0 = f32x16::load(token, (&r0[x..x + 16]).try_into().unwrap());
let vp1 = f32x16::load(token, (&rp1[x..x + 16]).try_into().unwrap());
let vp2 = f32x16::load(token, (&rp2[x..x + 16]).try_into().unwrap());
let sum = v0 * w0_v + (vm1 + vp1) * w1_v + (vm2 + vp2) * w2_v;
sum.store((&mut out[x..x + 16]).try_into().unwrap());
x += 16;
}
while x < width {
out[x] = r0[x] * w0 + (rm1[x] + rp1[x]) * w1 + (rm2[x] + rp2[x]) * w2;
x += 1;
}
}
temp.recycle(pool);
output
}
#[cfg(target_arch = "x86_64")]
#[archmage::arcane]
fn blur_mirrored_5x5_v3(
token: archmage::X64V3Token,
input: &ImageF,
weights: &[f32; 3],
pool: &BufferPool,
) -> ImageF {
use magetypes::simd::f32x8;
let width = input.width();
let height = input.height();
let w0 = weights[0];
let w1 = weights[1];
let w2 = weights[2];
let w0_v = f32x8::splat(token, w0);
let w1_v = f32x8::splat(token, w1);
let w2_v = f32x8::splat(token, w2);
let iwidth = width as i32;
let iheight = height as i32;
let mut temp = ImageF::from_pool_dirty(width, height, pool);
let border = 2.min(width);
let interior_end = if width > 4 { width - 2 } else { 0 };
for y in 0..height {
let row = input.row(y);
let out_row = temp.row_mut(y);
for x in 0..border {
let ix = x as i32;
let v_m2 = row[mirror(ix - 2, iwidth)];
let v_m1 = row[mirror(ix - 1, iwidth)];
let v_0 = row[x];
let v_p1 = row[mirror(ix + 1, iwidth)];
let v_p2 = row[mirror(ix + 2, iwidth)];
out_row[x] = v_0 * w0 + (v_m1 + v_p1) * w1 + (v_m2 + v_p2) * w2;
}
let mut x = border;
while x + 8 <= interior_end {
let v_m2 = f32x8::load(token, (&row[x - 2..x + 6]).try_into().unwrap());
let v_m1 = f32x8::load(token, (&row[x - 1..x + 7]).try_into().unwrap());
let v_0 = f32x8::load(token, (&row[x..x + 8]).try_into().unwrap());
let v_p1 = f32x8::load(token, (&row[x + 1..x + 9]).try_into().unwrap());
let v_p2 = f32x8::load(token, (&row[x + 2..x + 10]).try_into().unwrap());
let sum = v_0 * w0_v + (v_m1 + v_p1) * w1_v + (v_m2 + v_p2) * w2_v;
sum.store((&mut out_row[x..x + 8]).try_into().unwrap());
x += 8;
}
while x < interior_end {
let v_m2 = row[x - 2];
let v_m1 = row[x - 1];
let v_0 = row[x];
let v_p1 = row[x + 1];
let v_p2 = row[x + 2];
out_row[x] = v_0 * w0 + (v_m1 + v_p1) * w1 + (v_m2 + v_p2) * w2;
x += 1;
}
for x in interior_end..width {
let ix = x as i32;
let v_m2 = row[mirror(ix - 2, iwidth)];
let v_m1 = row[mirror(ix - 1, iwidth)];
let v_0 = row[x];
let v_p1 = row[mirror(ix + 1, iwidth)];
let v_p2 = row[mirror(ix + 2, iwidth)];
out_row[x] = v_0 * w0 + (v_m1 + v_p1) * w1 + (v_m2 + v_p2) * w2;
}
}
let mut output = ImageF::from_pool_dirty(width, height, pool);
let v_border = 2.min(height);
let v_interior_end = if height > 4 { height - 2 } else { 0 };
for y in 0..v_border {
let iy = y as i32;
let rm2 = temp.row(mirror(iy - 2, iheight));
let rm1 = temp.row(mirror(iy - 1, iheight));
let r0 = temp.row(y);
let rp1 = temp.row(mirror(iy + 1, iheight));
let rp2 = temp.row(mirror(iy + 2, iheight));
let out = output.row_mut(y);
let mut x = 0;
while x + 8 <= width {
let vm2 = f32x8::load(token, (&rm2[x..x + 8]).try_into().unwrap());
let vm1 = f32x8::load(token, (&rm1[x..x + 8]).try_into().unwrap());
let v0 = f32x8::load(token, (&r0[x..x + 8]).try_into().unwrap());
let vp1 = f32x8::load(token, (&rp1[x..x + 8]).try_into().unwrap());
let vp2 = f32x8::load(token, (&rp2[x..x + 8]).try_into().unwrap());
let sum = v0 * w0_v + (vm1 + vp1) * w1_v + (vm2 + vp2) * w2_v;
sum.store((&mut out[x..x + 8]).try_into().unwrap());
x += 8;
}
while x < width {
out[x] = r0[x] * w0 + (rm1[x] + rp1[x]) * w1 + (rm2[x] + rp2[x]) * w2;
x += 1;
}
}
for y in v_border..v_interior_end {
let rm2 = temp.row(y - 2);
let rm1 = temp.row(y - 1);
let r0 = temp.row(y);
let rp1 = temp.row(y + 1);
let rp2 = temp.row(y + 2);
let out = output.row_mut(y);
let mut x = 0;
while x + 8 <= width {
let vm2 = f32x8::load(token, (&rm2[x..x + 8]).try_into().unwrap());
let vm1 = f32x8::load(token, (&rm1[x..x + 8]).try_into().unwrap());
let v0 = f32x8::load(token, (&r0[x..x + 8]).try_into().unwrap());
let vp1 = f32x8::load(token, (&rp1[x..x + 8]).try_into().unwrap());
let vp2 = f32x8::load(token, (&rp2[x..x + 8]).try_into().unwrap());
let sum = v0 * w0_v + (vm1 + vp1) * w1_v + (vm2 + vp2) * w2_v;
sum.store((&mut out[x..x + 8]).try_into().unwrap());
x += 8;
}
while x < width {
out[x] = r0[x] * w0 + (rm1[x] + rp1[x]) * w1 + (rm2[x] + rp2[x]) * w2;
x += 1;
}
}
for y in v_interior_end..height {
let iy = y as i32;
let rm2 = temp.row(mirror(iy - 2, iheight));
let rm1 = temp.row(mirror(iy - 1, iheight));
let r0 = temp.row(y);
let rp1 = temp.row(mirror(iy + 1, iheight));
let rp2 = temp.row(mirror(iy + 2, iheight));
let out = output.row_mut(y);
let mut x = 0;
while x + 8 <= width {
let vm2 = f32x8::load(token, (&rm2[x..x + 8]).try_into().unwrap());
let vm1 = f32x8::load(token, (&rm1[x..x + 8]).try_into().unwrap());
let v0 = f32x8::load(token, (&r0[x..x + 8]).try_into().unwrap());
let vp1 = f32x8::load(token, (&rp1[x..x + 8]).try_into().unwrap());
let vp2 = f32x8::load(token, (&rp2[x..x + 8]).try_into().unwrap());
let sum = v0 * w0_v + (vm1 + vp1) * w1_v + (vm2 + vp2) * w2_v;
sum.store((&mut out[x..x + 8]).try_into().unwrap());
x += 8;
}
while x < width {
out[x] = r0[x] * w0 + (rm1[x] + rp1[x]) * w1 + (rm2[x] + rp2[x]) * w2;
x += 1;
}
}
temp.recycle(pool);
output
}
fn blur_mirrored_5x5_scalar(
_token: archmage::ScalarToken,
input: &ImageF,
weights: &[f32; 3],
pool: &BufferPool,
) -> ImageF {
let width = input.width();
let height = input.height();
let w0 = weights[0];
let w1 = weights[1];
let w2 = weights[2];
let iwidth = width as i32;
let iheight = height as i32;
let mut temp = ImageF::from_pool_dirty(height, width, pool);
for y in 0..height {
let row = input.row(y);
for x in 0..width {
let ix = x as i32;
let v_m2 = row[mirror(ix - 2, iwidth)];
let v_m1 = row[mirror(ix - 1, iwidth)];
let v_0 = row[x];
let v_p1 = row[mirror(ix + 1, iwidth)];
let v_p2 = row[mirror(ix + 2, iwidth)];
let sum = v_0 * w0 + (v_m1 + v_p1) * w1 + (v_m2 + v_p2) * w2;
temp.set(y, x, sum);
}
}
let mut output = ImageF::from_pool_dirty(width, height, pool);
for x in 0..width {
let col = temp.row(x);
for y in 0..height {
let iy = y as i32;
let v_m2 = col[mirror(iy - 2, iheight)];
let v_m1 = col[mirror(iy - 1, iheight)];
let v_0 = col[y];
let v_p1 = col[mirror(iy + 1, iheight)];
let v_p2 = col[mirror(iy + 2, iheight)];
let sum = v_0 * w0 + (v_m1 + v_p1) * w1 + (v_m2 + v_p2) * w2;
output.set(x, y, sum);
}
}
temp.recycle(pool);
output
}
pub fn blur_5x5(input: &ImageF, weights: &[f32; 3], pool: &BufferPool) -> ImageF {
let width = input.width();
let height = input.height();
let w0 = weights[0];
let w1 = weights[1];
let w2 = weights[2];
let kernel = [w2, w1, w0, w1, w2];
let weight_sum: f32 = kernel.iter().sum();
let scale = 1.0 / weight_sum;
let scaled_kernel: [f32; 5] = [
kernel[0] * scale,
kernel[1] * scale,
kernel[2] * scale,
kernel[3] * scale,
kernel[4] * scale,
];
let mut temp = ImageF::from_pool_dirty(height, width, pool);
let border = 2.min(width);
let interior_end = if width > 2 { width - 2 } else { 0 };
for x in 0..border {
for y in 0..height {
let row = input.row(y);
let minx = x.saturating_sub(2);
let maxx = (x + 2).min(width - 1);
let mut sum = 0.0f32;
let mut wsum = 0.0f32;
for j in minx..=maxx {
let k_idx = j + 2 - x;
let k_val = kernel[k_idx];
wsum += k_val;
sum += row[j] * k_val;
}
temp.set(y, x, if wsum > 0.0 { sum / wsum } else { 0.0 });
}
}
if interior_end > border {
for y in 0..height {
let row = input.row(y);
for x in border..interior_end {
let sum = row[x - 2] * scaled_kernel[0]
+ row[x - 1] * scaled_kernel[1]
+ row[x] * scaled_kernel[2]
+ row[x + 1] * scaled_kernel[3]
+ row[x + 2] * scaled_kernel[4];
temp.set(y, x, sum);
}
}
}
for x in interior_end..width {
for y in 0..height {
let row = input.row(y);
let minx = x.saturating_sub(2);
let maxx = (x + 2).min(width - 1);
let mut sum = 0.0f32;
let mut wsum = 0.0f32;
for j in minx..=maxx {
let k_idx = j + 2 - x;
let k_val = kernel[k_idx];
wsum += k_val;
sum += row[j] * k_val;
}
temp.set(y, x, if wsum > 0.0 { sum / wsum } else { 0.0 });
}
}
let mut output = ImageF::from_pool_dirty(width, height, pool);
let h_border = 2.min(height);
let h_interior_end = if height > 2 { height - 2 } else { 0 };
for y in 0..h_border {
for x in 0..width {
let col = temp.row(x);
let miny = y.saturating_sub(2);
let maxy = (y + 2).min(height - 1);
let mut sum = 0.0f32;
let mut wsum = 0.0f32;
for j in miny..=maxy {
let k_idx = j + 2 - y;
let k_val = kernel[k_idx];
wsum += k_val;
sum += col[j] * k_val;
}
output.set(x, y, if wsum > 0.0 { sum / wsum } else { 0.0 });
}
}
if h_interior_end > h_border {
for x in 0..width {
let col = temp.row(x);
for y in h_border..h_interior_end {
let sum = col[y - 2] * scaled_kernel[0]
+ col[y - 1] * scaled_kernel[1]
+ col[y] * scaled_kernel[2]
+ col[y + 1] * scaled_kernel[3]
+ col[y + 2] * scaled_kernel[4];
output.set(x, y, sum);
}
}
}
for y in h_interior_end..height {
for x in 0..width {
let col = temp.row(x);
let miny = y.saturating_sub(2);
let maxy = (y + 2).min(height - 1);
let mut sum = 0.0f32;
let mut wsum = 0.0f32;
for j in miny..=maxy {
let k_idx = j + 2 - y;
let k_val = kernel[k_idx];
wsum += k_val;
sum += col[j] * k_val;
}
output.set(x, y, if wsum > 0.0 { sum / wsum } else { 0.0 });
}
}
temp.recycle(pool);
output
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_kernel_generation() {
let kernel = compute_kernel(1.0);
assert!(!kernel.is_empty());
assert_eq!(kernel.len() % 2, 1);
let center = kernel.len() / 2;
for (i, &v) in kernel.iter().enumerate() {
if i != center {
assert!(v <= kernel[center]);
}
}
let sum: f32 = kernel.iter().sum();
assert!(sum > 0.0);
}
#[test]
fn test_blur_constant_image() {
let pool = BufferPool::new();
let img = ImageF::filled(32, 32, 0.5);
let blurred = gaussian_blur(&img, 2.0, &pool);
for y in 2..30 {
for x in 2..30 {
assert!(
(blurred.get(x, y) - 0.5).abs() < 0.01,
"Expected 0.5, got {} at ({}, {})",
blurred.get(x, y),
x,
y
);
}
}
}
#[test]
fn test_blur_reduces_delta() {
let pool = BufferPool::new();
let mut img = ImageF::new(32, 32);
img.set(16, 16, 1.0);
let blurred = gaussian_blur(&img, 2.0, &pool);
assert!(blurred.get(16, 16) < 1.0);
assert!(blurred.get(15, 16) > 0.0);
assert!(blurred.get(17, 16) > 0.0);
}
#[test]
fn test_blur_5x5_constant() {
let pool = BufferPool::new();
let img = ImageF::filled(32, 32, 0.5);
let weights = [1.0f32, 0.5, 0.25]; let blurred = blur_5x5(&img, &weights, &pool);
for y in 4..28 {
for x in 4..28 {
assert!(
(blurred.get(x, y) - 0.5).abs() < 0.01,
"Expected 0.5, got {} at ({}, {})",
blurred.get(x, y),
x,
y
);
}
}
}
}