Fixed bug in radial distortion for many points. Added unit tests for 4 parameter radial distortion.