We implemented Graph-SLAM algorithm for several model or real-world data. At first, we applied it to KITTI model dataset and evaluated how the ground truth is realized. Second, we analyzed the pictures of objects on the desk containing ArUco Markers with visual odometry and Graph-SLAM. In final, we demonstrated real-time trajectory and pose estimation using real-sense camera.