Multi-vehicle Formation Switching Trajectory Planning Based on Bézier Curve and Multi-objective Optimization Method

doi:10.3901/JME.2024.16.270

Abstract

Abstract: A new trajectory planning method for multi-vehicle formation switching based on Bessel curve and multi-objective optimization is proposed. The trajectory planning problem is divided into two parts: trajectory shape planning and velocity planning. Based on collision avoidance safety, track smoothness and shortest path length rules, a multi-objective optimization method is used to score the track group, so as to select the optimal switching track that meets the formation switching process. The results show that the selected formation switching trajectory group can satisfy the state constraint, curvature continuous bounded constraint, speed continuous constraint, no collision risk constraint, ride comfort constraint and shortest path constraint, and is suitable for actual vehicle running without large trajectory deviation or excessive acceleration and deceleration.

Key words: trajectory planning, multi-vehicle formation, multi-objective optimization, Bézier curve

CLC Number:

TG242

WANG Hongliang, YONG Jianyu, PI Dawei, XIE Boyuan, WANG Erlie, WANG Xianhui. Multi-vehicle Formation Switching Trajectory Planning Based on Bézier Curve and Multi-objective Optimization Method[J]. Journal of Mechanical Engineering, 2024, 60(16): 270-279.

References

[1] 王友发. 面向智能制造的多机器人系统任务分配研究[M]. 镇江:江苏大学出版社,2016. WANG Youfa. Research on task assignment of multi-robot system for intelligent manufacturing[M]. Zhenjiang:Jiangsu University Press,2016.
[2] 段书用,王启帆,韩旭,等. 具有确保安全距离的A^* 路径优化方法[J]. 机械工程学报,2020,56(18):205-215. DUAN Shuyong,WANG Qifan,HAN Xu,et al. A^* path optimization method to ensure safe distance is provided[J]. Journal of Mechanical Engineering,2020,56(18):205-215.
[3] 李善寿,方潜生,肖本贤,等. 全局路径规划中基于改进可视图法的环境建模[J]. 华东交通大学学报,2008,25(6):73-77. LI Shanshou,FANG Qiansheng,XIAO Benxian,et al. Environment modeling based on improved viewable method in global path planning[J]. Journal of East China Jiaotong University,2008,25(6):73-77.
[4] 孔迎盈. 机器人路径规划算法的研究[D]. 上海:复旦大学,2012. KONG Yingying. Research on robot path planning algorithm[D]. Shanghai:Fudan University,2012.
[5] 陈骏岭,秦小麟,李星罗,等. 基于人工势场法的多机器人协同避障[J]. 计算机科学,2020,47(11):220-225. CHEN Junling,QIN Xiaolin,LI Xingluo,et al. Multi-robot cooperative obstacle avoidance based on artificial potential field method[J]. Computer Science,2020,47(11):220-225.
[6] 陈超. 基于预测模型的动态多目标优化算法研究[D]. 长沙:湖南大学,2012. CHEN Chao. Research on dynamic multi-objective optimization algorithm based on prediction model[D]. Changsha:Hunan University,2012.
[7] 陈成,何玉庆,卜春光,等. 基于四阶贝塞尔曲线的无人车可行轨迹规划[J]. 自动化学报,2015,41(3):1-11. CHEN Cheng,HE Yuqing,PU Chunguang,et al. Feasible trajectory planning for unmanned vehicle based on fourth-order Bezier curve[J]. Acta Automatic Sinica,2015,41(3):1-11.
[8] JOLLY K G, KUMAR R S, VIJAYAKUMAR R. A Bezier curve based path planning in a multi-agent robot soccer system without violating the acceleration limits[J]. Robotics & Autonomous Systems,2009,57(1):23-33.
[9] CHOI J,CURRY R,ELKAIM G. Path planning based on bézier curve for autonomous ground vehicles[C]//Advances in Electrical and Electronics Engineering-IAENG Special Edition of the World Congress on Engineering and Computer Science 2008. IEEE,2008:158-166.
[10] 杨剑. 群机器人队形控制及协同搜索方法研究[D]. 哈尔滨:哈尔滨工业大学,2018. YANG Jian. Study on formation control and cooperative search method of swarm robots[D]. Harbin:Harbin Institute of Technology,2018.
[11] HUNG S M,GIVIGI S N. A Q-learning approach to flocking with UAVs in a stochastic environment[J]. IEEE transactions on cybernetics,2016,47(1):186-197.
[12] DAI Y,LEE S G. Formation control of mobile robots with obstacle avoidance based on GOACM using onboard sensors[J]. International Journal of Control,Automation and Systems,2014,12(5):1077-1089.
[13] 罗京,刘成林,刘飞. 多移动机器人的领航-跟随编队避障控制[J]. 智能系统学报,2017,12(2):202-212. LUO Jing,LIU Chenglin,LIU Fei. Obstacle avoidance control for piloting and following formation of multi-mobile robots[J]. CAAI Transactions on Intelligent Systems,2017,12(2):202-212.
[14] ASKARI A,MORTAZAVI M,TALEBI H. UAV formation control via the virtual structure approach[J]. Journal of Aerospace Engineering,2013,28(1):04014047.
[15] ZHENG Y,LI B,AN D,et al. A multi-agent path planning algorithm based on hierarchical reinforcement learning and artificial potential field[C]//201511th International Conference on Natural Computation (ICNC). IEEE,2015:363-369.
[16] AILON A,ZOHAR I,GUTERMAN H. Trajectory tracking and formation controls for a UAV model that incorporates dynamic effects[C]//20162nd International Conference on Control,Automation and Robotics (ICCAR). IEEE,2016:219-224.
[17] BAYINDIR L,SAHIN E. Modeling self-organized aggregation in swarm robotic system[C]//The IEEE Swarm Intelligence Symposium,2009:88-95.
[18] 吴孔逸,霍伟. 不确定移动机器人编队间接自适应模糊动力学控制[J]. 控制与决策,2010,25(12):1771-1781. WU Kongyi,HUO Wei. Indirect adaptive fuzzy dynamics control for formation of uncertain mobile robots[J]. Control and Decision,2010,25(12):1771-1781.
[19] 杨甜甜,刘志远,陈虹,等. 移动机器人编队控制的现状与问题[J]. 智能系统学报,2007,2(4):21-27. YANG Tiantian,LIU Zhiyuan,CHEN Hong,et al. Status and problems of formation control for mobile robots[J]. CAAI Transactions on Intelligent Systems,2007,2(4):21-27.
[20] 龚建伟,姜岩,徐威. 无人驾驶车辆模型预测控制[M]. 北京:北京理工大学出版社,2014. GONG Jianwei,JIANG Yan,XU Wei. Model predictive control for autonomous vehicles[M]. Beijing:Beijing Institute of Technology Press,2014.