Removed dependency on kinematics_base, replaced with moveit functionality