Astar test

Updated vec3 to implement hashCode, so that it will work in a set
Implemented an A star test, mostly works
Fixed A* calculations

I had mixed up some of the cost calculation
  (was modifying prev's cost by new loc's terrain)
Added some debug code