Fixed cost map usage for OMPL's new cost method