gicp — 3D gicp op

Data kinds: points × pointspose

Call: import fullseye as fs; fs.ledger.gicp(source, target, max_iter: 'int' = 30, k: 'int' = 20, epsilon: 'float' = 0.001, tol: 'float' = 1e-08, init=None) -> 'dict' (to call the implementation directly, import gicp; gicp.gicp(source, target, max_iter: 'int' = 30, k: 'int' = 20, epsilon: 'float' = 0.001, tol: 'float' = 1e-08, init=None) -> 'dict'; from the registry, ops3d.get("gicp"))

Return value through the ledger: fullseye.ledger.gicp(...) returns **only the declared out type pose** (the underlying function also returns auxiliary values). When you need what was dropped, use fullseye.ledger.gicp.raw(...) or call gicp.gicp directly.

Usage

Estimate the rigid transform (R,t) by Generalized-ICP (covariance-weighted Mahalanobis ICP).

> The detailed description below is the original text — the summary and the headings are translated.

各反復で source→target の最近傍対応を張り、残差 `d_i = R·s_i + t - q_i` を

重み `W_i = (C_target[q_i] + R·C_source[s_i]·Rᵀ)⁻¹` で測るマハラノビス

コスト `Σ d_iᵀ W_i d_i を、小角線形化 R ← (I+[ω]×)R` の Gauss-Newton で

最小化する。各対応のヤコビアン `J_i = [-[R·s_i+t]× | I]`(3×6)から

正規方程式 `(Σ J_iᵀ W_i J_i) x = -(Σ J_iᵀ W_i d_i)`(6×6)を解いて増分

`x=[ω|τ]` を得、Rodrigues で回転に戻して累積する。

共分散は plane-to-plane(`estimate_covariances`)。point-to-plane が target の

法線方向へ残差を射影する(rank-1)のに対し、GICP は source・target 双方の

full 3×3 共分散を合成した重みを使うため、平面的・ノイズを含む点群で頑健。

ICP はローカル最適化なので 近い初期化を前提(粗マッチや `init` を渡す)。

引数:

source (N,3): 動かす側の点群。

target (M,3): 参照側(固定)の点群。

max_iter: 最大反復数。

k: 共分散推定の近傍数。

epsilon: plane-to-plane の法線方向小分散(0<ε<1)。

tol: 収束閾値。増分並進 ‖τ‖ が `tol×(target のRMS半径)` 未満かつ

増分回転 ‖ω‖(rad)が `tol` 未満で打ち切り(スケール相対)。

init: (R0(3,3), t0(3,)) の初期姿勢タプル、または None(単位)。

返り値:

dict:

"R" (3,3) ndarray — target ≈ R·source + t を満たす回転。

"t" (3,) ndarray — 並進。

"rmse" float — 最終対応上のユークリッド RMSE(採用点)。

"iterations" int — 実反復数。

例外:

ValueError: 入力形状不正 / 点数不足 / 数値発散(非有限)= fail-closed。

References (sample data, literature)

• Sample-data catalog (download URLs / licences) — 2-D uses skimage.data (BSD/public domain) plus synthetic images; 3-D lists download URLs for real data sources (Stanford, PDS, …).

• Operator provenance and references — the sources of the research/methods this op family came from.

Runnable examples (verified samples that actually call this op)

gicp_registerpy -3.11 examples_3d/gicp_register.py

Ops the type connects to (they accept pose as input)

fuse_to_voxel · pose_error · bundle_adjust · mean_reprojection_error · optimize_pose_graph · relative_pose · mean_edge_error · rotation_translation_error

Same category (gicp)

estimate_covariances


*Provenance: gicp.py — 3D operator registry. This per-op note is generated by tools/opdocs.py md (do not hand-edit).*

© 2026 Kazufumi Furuse — Fullseye operator documentation. Licensed under Apache-2.0.