Updated to newer version of AStar.cpp. Calculating path from starting
rfid read from robot correctly. Crashing when sending moves to robot.