3D reconstruction with inverse depth filter of feature-based visual SLAM