Fixed Astar and added Centroid to launch file