Primitive obstacle avoidance for Auto mode

@autodidacta have you seen this blog ?