Sequential 3D-SLAM for mobile action planning. - Peter Kohlhepp; Paola Pozzo; Marcus Walther 002; Rüdiger Dillmann (IROS, 2004)