Astar Optimizations
Astar optimized version...no debugging
Astar optimized version...no debugging