def publish_astar(self):
obj = Astar()
obj.astar_func(self.path_array)
for i in range(len(self.path_array)):
rospy.sleep(1)
msg = AStarPath()
msg.data = self.path_array[i]
self.astar_pub.publish(msg)
