ガウス過程距離場による障害物・地面制約を考慮した安全ナビゲーション
Gaussian Process Distance Fields Obstacle and Ground Constraints for Safe Navigation
3D点群を地面と非地面に分け、2つのガウス過程距離場で障害物と地面制約を表現し、四分木構造で自由空間の多解像度マップを構築することで、車輪・脚式ロボットや人間支援に使える安全で滑らかな経路計画を実現した。
著者: Monisha Mushtary Uttsha, Cedric Le Gentil, Lan Wu, Teresa Vidal-Calleja
分類: cs.RO
原文アブストラクト
Navigating cluttered environments is a challenging task for any mobile system. Existing approaches for ground-based mobile systems primarily focus on small wheeled robots, which face minimal constraints with overhanging obstacles and cannot manage steps or stairs, making the problem effectively 2D. However, navigation for legged robots (or even humans) has to consider an extra dimension. This paper proposes a tailored scene representation coupled with an advanced trajectory optimisation algorithm to enable safe navigation. Our 3D navigation approach is suitable for any ground-based mobile robot, whether wheeled or legged, as well as for human assistance. Given a 3D point cloud of the scene and the segmentation of the ground and non-ground points, we formulate two Gaussian Process distance fields to ensure a collision-free path and maintain distance to the ground constraints. Our method adeptly handles uneven terrain, steps, and overhanging objects through an innovative use of a quadtree structure, constructing a multi-resolution map of the free space and its connectivity graph based on a 2D projection of the relevant scene. Evaluations with both synthetic and real-world datasets demonstrate that this approach provides safe and smooth paths, accommodating a wide range of ground-based mobile systems.
