Skip to main content

solve_aba_zero_heap

Function solve_aba_zero_heap 

pub fn solve_aba_zero_heap(
    nodes: &[DcaBodyNode],
    gravity: [f64; 3],
    out_qdd: &mut [f64],
) -> Result<(), SkeletalError>
Expand description

Solves forward dynamics in $O(N)$ using Featherstone’s Articulated-Body Algorithm (HotZeroHeap).