use super::CommonArgs;
use crate::StrError;
use russell_lab::{Matrix, Vector};
pub fn mat_09_nvb<F>(kk: &mut Matrix, args: &mut CommonArgs, mut fn_v: F) -> Result<(), StrError>
where
F: FnMut(&mut Vector, usize, &Vector, &Matrix) -> Result<(), StrError>,
{
let (space_ndim, nnode) = args.pad.xxt.dims();
let (nrow_kk, ncol_kk) = kk.dims();
let (ii0, jj0) = (args.ii0, args.jj0);
if nrow_kk < ii0 + nnode * space_ndim {
return Err("nrow(K) must be ≥ ii0 + nnode ⋅ space_ndim");
}
if ncol_kk < jj0 + nnode * space_ndim {
return Err("ncol(K) must be ≥ jj0 + nnode ⋅ space_ndim");
}
let mut v = Vector::new(space_ndim);
if args.clear {
kk.fill(0.0);
}
for p in 0..args.gauss.npoint() {
let iota = args.gauss.coords(p);
let weight = args.gauss.weight(p);
(args.pad.fn_interp)(&mut args.pad.interp, iota); let det_jac = args.pad.calc_gradient(iota)?;
let nn = &args.pad.interp;
let bb = &args.pad.gradient;
fn_v(&mut v, p, nn, bb)?;
let c = if args.axisymmetric {
let mut r = 0.0; for m in 0..nnode {
r += nn[m] * args.pad.xxt.get(0, m);
}
det_jac * weight * args.alpha * r
} else {
det_jac * weight * args.alpha
};
if space_ndim == 2 {
for m in 0..nnode {
for n in 0..nnode {
kk.add(ii0 + 0 + m * 2, jj0 + 0 + n * 2, c * nn[m] * v[0] * bb.get(n, 0));
kk.add(ii0 + 0 + m * 2, jj0 + 1 + n * 2, c * nn[m] * v[0] * bb.get(n, 1));
kk.add(ii0 + 1 + m * 2, jj0 + 0 + n * 2, c * nn[m] * v[1] * bb.get(n, 0));
kk.add(ii0 + 1 + m * 2, jj0 + 1 + n * 2, c * nn[m] * v[1] * bb.get(n, 1));
}
}
} else {
for m in 0..nnode {
for n in 0..nnode {
kk.add(ii0 + 0 + m * 3, jj0 + 0 + n * 3, c * nn[m] * v[0] * bb.get(n, 0));
kk.add(ii0 + 0 + m * 3, jj0 + 1 + n * 3, c * nn[m] * v[0] * bb.get(n, 1));
kk.add(ii0 + 0 + m * 3, jj0 + 2 + n * 3, c * nn[m] * v[0] * bb.get(n, 2));
kk.add(ii0 + 1 + m * 3, jj0 + 0 + n * 3, c * nn[m] * v[1] * bb.get(n, 0));
kk.add(ii0 + 1 + m * 3, jj0 + 1 + n * 3, c * nn[m] * v[1] * bb.get(n, 1));
kk.add(ii0 + 1 + m * 3, jj0 + 2 + n * 3, c * nn[m] * v[1] * bb.get(n, 2));
kk.add(ii0 + 2 + m * 3, jj0 + 0 + n * 3, c * nn[m] * v[2] * bb.get(n, 0));
kk.add(ii0 + 2 + m * 3, jj0 + 1 + n * 3, c * nn[m] * v[2] * bb.get(n, 1));
kk.add(ii0 + 2 + m * 3, jj0 + 2 + n * 3, c * nn[m] * v[2] * bb.get(n, 2));
}
}
}
}
Ok(())
}
#[cfg(test)]
mod tests {
use crate::integ::testing::aux;
use crate::integ::{self, AnalyticalTet4, AnalyticalTri3, CommonArgs, Gauss};
use russell_lab::{mat_approx_eq, Matrix, Vector};
#[test]
fn capture_some_errors() {
let mut pad = aux::gen_pad_lin2(1.0);
let mut kk = Matrix::new(4, 4);
let mut vv = Vector::new(0);
let nn = Vector::new(0);
let bb = Matrix::new(0, 0);
let f = |_: &mut Vector, _: usize, _: &Vector, _: &Matrix| Ok(());
f(&mut vv, 0, &nn, &bb).unwrap();
let gauss = Gauss::new(pad.kind);
let mut args = CommonArgs::new(&mut pad, &gauss);
args.ii0 = 1;
assert_eq!(
integ::mat_09_nvb(&mut kk, &mut args, f).err(),
Some("nrow(K) must be ≥ ii0 + nnode ⋅ space_ndim")
);
args.ii0 = 0;
args.jj0 = 1;
assert_eq!(
integ::mat_09_nvb(&mut kk, &mut args, f).err(),
Some("ncol(K) must be ≥ jj0 + nnode ⋅ space_ndim")
);
args.jj0 = 0;
assert_eq!(
integ::mat_09_nvb(&mut kk, &mut args, f).err(),
Some("calc_gradient requires that geo_ndim = space_ndim")
);
let mut pad = aux::gen_pad_tri3();
let mut kk = Matrix::new(6, 6);
let mut args = CommonArgs::new(&mut pad, &gauss);
assert_eq!(
integ::mat_09_nvb(&mut kk, &mut args, |_, _, _, _| Err("stop")).err(),
Some("stop")
);
}
#[test]
fn mat_09_nvb_tri3_works() {
let mut pad = aux::gen_pad_tri3();
let mut kk = Matrix::new(3 * 2, 3 * 2);
let ana = AnalyticalTri3::new(&pad);
let (v0, v1) = (2.0, 3.0);
let kk_correct = ana.mat_09_nvb(v0, v1);
let class = pad.kind.class();
let tolerances = [1e-15];
let selection: Vec<_> = [3].iter().map(|n| Gauss::new_sized(class, *n).unwrap()).collect();
selection.iter().zip(tolerances).for_each(|(ips, tol)| {
let mut args = CommonArgs::new(&mut pad, ips);
integ::mat_09_nvb(&mut kk, &mut args, |v, _, _, _| {
v[0] = v0;
v[1] = v1;
Ok(())
})
.unwrap();
mat_approx_eq(&kk, &kk_correct, tol);
});
}
#[test]
fn mat_09_nvb_tet4_works() {
let mut pad = aux::gen_pad_tet4();
let mut kk = Matrix::new(4 * 3, 4 * 3);
let ana = AnalyticalTet4::new(&pad);
let (v0, v1, v2) = (2.0, 3.0, 4.0);
let kk_correct = ana.mat_09_nvb(v0, v1, v2);
let class = pad.kind.class();
let tolerances = [1e-15];
let selection: Vec<_> = [4].iter().map(|n| Gauss::new_sized(class, *n).unwrap()).collect();
selection.iter().zip(tolerances).for_each(|(ips, tol)| {
let mut args = CommonArgs::new(&mut pad, ips);
integ::mat_09_nvb(&mut kk, &mut args, |v, _, _, _| {
v[0] = v0;
v[1] = v1;
v[2] = v2;
Ok(())
})
.unwrap();
mat_approx_eq(&kk, &kk_correct, tol);
});
}
}