Diverse multi-path planning with a path-set costmap | IEEE Conference Publication | IEEE Xplore