Integrated Planning and Control on Manifolds: Factor Graph Representation and Toolkit

Peiwen Yang, Weisong Wen, Runqiu Yang +5

Model predictive control (MPC) faces significant limitations when applied to systems evolving on nonlinear manifolds, such as robotic attitude dynamics and constrained motion plann…