ナビゲーション終了の通知

判定は move_base からとってこれるならそうするが， できない場合は amcl_pose と goal のユークリッド距離で計算する．

ゴールに到達したと判断できればイベントとしてRoIS側に通知する．