Cleaned URDF and MoveIt! config