Astar should recieve odom data and set goal pose. Doesn't search yet. Testing pending