Fixed NPAgent obstacle avoidance