Add the possibility to define the sole size for pg urdf.
Restore feetconstraints and add the sole parameters for urdf.