Ported to Go for teh lulz
Attempted pathfinding algorithm