robust undistort image implemented