回避と誘導試験

回避プログラムと誘導プログラムをリンクしました。
外は雨が降っているのでGPSが使えない状態で
オドメトリ走行です。

最後のほうはオドメトリの誤差が大きくて
WPの切り替えがうまくいかなくなっています。