基于改进人工势场法的汽车弯道超车路径规划与跟踪控制

doi:10.19562/j.chinasae.qcgc.2021.04.012

摘要/Abstract

摘要：

本文中针对无人驾驶汽车弯道超车工况，提出一种基于改进人工势场法的汽车弯道超车路径规划算法，以及一种基于线性鲁棒控制理论的汽车弯道超车路径跟踪最优保性能控制策略。首先，分别基于螺旋下降函数、斜坡正弦函数和指数函数构建弯道引力势能场、同车道行驶较慢车辆斥力势能场和弯道边界斥力势能场，三者构成汽车弯道超车路径的搜索空间。随后，设计一种可应用于动态环境的增量搜索算法，逐步搜索汽车弯道超车路径搜索空间的最快下降方向，进而规划出汽车弯道超车路径。为执行规划出的汽车弯道超车路径，以线性2自由度汽车动力学模型为基础建立包含参数摄动的汽车弯道超车路径跟踪误差动态模型，并基于线性鲁棒控制法设计汽车弯道超车路径跟踪最优保性能控制策略。最后，仿真验证所提出的汽车弯道超车路径规划算法和路径跟踪最优保性能控制策略的可行性和有效性，结果表明：所提出的路径规划算法和跟踪控制策略可安全、舒适地引导汽车完成弯道超车工况。

关键词: 路径规划与跟踪控制, 改进人工势场法, 增量搜索算法, 鲁棒控制, 最优保性能控制

Abstract:

A path planning algorithm based on the modified artificial potential field method and a path tracking optimal guaranteed cost control strategy based on the linear robust control theory for overtaking maneuver of autonomous vehicle on curved road are proposed in this paper. Firstly， the attractive potential field on curve， the repulsive potential field of the leading vehicle with lower speed on the same lane and the repulsive potential fields of curve boundary are built based on the spiral descent function， the slope sine function and the exponential function ，respectively， which form the search space of overtaking path on curve. Then， an incremental search algorithm， which can be applied to dynamic circumstance， is designed to search the fastest descent direction in search space for overtaking path on curve step by step， and the planned overtaking path on curve is obtained. In order to implement the planned path on curve， an overtaking path tracking error dynamic model for curve with parameter perturbation is established based on the 2-DOF linear vehicle dynamics model， and a path tracking optimal guaranteed cost control strategy for overtaking on curve is designed based on the linear robust control theory. Finally， a simulation is performed to verify the feasibility and effectiveness of the path planning algorithm and path tracking optimal guaranteed cost control strategy and the results show that the path planning algorithm and path tracking control strategy proposed can guide the vehicle to complete the overtaking maneuver on curve safely and comfortably.

Key words: path planning and tracking control, modified artificial potential field method, incremental search algorithm, robust control, optimal guaranteed cost control

张家旭,王晨,赵健. 基于改进人工势场法的汽车弯道超车路径规划与跟踪控制[J]. 汽车工程, 2021, 43(4): 546-552.

Jiaxu Zhang,Chen Wang,Jian Zhao. Path Planning and Tracking Control for Vehicle Overtaking on Curve Based on Modified Artificial Potential Field Method[J]. Automotive Engineering, 2021, 43(4): 546-552.

图/表 8

图 1

图 2

图 3

图 4

图 5

图 6

图 7

图 8

参考文献 16

1	张荣辉，游峰，初鑫男，等. 车-车协同下无人驾驶车辆的换道汇入控制方法［J］. 中国公路学报， 2018， 31（4）： 180-191.
	ZHANG R H， YOU F， CHU X N， et al. Lane change merging control method for unmanned vehicle under V2X cooperative environment［J］. China Journal of Highway and Transport， 2018， 31（4）： 180-191.
2	张家旭，张振兆，赵健，等. 采用极点配置的自动驾驶汽车换道路径规划与跟踪控制［J］. 西安交通大学学报， 2020， 54（10）： 170-177.
	ZHANG J X， ZHANG Z Z， ZHAO J， et al. A path planning and tracking control method for lane changing of autonomous vehicle using pole assignment［J］. Journal of Xi’an Jiaotong University， 2020， 54（10）： 170-177.
3	罗鹰，冒兴蜂. 智能汽车换道避障路径规划与跟踪控制研究［J］.机械设计与制造， 2019， 2019（7）： 139-143.
	LUO Y， MAO X F. Study on path planning and tracking control of intelligent vehicle obstacle avoidance by changing lanes［J］. Machinery Design and Manufacture， 2019， 2019（7）： 139-143.
4	杭鹏，陈辛波，张榜，等. 四轮独立转向-独立驱动电动车主动避障路径规划与跟踪控制［J］. 汽车工程， 2019， 41（2）： 170-176.
	HANG P， CHEN X B， ZHANG B， et al. Path planning and tracking control for collision avoidance of a 4WIS⁃4WID electric vehicle［J］. Automotive Engineering， 2019， 41（2）： 170-176.
5	LI X H， SUN Z P， LIU D X， et al. Combining local trajectory planning and tracking control for autonomous ground vehicles navigating along a reference path［C］. IEEE 17th International Conference on Intelligent Transportation Systems， Qingdao， China， 2014.
6	WANG Y N， QU T， CHU J X， et al. Trajectory planning and tracking control of vehicle obstacle avoidance based on optimization control［C］. Proceedings of the 38th Chinese Control Conference， Guangzhou， China， 2019.
7	GUO L， GE P S， YUE M， et al. Lane changing trajectory planning and tracking controller design for intelligent vehicle running on curved road［J］. Mathematical Problems in Engineering， 2014， 2014： 1-9.
8	XU Z J， ZHAO W Z， WANG C Y， et al. Local path planning and tracking control of vehicle collision avoidance system［J］. Transactions of Nanjing University of Aeronautics and Astronautics， 2018， 35（4）： 729-738.
9	LI S S， LI Z， YU Z X， et al. Dynamic trajectory planning and tracking for autonomous vehicle with obstacle avoidance based on model predictive control［J］. IEEE Access， 2019， 7： 132074-132086.
10	SHIM T， ADIREDDY G， YUAN H L. Autonomous vehicle collision avoidance system using path planning and model⁃predictive-control⁃based active front steering and wheel torque control［J］. Proceedings of the Institution of Mechanical Engineers， Part D： Journal of Automobile Engineering， 2012， 226（6）： 767-778.
11	BACHMANN E R， HODGSON E， HOFFBAUER C， et al. Multi⁃user redirected walking and resetting using artificial potential fields［J］. IEEE Transactions on Visualization and Computer Graphics， 2019， 25（5）： 2022-2031.
12	王健. 汽车在两种转向工况下的路径规划与路径跟踪研究［D］. 南京：南京航空航天大学， 2015.
	WANG J. Research on path planning and path tracking for automobile in two steering conditions［D］. Nanjing： Nanjing University of Aeronautics and Astronautics， 2015.
13	KIENCKE U， NIELSEN L. Automotive control systems［M］. Berlin： Springer， 2000.
14	AMATO F. Robust control of linear systems subject to uncertain time⁃varying parameters［M］. Berlin： Springer， 2006.
15	俞立. 鲁棒控制-线性矩阵不等式处理方法［M］. 北京：清华大学出版社， 2002.
	YU L. Robust control⁃linear matrix inequality approach［M］. Beijing： Tsinghua University Press， 2002.
16	THRUN S， MONTEMERLO M， DAHLKAMP H， et al. Stanley： the robot that won the DARPA grand challenge［J］. Journal of Field Robotics， 2006： 661-692.

[1]	吴其林,林育明,崔峥嵘,赵晓敏. 基于层级约束的多无人车编队包含控制[J]. 汽车工程, 2023, 45(8): 1333-1342.
[2]	张新荣,谭宇航,贾一帆,黄晋,许权宁. 四轮独立驱动电动汽车路径跟踪鲁棒控制[J]. 汽车工程, 2023, 45(2): 253-262.
[3]	赵越,胡纪滨,吴维,魏超. 无人车全轮蟹行转向稳定性鲁棒控制与试验验证[J]. 汽车工程, 2022, 44(8): 1126-1135.
[4]	赵治国, 范佳琦, 蒋蓝星, 唐旭辉, 付靖. 复合功率分流系统发动机起动H_∞鲁棒优化控制^*[J]. 汽车工程, 2020, 42(4): 417-424.
[5]	杨泽宇, 黄晋, 胡展溢, 谢国涛, 钟志华. 严格避撞的车辆队列分布式鲁棒控制^*[J]. 汽车工程, 2020, 42(10): 1312-1319.
[6]	马瑞海, 王丽芳, 张俊智, 何承坤. 基于自适应鲁棒控制的测功机动态滑移率模拟^*[J]. 汽车工程, 2020, 42(10): 1397-1403.
[7]	张亮修,吴光强,郭晓晓. 车辆自适应巡航控制系统的建模与分层控制[J]. 汽车工程, 2018, 40(5): 547-553.