SPTAM: Stereo Parallel Tracking and Mapping