Add mesh based undistort