Bugfixes for building and first working version of tool for producing iCub URDF