fixed setFootprint from urdf