Improve underground mapping