Improvement of terrain-aided navigation via trajectory optimization | IEEE Conference Publication | IEEE Xplore