Look in pgdata to know the forceData index instead of looking in robotConfig.
Add TorqueContactMinimization minimization function.
Update python binding.