Undistort Points : check this is consistent

[elliotwoods]

It seems that we keep pixel coords always in distorted space, which would not work for epipolar geometry parts Do we want to undistort as we come out of Centroids? Maybe we can keep the distorted coordinates alongside whenever we have undistorted coordinates, e.g. imagePoints and undistortedImagePoints