3D Point estimations from Stereo Images
First Version of Loop Closing Algorithm implemented