Skip unreachable poses in wandering

[kunzel]

[kunzel]

After solving #6, skip goal poses that cannot be reached. Monitored_navigation will return a failure that it cannot reach the goal. If this happens in the 'wait-for-person' behaviour, the overall action should fail.