pose_graph op• 데이터 종류: pose → table
• 호출: import fullseye as fs; fs.ledger.optimize_pose_graph(poses_init, edges, fix_first=True, max_iter=200)(구현을 직접 호출하려면 import pose_graph; pose_graph.optimize_pose_graph(poses_init, edges, fix_first=True, max_iter=200), 원장에서 가져오려면 ops3d.get("optimize_pose_graph"))
상대 자세 제약 + 루프 클로저로부터 전역 자세를 최적화. → dict{poses, rmse, cost}.
> 아래 상세 설명은 원문입니다 —— 요약과 제목은 번역되어 있습니다.
poses_init (N,6)=[rvec|t] の初期推定(ドリフトあり)、edges の相対姿勢制約を満たすよう最適化。
fix_first=True で先頭ノードを固定し gauge を除く。
• `edges: (i, j, rvec_ij, t_ij[, w_rot, w_trans]) のリスト。(rvec_ij, t_ij)` は「i から
見た j」= `T_i⁻¹ ∘ T_j の計測値(relative_pose` と同じ規約)。オドメトリ (i, i+1) と
ループ閉じ(離れた i, j)を同じ形で混ぜてよい。重みは残差に `sqrt(w)` を掛ける(省略時 1)。
• 各エッジの残差は `measured⁻¹ ∘ predicted` を回転ベクトル + 並進の 6 次元にしたもので、
`scipy.optimize.least_squares(method="lm") で最小化する(max_nfev = max_iter × パラメータ数`)。
• 返り値: `poses (N,6)(fix_first なら先頭は初期値のまま)、rmse` =
`mean_edge_error(poses, edges)、cost` = 最終コスト(残差 2 乗和の 1/2)。
fail-closed: ノード数 < 2、エッジ 0 本、エッジの添字が `[0, N)` を外れる(負の添字の黙った
折り返しも拒否)場合は `ValueError。fix_first=False` にすると gauge が残り解は一意でない
(LM は初期値近くの 1 つを返す)。回転は rad、並進は座標の単位で、両者を同じ残差ベクトルに
並べるため単位が大きく違うときは重みで揃える。3D 点も観測画素も使わない(それらを含めて
最適化するのは `bundle_adjust`)。
• 샘플 데이터 카탈로그(DL URL / 라이선스) —— 2-D 는 skimage.data(BSD/public)+ 합성, 3-D 는 실데이터 소스(Stanford/PDS 등)의 DL URL.
• 연산자의 내력·참고문헌 —— 이 연산자 족의 바탕이 된 연구/기법의 출처.
• pose_graph_slam — py -3.11 examples_3d/pose_graph_slam.py
table 를 입력으로 받는 것)fuse_to_voxel · mesh_select_lod
pose_graph)relative_pose · mean_edge_error
*Provenance: pose_graph.py — 3D 연산자 레지스트리. 이 op 노트는 tools/opdocs.py md 가 자동 생성합니다(직접 편집하지 마세요).*
© 2026 Kazufumi Furuse — Fullseye operator documentation. Licensed under Apache-2.0.