Added a bunch of different scoring algorithms.
Wired up euclidean distance+diagonalHeavy path score - Pathing kinda works!