Added decomposition of fundmental matrix to retrieve focal lengths

Change-Id: I13d763278ae830174efb3bbc733926ce470051e0