Advanced Situational Graphs for Robot Navigation in Structured Indoor Environments