ドップラーICP:速度情報を活用した点群位置合わせアルゴリズム
DICP: Doppler Iterative Closest Point Algorithm
各点のドップラー速度測定とセンサ運動推定の整合性を評価する新たな目的関数を幾何学的目的関数と統合し、特徴に乏しい環境でも高精度かつ高速に点群位置合わせを行う手法を提案した。
著者: Bruno Hexsel, Heethesh Vhavle, Yi Chen
分類: cs.RO, cs.CV
原文アブストラクト
In this paper, we present a novel algorithm for point cloud registration for range sensors capable of measuring per-return instantaneous radial velocity: Doppler ICP. Existing variants of ICP that solely rely on geometry or other features generally fail to estimate the motion of the sensor correctly in scenarios that have non-distinctive features and/or repetitive geometric structures such as hallways, tunnels, highways, and bridges. We propose a new Doppler velocity objective function that exploits the compatibility of each point's Doppler measurement and the sensor's current motion estimate. We jointly optimize the Doppler velocity objective function and the geometric objective function which sufficiently constrains the point cloud alignment problem even in feature-denied environments. Furthermore, the correspondence matches used for the alignment are improved by pruning away the points from dynamic targets which generally degrade the ICP solution. We evaluate our method on data collected from real sensors and from simulation. Our results show that with the added Doppler velocity residual terms, our method achieves a significant improvement in registration accuracy along with faster convergence, on average, when compared to classical point-to-plane ICP that solely relies on geometric residuals.
