use crate::dijkstra::Dist;
#[derive(Debug, Clone, Copy)]
pub(crate) struct PaddedShape {
pub psx: u64,
pub psy: u64,
pub psz: u64,
}
impl PaddedShape {
#[inline]
pub(crate) fn new(sx: u64, sy: u64, sz: u64) -> Self {
Self {
psx: sx + 2,
psy: sy + 2,
psz: sz + 2,
}
}
#[inline]
pub(crate) fn psxy(&self) -> u64 {
self.psx * self.psy
}
#[inline]
pub(crate) fn ptotal(&self) -> u64 {
self.psx.saturating_mul(self.psy).saturating_mul(self.psz)
}
}
pub(crate) fn pad_field<T: Copy>(
field: &[T],
sx: u64,
sy: u64,
sz: u64,
padded: PaddedShape,
) -> Vec<T> {
let ptotal = padded.ptotal() as usize;
let mut out = vec![field[0]; ptotal];
let sx_us = sx as usize;
let sy_us = sy as usize;
let sz_us = sz as usize;
let psx_us = padded.psx as usize;
let psxy_us = padded.psxy() as usize;
for z in 0..sz_us {
for y in 0..sy_us {
let src_base = (z * sy_us + y) * sx_us;
let dst_base = (z + 1) * psxy_us + (y + 1) * psx_us + 1;
out[dst_base..dst_base + sx_us].copy_from_slice(&field[src_base..src_base + sx_us]);
}
}
out
}
#[inline]
pub(crate) fn to_padded_index(x: u64, y: u64, z: u64, padded: PaddedShape) -> u64 {
(z + 1) * padded.psxy() + (y + 1) * padded.psx + (x + 1)
}
#[inline]
pub(crate) fn from_padded_index(p: u64, sx: u64, sxy: u64, psx: u64, psxy: u64) -> u64 {
let pz = p / psxy;
let rem = p % psxy;
let py = rem / psx;
let px = rem % psx;
(px - 1) + (py - 1) * sx + (pz - 1) * sxy
}
pub(crate) fn set_halo_zero<D: Dist>(distances: &mut [D], psx: usize, psy: usize, psz: usize) {
let psxy = psx * psy;
let ztop = (psz - 1) * psxy;
for p in 0..psxy {
distances[p] = D::ZERO;
distances[ztop + p] = D::ZERO;
}
for z in 1..psz - 1 {
let zb = z * psxy;
let yb = zb + (psy - 1) * psx;
for x in 0..psx {
distances[zb + x] = D::ZERO; distances[yb + x] = D::ZERO; }
for y in 1..psy - 1 {
let rb = zb + y * psx;
distances[rb] = D::ZERO; distances[rb + psx - 1] = D::ZERO; }
}
}