Real-Time Velocity Optimization for Energy-Efficient Control of Connected and Automated Vehicles
Abstract This paper presents a fast numerical algorithm for velocity optimization based on the Pontryagin' minimum principle (PMP). Considering the difficulties in the application of the PMP when state constraints exist, the penalty function approach is proposed to convert the state-constrained problem into an unconstrained one. Then this paper proposes an iterative numerical algorithm by using the explicit solution to find the optimal solution. The proposed numerical algorithm is applied to the velocity trajectory optimization for energy-efficient control of connected and automated vehicles (CAVs). Simulation results indicate that the algorithm can generate the optimal inputs in milliseconds, and a significant improvement in computational efficiency compared with traditional methods (a few seconds). Hardware in the Loop test for experimental validation is given to further verify the real-time performance of the proposed algorithm.