Abstract:

This paper considers a nonlinear constrained optimal control problem (NCOCP) originated from energy optimal trajectory planning of servomotor systems. Solving the exact optimal solution is challenging because of the nonlinear and switching cost function, and various constraints. This paper proposes a method to manage the switching cost function to establish a set of necessary conditions of an NCOCP. Specifically, a concept "sub-trajectory" is introduced to match multiple Hamiltonian due to switches in the cost function. Necessary conditions on the optimal trajectory is established as a union of conditions for all sub-trajectories and Weierstrass-Erdmann corner conditions between sub-trajectories. The set of feasible structures of optimal trajectories is further identified and represented by various state transition diagrams for the servomotor application. A decomposition-based shooting method is proposed to compute an optimal trajectory by solving multi-point boundary value problems. Simulations and experiments validate the effectiveness of the methodology and the energy saving benefit.