Open yasuohayashibara opened 7 years ago
こちらのノードのフレームをmea_odomとした. フレームの関係を以下のコマンドで表示した. rosrun tf view_frames
2つのフレームを読み込んで統合するAMCLを以下のブランチで作成中 https://github.com/yasuohayashibara/navigation/tree/multiple_odoms
コンパイルは通ったが, 実行するとtf関連のエラーが発生したので,以下の形式に変更した.
分かりづらいが,以下でオドメトリを2つ入力できるようになったと思われる. https://github.com/yasuohayashibara/navigation/commit/5de25034f8990e8d1a64db997eb3f14a5d28ad6e
駆動輪と計測輪のオドメトリを融合する
駆動輪のオドメトリはimuのデータとrobot_pose_ekfで融合されて,amclに渡される. この時robot_pose_ekfのデータはtfのodomフレームにブロードキャストしている.
こちらのノードもtfのodomフレームにブロードキャストしているため,これを別のフレームとしてブロードキャストして,amclで2つのフレームを使用してパーティクルを移動させれば良い.