Creating a 3-D Model Reconstruction of the surrounding and then using RGBD Slam to do the motion tracking. Registering the point clouds from RGBD sensors such as the kinect or stereo cameras. The rgbdslam node can be connected easily to an octomap_server node to create a memory-efficient 3D map.