New script for building iCub URDF
Various fixed in iDynTree