merged, now finding the urdf and successfully parsing