Improved pathfinding in smaller areas, added portals

Commit video: http://youtu.be/dbs94oDXVRI