Preliminary Version Milestone 2 (Undistortion+Rectification)