templateized p3p

	modified:   cvt/vision/Vision.h
standard RANSAC scheme for pose estimation

	modified:   cvt/vision/slam/stereo/StereoSLAM.cpp