fixed template for astar, wrote astar method code, and created template for A* test arduino sketch