Camera Match - Focal Distance Fix

Fixed a major issue with the focal distance calculation. Went totally
wrong with steep camera angles.
Camera orientation and focal length are now correctly calculated.