Add InitRectifyMap() and change distortionCoeff order