This paper presents a computational framework to efficiently generate feasible and safe trajectories for multiple autonomous vehicle operations. We formulate the optimal motion planning problem as a continuous-time optimal control problem, and approximate its solutions in a discretized setting using Bernstein polynomials. The latter possess convenient properties that allow to efficiently compute and enforce constraints along the vehicles trajectories, such as maximum speed and angular rates, minimum distance between trajectories and between the vehicles and known obstacles, etc. Thus, the proposed method is particularly suitable for generating trajectories in real-time for safe operations in complex environments and multiple vehicle missions. We show, using a rigorous mathematical framework, that the solution to the discretized optimal motion planning problem converges to that of the continuous-time one. The advantages of the proposed method are investigated through numerical examples.
This letter presents a computational framework to efficiently generate feasible and optimal trajectories for differentially flat autonomous vehicle systems. We formulate the optimal motion planning problem as a continuous-time optimal control problem, and approximate it by a discrete-time formulation using Bernstein polynomials. These polynomials allow for efficient computation of various constraints along the entire trajectory, and are particularly convenient for generating trajectories for safe operation of multiple vehicles in complex environments. The advantages of the proposed method are investigated through theoretical analysis and numerical examples.
This paper presents a method for the generation of trajectories for autonomous system operations. The proposed method is based on the use of Bernstein polynomial approximations to transcribe infinite dimensional optimization problems into nonlinear programming problems. These, in turn, can be solved using off-the-shelf optimization solvers. The main motivation for this approach is that Bernstein polynomials possess favorable geometric properties and yield computationally efficient algorithms that enable a trajectory planner to efficiently evaluate and enforce constraints along the vehicles’ trajectories, including maximum speed and angular rates as well as minimum distance between trajectories and between the vehicles and obstacles. By virtue of these properties and algorithms, feasibility and safety constraints typically imposed on autonomous vehicle operations can be enforced and guaranteed independently of the order of the polynomials. To support the use of the proposed method we introduce BeBOT (Bernstein/Bézier Optimal Trajectories), an open-source toolbox that implements the operations and algorithms for Bernstein polynomials. We show that BeBOT can be used to efficiently generate feasible and collision-free trajectories for single and multiple vehicles, and can be deployed for real-time safety critical applications in complex environments.
In this paper, we propose a set of guidelines to select a solver for the solution of nonlinear programming problems. We conduct a comparative analysis of the convergence performances of commonly used solvers for both unconstrained and constrained nonlinear programming problems. The comparison metrics involve accuracy, convergence rate, and computational time. MATLAB is chosen as the implementation platform due to its widespread adoption in academia and industry. Our study includes solvers which are either freely available or require a license, or are extensively documented in the literature. Moreover, we differentiate solvers if they allow the selection of different optimal search methods. We assess the performance of 24 algorithms on a set of 60 benchmark problems. We also evaluate the capability of each solver to tackle two large-scale UAV optimal path planning scenarios, specifically the 3D minimum time problem for UAV landing and the 3D minimum time problem for UAV formation flying. To enrich our analysis, we discuss the effects of each solver’s inner settings on accuracy, convergence rate, and computational time.