From images to augmented 3D models: improved visual SLAM and augmented point cloud modeling