Added Xacro to build the URDF from the DH faster