Added preliminary obstacle avoidance to NPC