Improved Enemy Pathfinding

Improved the enemy pathfinding so it doesn't get stuck behind obstacles
as often.