A frequency‐constrained geometric Pontryagin maximum principle on matrix Lie groups

We present a geometric discrete‐time Pontryagin maximum principle (PMP) on matrix Lie groups that incorporates frequency constraints on the control trajectories in addition to pointwise constraints on the states and control actions directly at the stage of the problem formulation. This PMP gives first‐order necessary conditions for optimality and leads to two‐point boundary value problems that may be solved by numerical techniques to arrive at optimal trajectories. We demonstrate our theoretical results with numerical simulations on the optimal trajectory generation of a wheeled inverted pendulum and an attitude control problem of a spacecraft on the Lie group SO(3).