Probably fixed updating of pathfinding. Also added a safety distance to obstacles.