some stuff on distortion

[carlosbeltran]

trafficstars

Fixes bug in distortion. Homogeneous coordinates were used instead of euclidian to compute pixel distances. Includes the computation of distortion when projecting rays. Includes a handy undistortion function to directly undistort pixel coordinates. Includes undistortion when computing the pose