首振り2D LiDARソフトウェア設計
本書は、MIRSに搭載する首振り2D LiDARのハードウェア構成、必要部品、計測の成立条件、およびSLAMへの展望をまとめる。
目的と方式
2D LiDARをサーボで上下に傾け、各角度で得た水平距離スキャンを組み合わせて周囲の三次元形状を計測する。専用の回転式3D LiDARを新たに導入せずに、床面から障害物上部までの形状を捉えることを狙う。
この方式の計測は一度に全方向を撮るものではない。LiDARの水平スキャンとサーボの上下走査が時間差で進むため、点群は走査中の機体や対象物の動きに影響される。Arduinoの指令角度・角速度・タイムスタンプをLiDARスキャンと対応づけ、IMUで機体姿勢を補正する。
システム概要
計測ロジック
一断面から三次元点群へ
- LiDARが水平面内の各方向について距離を計測する。
- サーボがLiDARの向きを上下に変え、走査位置を移動する。
- 各距離値を、測定時刻に対応するサーボ角度と機体姿勢で三次元座標へ変換する。
- 複数の水平スキャンをまとめ、周囲の点群として利用する。
角度の計測と同期
本機にはサーボ軸のエンコーダを設けず、Arduino Uno R3がサーボへ指示した角度と角速度、およびタイムスタンプをMIRSに搭載したPCへ送る。この値は軸の実測値ではなく指令値に基づく姿勢情報であるため、サーボの追従遅れや機械的な遊びによる誤差を含みうる。
ROS 2側では角度・角速度・時刻からサーボ回転をTFの回転として再現し、LiDARスキャン時刻に対応づける。さらにIMUから得たロボット本体の姿勢を統合し、機体の傾きに合わせて点群の位置・姿勢を補正する。補正精度は、ArduinoとMIRSに搭載したPC間の時刻対応、IMUとLiDARの軸合わせ、サーボ指令から実動作までの遅延に依存する。
SLAMへの展望
首振り2D LiDARは、水平一面の2D LiDARでは捉えにくい高さ方向の障害物や床面形状を点群として扱える可能性がある。点群化してRTAB-MapのICP入力へ渡す構成、地面と非地面を分けてNav2の走行判断に使う構成がある。
| 段階 | 目標 | 確認指標 |
|---|---|---|
| 1. 安定した計測 | 首振りしながら再現性のある点群を得る。 | 同じ場所で取得した壁・床の形状が重なり、周期的なゆがみが小さい。 |
| 2. 3D地図・位置推定 | 点群と機体姿勢を組み合わせ、地図作成と位置推定を行う。 | 走行後の地図閉合、位置ずれ、再走行時の地図照合を評価する。 |
| 3. 地形・障害物を使う走行 | 床面と障害物の高さを考慮して安全な経路を選ぶ。 | 低障害物・張り出し・段差の検出率と誤検出を確認する。 |
この方式はコストと搭載体積を抑えやすい一方、専用3D LiDARのように瞬時に全視野を観測できない。機体を高速に動かす場合や動く物体が多い場合は点群が変形しやすく、走査を遅くすると地図更新が遅れる。SLAM性能を評価する前に、停止状態での角度・距離校正、低速走行時の点群安定性、IMU・オドメトリとの時刻整合を確認する。