General Concept of 3 D SLAM