fixed gicp guess handling