1: \begin{abstract}

2: Orthogonal collocation methods are direct simultaneous approaches for solving optimal control problems (OCP). A high solution accuracy is achieved with few optimization variables, making it more favorable for embedded and real-time NMPC applications. However, collocation approaches lack a guarantee about the safety of the resulting continuous trajectory as inequality constraints are only set on a finite number of collocation points. In this paper we propose a method to efficiently create a convex safety envelope containing the full trajectory such that the solution fully satisfies the OCP constraints. We make use of the Bernstein approximations of a polynomial’s extrema and span the solution over an orthogonal basis using the Legendre polynomials. The tightness of the safety envelope estimation, high spectral accuracy of the method in solving the underlying differential equations, fast rate of convergence and little conservatism are properties of the presented approach making it a suitable method for safe real-time NMPC deployment.  We show that our method has comparable computational performance to the pseudospectral approaches and can approximate the original OCP more accurately and up to 9 times more quickly than standard multiple-shooting methods in autonomous driving applications, without adding complexity to the formulation.

3: \end{abstract}

4: