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`)。
• 示例数据目录(下载 URL / 许可证) —— 2-D 用 skimage.data(BSD/公有领域)加合成图,3-D 给出真实数据源(Stanford/PDS 等)的下载 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 算子登记表。本条目由 tools/opdocs.py md 自动生成(请勿手工编辑)。*
© 2026 Kazufumi Furuse — Fullseye operator documentation. Licensed under Apache-2.0.