Reimplemented goal seeking and obstacle avoidance using spatial vector type.