Add wandering behaviour and fixes
fix wander objective