Cleaning up robot urdfs
Major cleanup