LoginSignup
18

More than 5 years have passed since last update.

Navigation Stack を理解する - 3.1 amcl: ROSで遊んでみる

Last updated at Posted at 2016-04-12

目次

  1. 導入
  2. move_base (ナビゲーション)
    1. ROSで遊んでみる
    2. ソフトウェア構成をみる
  3. amcl (自己位置推定)
    1. ROSで遊んでみる ← いまココ
    2. ソフトウェア構成をみる
    3. 原理をみる (準備編)
    4. 原理をみる (応用編)
  4. gmapping (地図生成)
    1. ROSで遊んでみる
    2. ソフトウェア構成をみる
    3. 原理をみる(応用編)
    4. 原理をみる(準備編 その1)
    5. 原理をみる(準備編 その2)

はじめに

本節ではNavigation Stack の子分的存在の一つである,amcl について記述します.子分だからといって,技術的に劣っているとかそういうことではありません.move_baseという頭からみたらサポート役という位置づけであって,こちらも技巧的に組まれています.

やりたいことは,自己位置推定です.スリップ等でずれまくってしまうオドメトリ情報を,地図とセンサ情報を駆使して補正しようという発想です.
07_現実はずれている.png

さて,ソフトウェア構成内の位置づけとしては,下記の図に示すとおりです.

  • ROS Wiki の図中
    01_位置づけ1.png

  • 導入部で示したパッケージの図中
    02_位置づけ2.png

環境

Husky AMCL Demo について

amcl を使った自己位置推定を体感します.ただし,地図は既に作成されたものを使用しています.

03_チュートリアル位置づけ.png

ROSで遊んでみる

例によって,遊んでみましょう.

インストール

Navigation Stack を理解する - 2.1 move_base: ROSで遊んでみる でインストールしたパッケージで十分です.

各種launch ファイルの起動

i. Husky シミュレータの起動(gazebo)

$ roslaunch husky_gazebo husky_playpen.launch

01.png

ii. ビジュアライザの起動(rviz)

$ roslaunch husky_viz view_robot.launch

今回は地図を使いますので,ワールド座標系の原点は /map フレームとしておきます.初期状態では,/map フレームと /odom フレームと /base_link フレームは一致しています.

05_rviz.png

iii. move_base の起動

$ roslaunch husky_navigation amcl_demo.launch

これで,自己位置推定付きでナビゲーションが可能な状態となります.

自己位置推定を体感する

Navigation Stack を理解する - 2.1 move_base: ROSで遊んでみる と同じ要領で目標を設定すれば,動きます.しばらく遊んでいると,いくつか違いに気がつきます.

大域的コストマップが地図全体に割り当てられる

2.1 move_base: ソフトウェア構成をみるでは部分的にしか割あたらなかった大域的コストマップが,地図全体に行き渡っています.いい眺め(?)です.

12.png

/odom フレームと/map の補正が確認できる

06_rviz_odomとmapのずれ.png

オドメトリの原点である/odom フレームが,ワールド座標系の原点である/map フレームからずれた位置に表示されています.これは,move_base のチュートリアルではなかった挙動です.amcl がオドメトリのずれを補正してくれていることが理解できます.

おわりに

遊べるのはこんなところです.rvizで遊ぶ分にはあまり違いはなさそうですが,amcl が裏でかなりいい仕事をしているのです.次項以降でその辺りを紐解いていきます.

Next: 3.2 amcl: ソフトウェア構成をみる
Prev: 2.2 move_base: ソフトウェア構成をみる

参考文献

  1. S Thrun, et al., "Probabilistic Robotics", the MIT Press, 2005.
  2. ROS Wiki.
  3. "ros-planning/navigation", github.
  4. "husky_navigation", github.

Register as a new user and use Qiita more conveniently

  1. You get articles that match your needs
  2. You can efficiently read back useful information
  3. You can use dark theme
What you can do with signing up
18