stack-of-tasks / pinocchio

A fast and flexible implementation of Rigid Body Dynamics algorithms and their analytical derivatives
http://stack-of-tasks.github.io/pinocchio/
BSD 2-Clause "Simplified" License
1.7k stars 366 forks source link

Wrong derivatives of constraintDynamics #2247

Open LudovicDeMatteis opened 1 month ago

LudovicDeMatteis commented 1 month ago

Bug description

The acceleration and contact forces derivatives computed by the function computeConstraintDynamicsDerivatives are incorrect on Release v3.0.0. It seems like only the case of 6D contact is affected. Here is a small python test for different robots, replicating the test test-cpp-contact-dynamics-derivatives of Pinocchio. It compares computed derivatives against finite differences.

The issue if already known by the maintainers and is being worked on

List of broken derivatives (to my knowledge)