この論文では、リターンごとの瞬間視線速度を測定できる距離センサーの点群登録のための新しいアルゴリズム、ドップラーICPを提示します。ジオメトリまたはその他の機能のみに依存するICPの既存のバリアントは、一般に、特徴のない機能や、廊下、トンネル、高速道路、橋などの反復的なジオメトリ構造を持つシナリオでは、センサーの動きを正しく推定できません。各ポイントのドップラー測定とセンサーの現在の動きの推定値の互換性を活用する新しいドップラー速度目的関数を提案します。ドップラー速度目的関数と幾何学的目的関数を共同で最適化し、機能が拒否された環境でも点群の位置合わせの問題を十分に抑制します。さらに、アライメントに使用される対応一致は、一般にICPソリューションを劣化させる動的ターゲットからポイントを取り除くことによって改善されます。実際のセンサーとシミュレーションから収集されたデータに基づいて、この方法を評価します。私たちの結果は、ドップラー速度残差項を追加することで、幾何学的残差のみに依存する従来の点から平面へのICPと比較した場合、平均して、より速い収束とともに登録精度の大幅な改善を達成することを示しています。
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.