Work in progress release.
Changelog
- Make OCP cost factors consistent (remove factor 1/2 from TCP tracking cost)
- Breaking: Update implementation of the geometric Jacobian time derivative. The method
computeGeomJacobianTimeDerivativenow computes the true time derivative, whereas the acceleration bias matrix (which was previously computed bycomputeGeomJacobianTimeDerivative) is now computed with the new methodcomputeGeomJacobianAccelerationBiasMatrix. Note that the true time derivative is computationally more expensive, so the cheaper bias matrix is used internally.