Revision history [back]

Use the undistortPoints function. It should do everything you're asking for.

I'm not sure how exactly it works, but you can check the code if you want to know.