Refactor Armar6GraspProvider