Omnidirectional dense large-scale mapping and navigation based on meaningful triangulation