Add grasp point visualisation