check frequently for radius, so filtering stays within it
improve escape strategies; create function to go through whitelist
stay within radius when filtering
DRIVE_TO_GOAL... trigger in publishGoal