agv send msg and dijkstra edit