A prototype implementation for serial manipulators.
If assumed massless (@danbarla ) the Jacobian calculated by the poe method can be used to compute torques $tau=J^T \mathcal{F}$ with F the wrench at the end-effector (foot). We can "easily" add joint angle dynamics, actually, in a later PR, I think.
The last test shows decomposition of the Panda, effortlessly.
A prototype implementation for serial manipulators.
If assumed massless (@danbarla ) the Jacobian calculated by the poe method can be used to compute torques $tau=J^T \mathcal{F}$ with F the wrench at the end-effector (foot). We can "easily" add joint angle dynamics, actually, in a later PR, I think.
The last test shows decomposition of the Panda, effortlessly.