Submap matching for stereo-vision based indoor/outdoor SLAM
towards 3d point cloud based object maps for household environments .