点群ICPの位置合わせ

未知対応を含む3次元点群の、初期姿勢からの局所的な剛体位置合わせ。

入力点群は初期姿勢で十分近いことが前提です。点ごとの最近傍対応は反復中に更新され、局所解に収束する場合があります。

項目を入力・選択してから「計算する」を押してください。

選択内容に応じて、残りの入力項目を案内します。

計算する内容

移動前・基準の両方と初期並進・対応距離に同じ単位を使います。

移動前の点群 XYZ必須
行点ID(任意) 任意x(選択した座標単位)y(選択した座標単位)z(選択した座標単位)操作
1
2
3

4列を左端の欄へタブ区切りで貼り付けられます。1000行まで。

1行が1点。行順と同じ点の重複を保持します。列順はID、x、y、z。

基準の点群 XYZ・法線必須
行点ID(任意) 任意x(選択した座標単位)y(選択した座標単位)z(選択した座標単位)nx(単位法線) 任意ny(単位法線) 任意nz(単位法線) 任意操作
1
2
3

7列を左端の欄へタブ区切りで貼り付けられます。1000行まで。

列順はID、x、y、z、nx、ny、nz。点と平面方式は全行で単位法線が必要。点と点方式では法線は空欄で構いません。

この距離を超える点を対応外とします。無条件に全点をinlierにしません。


計算結果

値を入力して計算してください。

お気に入り一覧

計算方法・適用範囲・出典

計算方法

各反復kで pᵢ=Rₖxᵢ+tₖ を計算し、基準点群の最近傍qⱼを距離 d≤dmax で選ぶ。点と点は Σρ(||pᵢ−qⱼ||)、点と平面は Σρ(nⱼ·(pᵢ−qⱼ)) を対応固定の近似更新で最小化。点と点はdet(R)=+1のHorn四元数fit、点と平面はSO(3)小回転+並進の6×6線形最小二乗。収束はRMS変化・姿勢変化・対応数の停止条件の同時成立、最大60反復。重なり率は閾値内の移動前点数/移動前総点数、3D RMSは閾値内の最近傍距離の二乗平均平方根。

source→targetのSE(3)、対応点と外れ値、3D RMS・法線方向RMS、重なり率、反復履歴と収束状態。

計算例(架空の数値)

独立検算:非共線の4点以上で source=target、初期roll/pitch/yawと並進をすべて0にすると R=I、t=(0,0,0)、RMS=0、重なり率100%。別の点群では近い初期値を入力して局所解を比較します。

適用対象と限界

同一単位・同一軸規約の2つの有限な3D点群。point-to-planeでは各基準点に単位法線が必要。初期姿勢に依存する局所解。global登録、反射/尺度推定、特徴量マッチング、法線自動推定、測量精度・一意性の保証は対象外。表入力は各1000点まで。

採用した方式

  • ICP最近傍更新・剛体fit(E1839-ICP-v1.0):対象範囲 局所最適、3D、既知初期姿勢、対応距離内/適用地域 global

方法と出典

方法:Open3D legacy ICP definition (0.19.0 tutorial) aligned; independent E1839-ICP-v1.0 (2026-11-15)。データ記録日:2026-11-15。