An extended penalty function approach to the numerical solution of constrained optimal control problems

This paper presents the extended penalty function method for solving constrained optimal control problems. Here, equality and inequality constraints on the state and control variables are considered. Using the extended penalty function method, the original constrained optimal control problem is transformed into a sequence of optimal control problems without inequality constraints. This is accomplished by adding to the cost functional a penalty term that takes on large values when the inequality constraints are violated and small values when the constraints are satisfied. Also presented is a continuation method for solving the sequence of differential-algebraic boundary value problems arising from the transformed optimal control problems. The effectiveness of the approach is demonstrated via examples.