SLAMIt A Sub-Map Based SLAM System : On-line creation of multi-leveled map