Added some local obstacle avoidance using directional dampers. Currently obstacle is hard coded.