use std::ops::{Div, Mul};
use crate::{
constitutive::solid::elastic::internal_variables::ElasticIV,
fem::{
ElementModelError, NodalCoordinates,
block::{
Block,
element::{
FiniteElementError, solid::elastic::internal_variables::ElasticIVFiniteElement,
},
},
solid::{
NodalForcesSolid, NodalStiffnessesSolid,
elastic::internal_variables::{ElasticIVElements, InternalVariablesField},
},
},
math::{
Erase, Jacobian, Matrix, Quantity, Scalar, Solution, Tensor, Vector,
optimize::NewtonRaphson,
},
units::{Dimensionless, UnitDiv},
};
impl<C, F, const G: usize, const M: usize, const N: usize, const P: usize, V, E>
ElasticIVElements<G, V, 3> for Block<C, F, G, M, N, P>
where
C: ElasticIV<V>,
C::Residual: Erase<Erased = E>,
F: ElasticIVFiniteElement<C, G, M, N, P, V, E>,
E: Tensor,
for<'a> &'a C::Residual: Div<C::TangentVv, Output = V>,
for<'a> &'a V: Mul<Quantity<Dimensionless>, Output = V> + Mul<Scalar, Output = V>,
for<'a> &'a Matrix: Mul<&'a V, Output = Vector>,
V: Erase<Erased = E> + Jacobian + Solution,
<V as Tensor>::Unit: UnitDiv<<V as Tensor>::Unit, Output = Dimensionless>,
{
fn internal_variables_initial(&self) -> InternalVariablesField<G, V> {
self.elements()
.iter()
.map(|element| element.internal_variables_initial(self.constitutive_model()))
.collect()
}
fn internal_variables_increment(
&self,
nodal_coordinates: &NodalCoordinates<3>,
internal_variables: &InternalVariablesField<G, V>,
nodal_decrement: &NodalCoordinates<3>,
step: Scalar,
) -> Result<InternalVariablesField<G, V>, ElementModelError> {
self.elements()
.iter()
.zip(self.connectivity())
.zip(internal_variables)
.map(|((element, nodes), internal_variables_element)| {
element.internal_variables_increment(
self.constitutive_model(),
&Self::element_coordinates(nodal_coordinates, nodes),
internal_variables_element,
&Self::element_coordinates(nodal_decrement, nodes),
step,
)
})
.collect::<Result<InternalVariablesField<G, V>, _>>()
.map_err(|error| ElementModelError::upstream(error, self))
}
fn internal_variables_root(
&self,
local_solver: &NewtonRaphson,
nodal_coordinates: &NodalCoordinates<3>,
internal_variables: &InternalVariablesField<G, V>,
) -> Result<InternalVariablesField<G, V>, ElementModelError> {
self.elements()
.iter()
.zip(self.connectivity())
.zip(internal_variables)
.map(|((element, nodes), internal_variables_element)| {
element.internal_variables_root(
local_solver,
self.constitutive_model(),
&Self::element_coordinates(nodal_coordinates, nodes),
internal_variables_element,
)
})
.collect::<Result<InternalVariablesField<G, V>, _>>()
.map_err(|error| ElementModelError::upstream(error, self))
}
fn nodal_forces_into(
&self,
nodal_coordinates: &NodalCoordinates<3>,
internal_variables: &InternalVariablesField<G, V>,
nodal_forces: &mut NodalForcesSolid<3>,
) -> Result<(), ElementModelError> {
self.elements()
.iter()
.zip(self.connectivity())
.zip(internal_variables)
.try_for_each(|((element, nodes), internal_variables_element)| {
element
.nodal_forces(
self.constitutive_model(),
&Self::element_coordinates(nodal_coordinates, nodes),
internal_variables_element,
)?
.into_iter()
.zip(nodes)
.for_each(|(nodal_force, &node)| nodal_forces[node] += nodal_force);
Ok::<(), FiniteElementError>(())
})
.map_err(|error| ElementModelError::upstream(error, self))
}
fn nodal_forces_eliminated_into(
&self,
nodal_coordinates: &NodalCoordinates<3>,
internal_variables: &InternalVariablesField<G, V>,
nodal_forces: &mut NodalForcesSolid<3>,
) -> Result<(), ElementModelError> {
self.elements()
.iter()
.zip(self.connectivity())
.zip(internal_variables)
.try_for_each(|((element, nodes), internal_variables_element)| {
element
.nodal_forces_eliminated(
self.constitutive_model(),
&Self::element_coordinates(nodal_coordinates, nodes),
internal_variables_element,
)?
.into_iter()
.zip(nodes)
.for_each(|(nodal_force, &node)| nodal_forces[node] += nodal_force);
Ok::<(), FiniteElementError>(())
})
.map_err(|error| ElementModelError::upstream(error, self))
}
fn nodal_stiffnesses_into(
&self,
nodal_coordinates: &NodalCoordinates<3>,
internal_variables: &InternalVariablesField<G, V>,
nodal_stiffnesses: &mut NodalStiffnessesSolid<3>,
) -> Result<(), ElementModelError> {
self.elements()
.iter()
.zip(self.connectivity())
.zip(internal_variables)
.try_for_each(|((element, nodes), internal_variables_element)| {
element
.nodal_stiffnesses(
self.constitutive_model(),
&Self::element_coordinates(nodal_coordinates, nodes),
internal_variables_element,
)?
.into_iter()
.zip(nodes)
.for_each(|(object, &node_a)| {
object
.into_iter()
.zip(nodes)
.for_each(|(nodal_stiffness, &node_b)| {
nodal_stiffnesses[node_a][node_b] += nodal_stiffness
})
});
Ok::<(), FiniteElementError>(())
})
.map_err(|error| ElementModelError::upstream(error, self))
}
}