Make calibration work.
Undistort frame if possible.