use crate::mesh::{QuadMeshView2d, QuadratureRule};
use crate::physics::solenoid_stress::family::QuadElementFamily;
use crate::physics::solenoid_stress::geometry::{VolumeSample, validate_structural_2d_mesh};
use crate::physics::solenoid_stress::types::{
DOF_PER_NODE, Real, Structural2dFormulation, local_dofs, scatter_local_matrix,
};
use super::SparseOperator;
fn body_force_element_kernel<
F: Real,
const NODES_PER_ELEMENT: usize,
const DOF_PER_ELEMENT: usize,
>(
samples: &[VolumeSample<F, NODES_PER_ELEMENT>],
formulation: Structural2dFormulation<F>,
) -> Result<[[F; 2]; DOF_PER_ELEMENT], String> {
const {
assert!(DOF_PER_ELEMENT == DOF_PER_NODE * NODES_PER_ELEMENT);
}
let mut local = [[F::zero(); 2]; DOF_PER_ELEMENT];
for sample in samples {
let scale = formulation.volume_scale(sample.point, sample.det_j, sample.weight)?;
for local_node in 0..NODES_PER_ELEMENT {
local[2 * local_node][0] = local[2 * local_node][0] + scale * sample.n[local_node];
local[2 * local_node + 1][1] =
local[2 * local_node + 1][1] + scale * sample.n[local_node];
}
}
Ok(local)
}
pub(crate) fn body_force_operator_for_family<
F: Real,
Family,
const NODES_PER_ELEMENT: usize,
const DOF_PER_ELEMENT: usize,
>(
mesh: QuadMeshView2d<'_, F, NODES_PER_ELEMENT>,
formulation: Structural2dFormulation<F>,
quadrature: QuadratureRule,
) -> Result<SparseOperator<F>, String>
where
Family: QuadElementFamily<NODES_PER_ELEMENT>,
{
const {
assert!(DOF_PER_ELEMENT == DOF_PER_NODE * NODES_PER_ELEMENT);
}
validate_structural_2d_mesh(mesh, formulation)?;
let ndof = mesh.num_nodes() * 2;
let ncol = 2 * mesh.num_elements();
let mut rows = Vec::with_capacity(mesh.num_elements() * DOF_PER_ELEMENT * 2);
let mut cols = Vec::with_capacity(mesh.num_elements() * DOF_PER_ELEMENT * 2);
let mut vals = Vec::with_capacity(mesh.num_elements() * DOF_PER_ELEMENT * 2);
for element_index in 0..mesh.num_elements() {
let coords = mesh.element_coords(element_index)?;
let nodes = mesh.element_nodes(element_index)?;
let samples = Family::volume_samples::<F>(&coords, quadrature)?;
let local = body_force_element_kernel::<F, NODES_PER_ELEMENT, DOF_PER_ELEMENT>(
&samples,
formulation,
)?;
let global_rows = local_dofs::<NODES_PER_ELEMENT, DOF_PER_ELEMENT>(&nodes);
let global_cols = [2 * element_index, 2 * element_index + 1];
scatter_local_matrix(
&mut rows,
&mut cols,
&mut vals,
&global_rows,
&global_cols,
&local,
);
}
Ok(SparseOperator {
rows,
cols,
vals,
nrow: ndof,
ncol,
})
}