Simultaneous Localization And Mapping For Structured Indoor Environments