Skip to main content

resolve_loop_closures_zero_heap

Function resolve_loop_closures_zero_heap 

pub fn resolve_loop_closures_zero_heap(
    loops: &[LoopClosureConstraint],
    body_motors: &mut [Motor],
    iterations: usize,
) -> Result<f64, SkeletalError>
Expand description

Resolves closed kinematic loop residuals (e.g. ribcage, radius-ulna) via compliant constraint projection over world body Motor poses (HotZeroHeap), returning max residual (m).