Revised the camera matrix used.
Moved StereoRectify to run on before TriangulatePoints instead of only
in initialization.
Implemented the extraction of the Rotation and Translation Matrices
(based on the Essential Matrix, taken from the Fundamental Matrix)