Cooperative Lane-Change Motion Planning for Connected and Automated Vehicle Platoons in Multi-Lane Scenarios

Multi-vehicle motion planning (MVMP) has become an emerging paradigm in connected and automated vehicles (CAVs). The cooperative lane-change movements with the coexistence of platoons and CAVs are typical scenarios on the muti-lane roads. This paper proposes an optimal control framework with the advantages of completeness and universality for platoons and CAVs’ cooperative lane-change motion planning in different task scenarios. Two typical cooperative scenarios are designed for the subsequent study of optimal modeling. The platoons’ reconfiguration and original shape maintenance are considered to reflect the universality of moving objects and the diversity of cooperative tasks. Approximately geometric contour models, dynamic externally tangent rectangle and inflated rectangle, are utilized to describe the platoon’s profile. Analytical complete collision avoidance constraints among different motion objects are constructed effectively. Other necessary constraints and the weighted cost function that minimizes lane-change time and motion energy are comprehensively considered. The optimal control models are established for the desired scenarios. Moreover, a numerical solution method combined with the simultaneous direct collocation method based on the trapezoidal rule and the barrier function method is proposed to obtain the optimal schemes. Simulation and contrast experiments are conducted for two scenarios. The results indicate that the cost function’s weight coefficients and specific lane-change tasks influence the cooperative motion planning effects and verify that the proposed optimal control framework is of reasonability, effectiveness, and unification.

[1]  Garrett A. Warnell,et al.  Machine Learning Methods for Local Motion Planning: A Study of End-to-End vs. Parameter Learning , 2021, 2021 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR).

[2]  Rym Zalila-Wenkstern,et al.  Adaptive Reward for CAV Action Planning using Monte Carlo Tree Search , 2021, 2021 IEEE International Intelligent Transportation Systems Conference (ITSC).

[3]  Xiafu Lv,et al.  Research on Robot Global Path Planning Based on Improved A-star Ant Colony Algorithm , 2021, 2021 IEEE 5th Advanced Information Technology, Electronic and Automation Control Conference (IAEAC).

[4]  Rym Zalila-Wenkstern,et al.  Collaborative Collision Avoidance for CAVs in Unpredictable Scenarios , 2020, 2020 IEEE 3rd Connected and Automated Vehicles Symposium (CAVS).

[5]  Francesco Braghin,et al.  Attention-based Sampling Distribution for Motion Planning in Autonomous Driving , 2020, 2020 39th Chinese Control Conference (CCC).

[6]  Yuncheng Jiang,et al.  A Dynamic Motion Planning Framework for Autonomous Driving in Urban Environments , 2019, 2020 39th Chinese Control Conference (CCC).

[7]  Jing Shi,et al.  A cellular automata traffic flow model combined with a BP neural network based microscopic lane changing decision model , 2019, J. Intell. Transp. Syst..

[8]  Yimin Zhou,et al.  An Improved Probabilistic Roadmap Algorithm with Potential Field Function for Path Planning of Quadrotor , 2019, 2019 Chinese Control Conference (CCC).

[9]  Lijun Sun,et al.  Efficient Motion Planning for Automated Lane Change based on Imitation Learning and Mixed-Integer Optimization , 2019, 2020 IEEE 23rd International Conference on Intelligent Transportation Systems (ITSC).

[10]  Yue Zhang,et al.  Cooperative Lane Change Motion Planning of Connected and Automated Vehicles: A Stepwise Computational Framework , 2018, 2018 IEEE Intelligent Vehicles Symposium (IV).

[11]  Sascha Wirges,et al.  Making Bertha Cooperate–Team AnnieWAY’s Entry to the 2016 Grand Cooperative Driving Challenge , 2018, IEEE Transactions on Intelligent Transportation Systems.

[12]  Pu Li,et al.  Nonlinear programming for multi-vehicle motion planning with homotopy initialization strategies , 2017, 2017 13th IEEE Conference on Automation Science and Engineering (CASE).

[13]  Kaan Ozbay,et al.  Developments in connected and automated vehicles , 2017, J. Intell. Transp. Syst..

[14]  Hossein Nourkhiz Mahjoub,et al.  Utilizing Model-Based Communication and Control for Cooperative Automated Vehicle Applications , 2017, IEEE Transactions on Intelligent Vehicles.

[15]  Youmin Zhang,et al.  Simultaneous versus joint computing: A case study of multi-vehicle parking motion planning , 2017, J. Comput. Sci..

[16]  Hong Liu,et al.  Centralized and optimal motion planning for large-scale AGV systems: A generic approach , 2017, Adv. Eng. Softw..

[17]  Daniel Axehill,et al.  Combining Homotopy Methods and Numerical Optimal Control to Solve Motion Planning Problems , 2017, 2018 IEEE Intelligent Vehicles Symposium (IV).

[18]  Pankoo Kim,et al.  A Green Ant-Based method for Path Planning of Unmanned Ground Vehicles , 2017, IEEE Access.

[19]  Alberto Bemporad,et al.  Multi-automated vehicle coordination using decoupled prioritized path planning for multi-lane one- and bi-directional traffic flow control , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[20]  Karsten Lemmer,et al.  Cooperative Maneuver Planning for Cooperative Driving , 2016, IEEE Intelligent Transportation Systems Magazine.

[21]  Baher Abdulhai,et al.  Assessing the Potential Impacts of Connected Vehicles: Mobility, Environmental, and Safety Perspectives , 2016, J. Intell. Transp. Syst..

[22]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[23]  Christos Katrakazas,et al.  Real-time motion planning methods for autonomous on-road driving: State-of-the-art and future research directions , 2015 .

[24]  Lie Guo,et al.  Trajectory planning and tracking control for autonomous lane change maneuver based on the cooperative vehicle infrastructure system , 2015, Expert Syst. Appl..

[25]  Kevin Heaslip,et al.  Minimizing the Disruption of Traffic Flow of Automated Vehicles During Lane Changes , 2015, IEEE Transactions on Intelligent Transportation Systems.

[26]  Mo Chen,et al.  Safe sequential path planning of multi-vehicle systems via double-obstacle Hamilton-Jacobi-Isaacs variational inequality , 2014, 2015 European Control Conference (ECC).

[27]  Shuang Liu,et al.  A dynamic priority based path planning for cooperation of multiple mobile robots in formation forming , 2014 .

[28]  Moshe Kam,et al.  Mathematical programming for Multi-Vehicle Motion Planning problems , 2012, 2012 IEEE International Conference on Robotics and Automation.

[29]  Mohamed Achache,et al.  Complexity analysis and numerical implementation of a short-step primal-dual algorithm for linear complementarity problems , 2010, Appl. Math. Comput..

[30]  Daniel D. Lee,et al.  Little Ben: The Ben Franklin Racing Team's entry in the 2007 DARPA Urban Challenge , 2008, J. Field Robotics.

[31]  Peter King,et al.  Odin: Team VictorTango's entry in the DARPA Urban Challenge , 2008, J. Field Robotics.

[32]  F. Borrelli,et al.  MILP and NLP Techniques for centralized trajectory planning of multiple unmanned air vehicles , 2006, 2006 American Control Conference.

[33]  Florent Lamiraux,et al.  Kinodynamic motion planning: connecting exploration trees using trajectory optimization Methods , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[34]  Jonathan P. How,et al.  Aircraft trajectory planning with collision avoidance using mixed integer linear programming , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[35]  Takashi Tsuchiya,et al.  Polynomial Convergence of a New Family of Primal-Dual Algorithms for Semidefinite Programming , 1999, SIAM J. Optim..

[36]  C. Roos,et al.  A potential-reduction variant of Renegar's short-step path-following method for linear programming , 1991 .

[37]  Xiong Hu,et al.  Geometric A-Star Algorithm: An Improved A-Star Algorithm for AGV Path Planning in a Port Environment , 2021, IEEE Access.

[38]  Jingwei Song,et al.  Trajectory Planning in Joint Space for a Pointing Mechanism Based on a Novel Hybrid Interpolation Algorithm and NSGA-II Algorithm , 2020, IEEE Access.

[39]  Ece Guran Schmidt,et al.  Lane Change Scheduling for Autonomous Vehicles , 2016 .

[40]  Kun Cao,et al.  A dynamic automated lane change maneuver based on vehicle-to-vehicle communication , 2016 .

[41]  Xinmin Wang,et al.  3-D online route planning for UAVs based on an improved PRM , 2013, IEEE Conference Anthology.

[42]  Bérénice Mettler,et al.  Survey of Motion Planning Literature in the Presence of Uncertainty: Considerations for UAV Guidance , 2012, J. Intell. Robotic Syst..

[43]  John R. Hauser,et al.  Cooperative Motion Planning for Multiple Autonomous Marine Vehicles , 2012 .

[44]  Kurt M. Anstreicher,et al.  Linear Programming: Interior Point Methods , 2009, Encyclopedia of Optimization.

[45]  Michael J. Todd,et al.  Path-Following Methods , 2000 .