ロボットの位置と位置の距離を計算する関数追加した。
ロボットの台車の移動誤差があつため、ロボットの位置の絶対比較を外した。
絶対距離を計算する関数を追加した。
台車の移動誤差があるため、ロボットの位置の絶対比較を外した。
テーブルを一個にして、テストした。
テストするために、GRID_SIZEを１０から４０にした
ロボットの台車の移動誤差を追加した
ビジョンの認識結果を受け取るか否かのフラッグをついかした。
ロボットが一か所見に行って、初期位置に戻れるようになってきた。
複数の家具でやった時、まだ出来てない。