Adding Tracking SLAM