From SLAM to Situational Awareness: Challenges and Survey