Robot Mapping with Real-Time Incremental Localization Using Expectation Maximization