Codes for VSLAM project