use crate::mesh::{QuadMeshView2d, QuadratureRule};
use crate::physics::solenoid_stress::family::QuadElementFamily;
use crate::physics::solenoid_stress::geometry::{FaceSample, validate_structural_2d_mesh};
use crate::physics::solenoid_stress::types::{
DOF_PER_NODE, Real, Structural2dFormulation, TractionLoad, local_dofs,
};
use super::{SparseOperator, scatter_local_matrix};
fn traction_face_kernel<F: Real, const NODES_PER_ELEMENT: usize, const DOF_PER_ELEMENT: usize>(
samples: &[FaceSample<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 tangent_norm =
(sample.tangent[0] * sample.tangent[0] + sample.tangent[1] * sample.tangent[1]).sqrt();
let scale = formulation.face_scale(sample.point, tangent_norm, 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 traction_operator_for_family<
F: Real,
Family,
const NODES_PER_ELEMENT: usize,
const DOF_PER_ELEMENT: usize,
>(
mesh: QuadMeshView2d<'_, F, NODES_PER_ELEMENT>,
traction_faces: &[TractionLoad],
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 * traction_faces.len();
let mut rows = Vec::with_capacity(traction_faces.len() * DOF_PER_ELEMENT * 2);
let mut cols = Vec::with_capacity(traction_faces.len() * DOF_PER_ELEMENT * 2);
let mut vals = Vec::with_capacity(traction_faces.len() * DOF_PER_ELEMENT * 2);
for (load_index, load) in traction_faces.iter().enumerate() {
if load.element >= mesh.num_elements() {
return Err(format!(
"traction load references element {}, but mesh has only {} elements",
load.element,
mesh.num_elements()
));
}
let coords = mesh.element_coords(load.element)?;
let nodes = mesh.element_nodes(load.element)?;
let samples = Family::face_samples::<F>(&coords, load.local_face, quadrature)?;
let local =
traction_face_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 * load_index, 2 * load_index + 1];
scatter_local_matrix(
&mut rows,
&mut cols,
&mut vals,
&global_rows,
&global_cols,
&local,
);
}
Ok(SparseOperator {
rows,
cols,
vals,
nrow: ndof,
ncol,
})
}