Implementation of Masters Thesis: ROBOT MAPPING WITH REAL-TIME INCREMENTAL LOCALIZATION USING EXPECTATION MAXIMIZATION