2022年11月アーカイブ

ROS2 で、Rtabmap_ros を試す。#2
--- ROS2 & Rtabmap_ros で、Gazbo Turtlebot3 with Scan (Acitve SLAM も可) ---
Foxy devel Rtabmap_ros を参考に、rtabmap_ros で、ROS2 Gazebo Turtlebot3 with Scanを、動かしてみました。
PC 環境:
Ubuntu Mate 20.04
ROS2 :foxy

1. 手順。
Example with Turtlebot3 を参考にすればできます。
$ ros2 launch turtlebot3_gazebo turtlebot3_house.launch.py

$ ros2 launch rtabmap_ros rtabmap.launch.py \
visual_odometry:=false \
frame_id:=base_footprint \
subscribe_scan:=true depth:=false \
approx_sync:=true \
odom_topic:=/odom \
scan_topic:=/scan \
qos:=2 \
args:="-d --RGBD/NeighborLinkRefining true --Reg/Strategy 1" \
use_sim_time:=true \
rviz:=true

Teleop keyboard を起動して操作。
$ ros2 run turtlebot3_teleop teleop_keyboard

ROS2 で navigation2 の Active SLAM を試す。
--- ROS2 Gazbo Turtlebot3 で、Mapping しながら、 Navigationでロボットを動かす。 ---

(SLAM) Navigating While Mapping を参考に、ROS2 Gazebo Turtlebot3 を、動かしてみました。
PC 環境:
Ubuntu Mate 20.04
ROS2 :foxy

1. Gazebo turtlebot3_house Waffle の準備。

$ ros2 launch turtlebot3_gazebo turtlebot3_house.launch.py
で、Gazebo House が起動出来ますが、ロボットの起点がちょっと、ROS と比べて変なので、修正します。
~/colcon_ws/src/turtlebot3_simulations/turtlebot3_gazebo/worlds/turtlebot3_houses/waffle.model
.... <include> <!-- <pose>-2.0 -0.5 0.01 0.0 0.0 0.0</pose> --> <!-- changed by nishi --> <pose>-3.0 1.0 0.01 0.0 0.0 0.0</pose> <uri>model://turtlebot3_waffle</uri> </include> ....

注)ロボットの pose(位置と向き) は、tf base_footprint が、 tf odom の pose からの距離と向きの差で決まる。ので、tf odom を起点とした値を使います。
tf odom の x 軸は、ロボットの前、後、 y軸は、ロボットの左右になっていて、Rviz2 の開始時の画面が、90[度] 左に回転しているのがややこしいが、
Rviz2 の開始時の画面を、90[度] 右に回転すれば、理解しやすい。
tf base_footprint は、tf odom から、後ろに 3[m] (x軸で、-3.0) 、左に 1.0[m] (y軸で、+1.0) になります。これが、起動時のロボットの位置になります。
z軸=0.01 は、ちょっと浮かせているのかな?　向きは、変わらず。

tf odom は、tf map からの距離と、向が与えられる。
tf map は、 Map原点(左、下が 0,0) からの距離が、Map データ上から与えられる。
注)全ては、MAP 情報の定義で自由に決まる。
Turtlebot3 Gazebo の MAP 定義が上記のようになっているだけです。

2. (SLAM) Navigating While Mapping の 4- Getting Started Simplification を参考に、

$ ros2 launch nav2_bringup tb3_simulation_launch.py slam:=True
すれば、Gazbo も一緒に起動できるようですが、
なぜか、おんちゃんが試すと、Gazebo が起動途中でだんまりになります。

ROS2 で、 Rtabmap_ros を試す。
--- Jetson Nano 2G でのBuild トラブルの巻。---

Jetson nano 2G
Jetpack4.x and ubuntu 20.04
ROS2: galactic

rtabmap_ros/ros2
Ubuntu Mate 20.04 で、Rtabmap_ros のソースビルドが出来たので、

1. 次は、Jetson Nano 2G で、Rtabmap_ros のソースビルドを行って見たのですが、
これがなかなかうまく行かない。

84[%] 辺りまで進んで、それからずっと進まない。
途中で、なんやら変なエラー表示が出てくる。

kthread invoked oom-killer :gfp_mask=0x27...... Out of memory : kill process 14508(cc1plus) score 247 or sacrifice child killed process 14508(cc1plus) total-vm:1824072 kB, anon-rss: 355148kB, file-rss:0kB, shmem-rss:0kB .... BUG:workqueue lookup - pool cpus=0-3 flags=0x5 nice=0 stuck for 37s! ... <br /> 最初は、swapfile のサイズを 5G から、思い切って 10G にしてみる。<br /> 結構、ビルドの進捗が早くなった、がこれでも、状況は、85[%] 辺りから、変わらない。<br /> </p> <p style="margin-top:30px;"> 2. JetsonNano 2G のメディアの不良か? と思って、ネットでパーテイションチェックの方法を検索したが、出てこない。<br /> ものは試しで、別の Ubuntu PC に、SDカードRead/Write で、JetsonNano 2G の SDカードを、挿すと、<br /> /dev/sdb1 に、JetsonNano 2G の '/' が出てくるので、<br /> これを、 fsck で修復することにしました。<br /> <br /> Ubuntu 20.04 PC で、JetsonNano 2G の SDHCカードを、外付けドライブで、挿す<br /> <br /> $ sudo umount /dev/sdb1<br /> $ sudo badblocks -s -o ./badblocks-text.txt /dev/sdb1<br /> <br /> $ sudo fsck -v[c]f /dev/sdb1<br /> -c: badblocks を先に実行して、不良ブロックを、使用不可にする。<br /> <br /> これで、OK か?<br /> </p>