Add option in tsid_biped.py to specify contact motion constraints as costs rather than hard constraints.