Fixed vector::reserve exception in smac planner due to precision error#2563

SteveMacenski merged 1 commit intoros-navigation:mainros-navigation/navigation2:mainfrom

incubedIT:vector-reserve-exception-precisionincubedIT/navigation2:vector-reserve-exception-precisionCopy head branch name to clipboard