Added visualization for the OrthogonalJumpPointFinder