Stereo SLAM

SLAM system using stereo matching, generating dense 3D point clouds, motion estimation via PnP, and Odometry calculation through ICP and bundle adjustment techniques.