Considering flipped initial pose on ICP registration