Remove useless comment
Remove useless local variables in Graph constructor
Rename GraphNode to GridNode because only used in grid mode
Move gps heuristic function to tests.js

Also clearer segmentation between heuristic function and cost function.