An Inverse Optimal Control Approach for Trajectory Prediction of Autonomous Race Cars

This paper proposes an optimization-based approach to predict trajectories of autonomous race cars. We assume that the observed trajectory is the result of an optimization problem that trades off path progress against acceleration and jerk smoothness, and which is restricted by constraints. The algorithm predicts a trajectory by solving a parameterized nonlinear program (NLP) which contains path progress and smoothness in cost terms. By observing the actual motion of a vehicle, the parameters of prediction are updated by means of solving an inverse optimal control problem that contains the parameters of the predicting NLP as optimization variables. The algorithm therefore learns to predict the observed vehicle trajectory in a least-squares relation to measurement data and to the presumed structure of the predicting NLP. This work contributes with an algorithm that allows for accurate and interpretable predictions with sparse data. The algorithm is implemented on embedded hardware in an autonomous real-world race car that is competing in the challenge Roborace and analyzed with respect to recorded data.

[1]  Moritz Diehl,et al.  Mixed-integer optimization-based planning for autonomous racing with obstacles and rewards , 2021, IFAC-PapersOnLine.

[2]  Moritz Diehl,et al.  Parameterization Approach of the Frenet Transformation for Model Predictive Control of Autonomous Vehicles , 2021, 2021 European Control Conference (ECC).

[3]  Rodolfo Oliveira,et al.  Vehicle Trajectory Prediction based on LSTM Recurrent Neural Networks , 2021, 2021 IEEE 93rd Vehicular Technology Conference (VTC2021-Spring).

[4]  Nicola Forti,et al.  Deep Learning Methods for Vessel Trajectory Prediction Based on Recurrent Neural Networks , 2021, IEEE Transactions on Aerospace and Electronic Systems.

[5]  Mac Schwager,et al.  LUCIDGames: Online Unscented Inverse Dynamic Games for Adaptive Trajectory Prediction and Planning , 2020, IEEE Robotics and Automation Letters.

[6]  M. Diehl,et al.  acados—a modular open-source framework for fast embedded optimal control , 2019, Mathematical Programming Computation.

[7]  Stephen P. Boyd,et al.  Differentiable Convex Optimization Layers , 2019, NeurIPS.

[8]  Simon Le Cleac'h,et al.  ALGAMES: A Fast Solver for Constrained Dynamic Games , 2019, Robotics: Science and Systems.

[9]  M. Gavrilescu,et al.  A Review of Tracking, Prediction and Decision Making Methods for Autonomous Driving , 2019, Mathematics.

[10]  Mario Zanon,et al.  Data-Driven Economic NMPC Using Reinforcement Learning , 2019, IEEE Transactions on Automatic Control.

[11]  Vincent Aravantinos,et al.  The Simpler the Better: Constant Velocity for Pedestrian Motion Prediction , 2019, ArXiv.

[12]  Melanie N. Zeilinger,et al.  Predictive Modeling by Infinite-Horizon Constrained Inverse Optimal Control with Application to a Human Manipulation Task , 2018, ArXiv.

[13]  Brendan Tran Morris,et al.  Convolutional Neural Networkfor Trajectory Prediction , 2018, ECCV Workshops.

[14]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.

[15]  Melanie N. Zeilinger,et al.  Convex Formulations and Algebraic Solutions for Linear Quadratic Inverse Optimal Control Problems , 2018, 2018 European Control Conference (ECC).

[16]  Stephen P. Boyd,et al.  OSQP: an operator splitting solver for quadratic programs , 2017, Mathematical Programming Computation.

[17]  Kalyanmoy Deb,et al.  A Review on Bilevel Optimization: From Classical to Evolutionary Approaches and Applications , 2017, IEEE Transactions on Evolutionary Computation.

[18]  Jean-Paul Laumond,et al.  From human to humanoid locomotion—an inverse optimal control approach , 2010, Auton. Robots.

[19]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[20]  P. Tsiotras,et al.  Optimal velocity profile generation for given acceleration limits: theoretical analysis , 2005, Proceedings of the 2005, American Control Conference, 2005..

[21]  Robert X. Gao,et al.  Recurrent neural network for motion trajectory prediction in human-robot collaborative assembly , 2020 .