This method integrates the state estimations of each the ego vehicle and the static and dynamic objects in the environment right into a unified optimization framework, to realize SLAM and object tracking (SLOT) concurrently. We perform SLAM and object tracking simultaneously in this framework, which significantly improves the robustness and accuracy of SLAM in highly…