Stereo Parallel Tracking and Mapping for robot localization