Changes to URDF and replaced hand made srdf with setup assistant generated version