Add undistortImage
Merge master