agv send msg and dijkstra edit
Merge pull request #63 from pasibun/agv_msg_sended_and_fix_dijkstra

agv send msg and dijkstra edit