Constrained-covisibility marginalization for efficient on-board stereo SLAM