An Introduction to Trajectory Optimization: How to Do Your Own Direct Collocation

Abstract

Abstract. This paper is an introductory tutorial for numerical trajectory optimization with a focus on direct collocation methods. These methods are relatively simple to understand and effectively solve a wide variety of trajectory optimization problems. Throughout the paper we illustrate each new set of concepts by working through a sequence of four example problems. We start by using trapezoidal collocation to solve a simple one-dimensional toy problem and work up to using Hermite-Simpson collocation to compute the optimal gait for a bipedal walking robot. Along the way, we cover basic debugging strategies and guidelines for posing well-behaved optimization problems. The paper concludes with a short overview of other methods for trajectory optimization. We also provide an electronic supplement that contains well-documented MATLAB code for all examples and methods presented. Our primary goal is to provide the reader with the resources necessary to understand and successfully implement their own direct collocation methods.

Joint optimization of transmission and propulsion in aerial communication networks

“…We observe that U a1 transmits only within a certain proximity of the static destination node, and more power is allocated for transmission when it is closer to the destination. If instead we allow U a1 to have a free trajectory then the jointly optimal transmission and mobility profiles of U a1 2 Transcription involves conversion of the original continuous time optimal control problem into a nonlinear program [36]. Various transcription methods exist, with the appropriate one often depending on characteristics of the problem.…”

Dynamic fluence map sequencing using piecewise linear leaf position functions

“…There is a fundamental trade-off in polynomial splines: for a given amount of data you can store many low-order segments or few high-order segments. Selecting the correct trade-off is discussed in detail in [21], [13], [22].…”

OpenSim Moco: Musculoskeletal optimal control

“…Most musculoskeletal simulation problems are naturally posed as optimal control problems: we seek a system's parameters and time-varying controls that minimize a cost (e.g., energy consumption) subject to the dynamics of the system, expressed as differential-algebraic equations. An increasingly popular method for solving optimal control problems is to approximate the system's states and controls as polynomial splines and solve for the knot points that lead the spline to obey the system's dynamics [17][18][19][20]. The dynamics are enforced by requiring the time derivative of the state splines to match the derivative from the system's differential equations at specified time points.…”