This PR aims at adding a new feature to the centroidal dynamics and costs formulation, namely the option to consider 6D contacts with angular forces. It also provides an approximated wrench cone residual with 4 facets. The 6D contact dynamics is especially useful for robots with large feet like Talos.
This PR aims at adding a new feature to the centroidal dynamics and costs formulation, namely the option to consider 6D contacts with angular forces. It also provides an approximated wrench cone residual with 4 facets. The 6D contact dynamics is especially useful for robots with large feet like Talos.