fix: add check for keepout filter mask if it is not nullptr#5773

SteveMacenski merged 2 commits intoros-navigation:mainros-navigation/navigation2:mainfrom

AJedancov:fix/check-keepout-filter-maskAJedancov/navigation2:fix/check-keepout-filter-maskCopy head branch name to clipboard