Added explicit check for the stop_before_obstacle flag, so that the robot actually stops immediately if an unmapped obstacle is in the calculated path and do_mapping is turned off.
TargetUnrechableMessage will be send.
FYI @raphael @muellerd
@mmints @buchhold
