Fixing bugs with Essential Matrix calculation

Normalized coordinates before computing F
Changed Camera Matrix
Changed options of computing Fundamental Matrix.
Changed how translation was computed and how the correct rotation is
selected.
Changed how results of Vis. Odometry are displayed.
Added triangulate function to test triangulation of points.