動的因子グラフを用いたバッチ型・逐次型キノダイナミック動作計画
Batch and Incremental Kinodynamic Motion Planning using Dynamic Factor Graphs
因子グラフと数値最適化により、衝突回避や速度・加速度・トルク制約を満たしつつ重力や慣性を活用した省エネルギー軌道を生成し、逐次消去で再計画を高速化するキノダイナミック動作計画手法を提案した。
著者: Mandy Xie, Frank Dellaert
分類: cs.RO
原文アブストラクト
This paper presents a kinodynamic motion planner that is able to produce energy efficient motions by taking the full robot dynamics into account, and making use of gravity, inertia, and momentum to reduce the effort. Given a specific goal state for the robot, we use factor graphs and numerical optimization to solve for an optimal trajectory, which meets not only the requirements of collision avoidance, but also all kinematic and dynamic constraints, such as velocity, acceleration and torque limits. By exploiting the sparsity in factor graphs, we can solve a kinodynamic motion planning problem efficiently, on par with existing optimal control methods, and use incremental elimination techniques to achieve an order of magnitude faster replanning.
