removed urdf and srdf from configure function since kinematic model is also passed in