出村です！今日もよろしくお願いします！
今出村はTeam IcARusというエンジニアチームで本物のドローンを使った現実融合(Augumented Reality)型空中対戦ゲーム「Drone Space Defence」を開発中です！
今週の金曜,4/24に東京のお台場で開かれる世界的なイベント「SLUSH ASIA」でゲーム「Drone Space Defence」を展示します！国際的なドローンパフォーマ・芸人とのコラボもします！
最先端の技術が体験できます！よろしければ体験しに来てください！
SLUSH ASIA
Team IcARus HP
Turtlebotで部屋の好きな場所に移動する
部屋の好きな場所に移動できるロボットを作ってみたいと思ったことはありませんか？
KinectというデバイスとSLAMという技術を使えば可能です！
Kinectはジェスチャー認識デバイスとして有名ですが、Kinectの中にはRGBカメラ（普通のカメラ）とデプスカメラ（深さを測るカメラ）が入っています。
この画像はkinect V1で撮ったものです！左が深さ画像、右がRGB画像になります。
SLAM（Simultaneous Localization and Mapping）はロボット等の地図生成と自己位置推定を同時に行うことのできる技術です！SLAMをするために必要なものは地図を生成するための情報と自己位置推定をするための情報で、この情報をKinectとTurtlebotだけで補うことができます！
今回の開発環境はUbuntu 14.04,ROS Indigo, Kinect V1, Turtlebotです。
Turtlebotの動作確認
まず、今回はTurtlebotを動かすためにROS（Robot Operating System）というロボットミドルウエアを使用します！
ROS環境をまだ構築していない方はROSを使用したCRANE+の動かし方の１〜４章を見て下さい！
Turtlebotを動かすためのROSパッケージは入っているでしょうか？入っていない場合はFamily&Robotics勉強会にTurtlebotパッケージの入れ方があるので下記のfamily&Robotics勉強会のURLを参考にしてください！
family&Robotics勉強会資料 Turtlebotパッケージの入れ方
turlebotを起動します！turtlebotの接続ケーブルをPCのUSBにつないで下さい！
$ roslaunch turtlebot_bringup minimal.launch
このとき音がなればturtlebotとPCとの接続が確立しています！
Ubuntu 14.04にkinect V1 driverを入れる
Ubuntu 14.04ではkinect V1のドライバーがaptで入るパッケージ（PPA含む）だけでは上手く動作しません。
以下のサイトの説明にしたがってkinect V1のドライバーを入れて下さい！このインストール方法で入るのは新型のKinectドライバーではないのですが、これしかドライバーをUbuntu 14.04に入れる方法が見つかりませんでした！（ソースインストール＋aptパッケージ）
Kinect V1をUbuntu 14.04で使えるようにする
また、kinect V1の接続ケーブルのランプは緑色に光っているでしょうか？光っていない場合はkinect V1への電源が供給されていないもしくは断線しています。
ドライバがPCに認識されているかどうかは以下のコマンドで確認できます。
$ lsusb | grep "Xbox"
この３つのデバイスが認識されていたら成功です！Xbox NUI Motorだけが認識されている場合は正しく認識していません。
次にROSのTurtlebot PackageがKinectを使用できるようにします。以下のコマンドでROSから使用できるようになります。
$ echo "export TURTLEBOT_3D_SENSOR=kinect" >> ~/turtlebot/devel/setup.sh $ source ~/turtlebot/devel/setup.bash
Kinectセットアップ完了です！
Turtlebotを操縦する
Turtlebotを操縦してみましょう！Turtlebotの移動にはキーボードかPS3コントローラを使います！
キーボードで操縦する場合
$ roslaunch turtlebot_teleop keyboard.launch
このコマンドを入力したターミナルが選択されているとき(最後にクリックしたものがコマンドを入力したターミナル)だけキーボード入力を受け付けます！
PS3コントローラを使いたい場合
PS３コントローラを使用するときはBluetooth内蔵PCが推奨されます。Bluetoothがある場合は無線でPS3コントローラが動かせます。
PS3コントローラのドライバーパッケージを入れます。
$ sudo apt-add-repository ppa:falk-t-j/qtsixa $ sudo apt-get update $ sudo apt-get install sixad
PS3コントローラをUSB経由でPCと接続します。そしてこのコマンドを入力してください。
$ sudo sixpair
PS3コントローラをUSBケーブルから外し、
$ sixad --start
でPS3コントローラのPSボタンを押し続けると認識されます。
DUALSHOCKコントローラでは認識時に振動します。SIXADコントローラでは認識時にPS3のユーザーを示すLEDがぐるぐる回るだけです。
$ roslaunch turtlebot_teleop ps3_teleop.launch
L1がデッドロックになっています。L1を押しながらでないと入力を受け付けません。
L1 + 左ジョイスティックを上にかたむけると前進、L1 + 左ジョイスティックを左に傾けると左に回り、L1 + 左ジョイスティックを右に傾けると右に回ります。
TurtlebotでSLAM
SLAMには2Dマップと3Dマップの２種類があります。今回は２DマップのSLAMを使用します。
Turtlebotで地図生成
今回は地図生成にGmappingというアルゴリズムを使用します。以下のコマンドを入力して下さい！
$ roslaunch turtlebot_bringup minimal.launch $ roslaunch turtlebot_bringup 3dsensor.launch $ roslaunch turtlebot_navigation gmapping_demo.launch
これでSLAMプログラムが起動しました！
$ roslaunch turtlebot_rviz_launchers view_navigation.launch
これで地図生成の可視化をします！
PS3コントローラやキーボードでTurtlebotを移動させてみましょう！
すると、地図がどんどん生成されていくではないでしょうか！
ロボットを移動するほど地図が生成されます。
地図を保存したい場合
地図を保存したい場合は下のコマンドを入力して下さい！
$ rosrun map_server map_saver -f ~/Pictures/rosmap
このコマンドではファイルはPicturesにrosmap.pgmというファイル名で保存されますが任意の場所に任意のファイル名で保存したいときは
$ rosrun map_server map_saver -f /パス名/ファイル名
と入力して下さい！
生成された地図を見てみます！gimpという画像エディタがlinuxでは使いやすいのでインストールを推奨します。以下のコマンドを入力するとインストールできます！
$ sudo apt-get install gimp
そして以下のコマンドで生成された地図を見ることができます！
$ gimp ~/Pictures/rosmap.pgm
どうでしょうか。下の画像のような地図が生成されたでしょうか。
Turtlebotを部屋の好きな場所に移動させる
では生成した地図データを元にTurtlebotを部屋の好きな場所へ移動させましょう！今回はロボットの位置推定にAMCL(Adaptive Monte Calro Localization)という２Dマップのアルゴリズムを使用します。
まず生成した地図データを指定します。以下のコマンドで指定できます。
$ export map_server map_saver -f ~/Pictures/rosmap.yaml
任意のファイル名で地図を保存した場合は
$ export TURTLEBOT_MAP_FILE=/パス名/ファイル名
そして以下のコマンドを入力してください！
$ roslaunch turtlebot_navigation amcl_demo.launch $ roslaunch turtlebot_rviz_launchers view_navigation.launch
するとこのような画面が開きます！
部屋の好きな場所に移動するためには２つの操作をする必要があります！
1.現在地の指定
rvizアプリケーションの上のタブの”2D Pose Estimate”をクリックして、現在地をrvizのマップ上でクリックして指定してください！
2.目的地の指定
rvizアプリケーションの上のタブの”2D Nav Goal”をクリックして、目的地をrvizのマップ上でクリックして指定してください！
するとロボットが目的地に向かって移動します！
これでマップに載っている場所なら部屋の好きな場所のどこにでも行くことが可能です！
今回はGUIで現在地と目的地を指定しました。ですが、テキストファイルに現在地と目的地を記載して場所を指定したり、ウエイポイント走行をすることも可能です！
また、SLAM技術には色々なアルゴリズムがあります。今回は２Dマップでしたが、３Dマップを生成して３Dマップの情報を元に位置推定を行うことも可能です！
次はRGB-DのSLAM,ウエイポイント走行や、画像追跡について書きます！
