Pathfinding multiple fixes

Tile->position, more effective, no longer stuck on corners, other
various bug fixes, one of them being the movement around traffic lights.