适用全速域大曲率路径的自动驾驶跟踪算法
Autonomous vehicle tracking algorithm for high curvature path in full speed range
- 2021年26卷第1期 页码:135-142
收稿日期:2020-07-31,
修回日期:2020-10-27,
录用日期:2020-11-3,
纸质出版日期:2021-01-16
DOI: 10.11834/jig.200435
移动端阅览

浏览全部资源
扫码关注微信
收稿日期:2020-07-31,
修回日期:2020-10-27,
录用日期:2020-11-3,
纸质出版日期:2021-01-16
移动端阅览
目的
2
路径跟踪是自动驾驶汽车根据感知、决策和规划结果正确沿道路行驶的关键部分。目前路径跟踪算法难以在全速域、复杂路径场景和高自由度动力学模型下取得优异的性能,并且未考虑与纵向控制的耦合特性,限制了控制算法的跟踪性能。针对以上问题,提出了一种基于速度自适应预瞄的无模型转向控制算法。方法根据车辆与跟踪路径的横向偏差与角度偏差,建立车辆方向盘输出控制量方程,该方法实现了在动力学高度复杂情况和跟踪路径可导情况下的低速稳定跟踪。同时根据车辆纵向速度自适应设置跟踪预瞄距离,并将速度耦合参数加入方程,实现了车辆全速域、全路径的稳定跟踪。
结果
2
本文在PanoSim自动驾驶仿真系统和Simulink仿真软件进行仿真实验,在高自由度动力学模型下,本文算法实现在超高速(
>
220 km/h)直线及小曲率跟踪路径中横向偏差变化量
Δ
d
的模Δ
d
<
0.1 m、在高速(
>
150 km/h)大曲率弯道跟踪路径中Δ
d
<
0.3 m的性能。
结论
2
本文提出的基于速度自适应预瞄的无模型转向控制算法可以实现全速域、大曲率的路径稳定跟踪。
Objective
2
Path tracking is the key part of an automatic driving vehicle running along a road according to the perception system and decision system results. The control module involved in path tracking is the lowest-level software algorithm module of autopilot
which includes two parts: lateral control and longitudinal control. Steering control is mainly responsible for vehicle steering output control
and longitudinal control is mainly responsible for throttle and brake control. The steering control algorithm tracks and controls the path of the two upper frameworks on the basis of perception and decision
and it optimizes the tracking error to ensure the stability and comfort of the self-driving vehicle. Current tracking algorithms mainly include model-free lateral control algorithm and model-based lateral control algorithm. The representative of model free lateral control algorithm is proportion integration differentiation (PID) control. The PID algorithm is difficult to use in controlling automatic driving vehicles without considering the physical characteristics of the vehicle and in high-speed and complex environments. The model-based lateral control algorithm includes the lateral control algorithm based on vehicle kinematics model and the lateral dynamics algorithm based on vehicle dynamic model. The former is represented by the Stanley method based on front-wheel feedback and rear-wheel control based on rear-wheel feedback. The latter is represented by the lateral control algorithm of linear quadratic regulator based on the dynamic model. Algorithms based on the vehicle model need to accurately model the kinematic or dynamic characteristics of the vehicle and usually need to simplify the model to predict the state of vehicle tracking deviation by simplifying the modeling of the model. This approach thus achieves accurate control of the vehicle. In addition
these two lateral control algorithms do not consider the coupling characteristics with longitudinal control
which limits the tracking performance of the control algorithm. To address the problems of high-complexity vehicle model and current path tracking algorithm
this paper proposes a model free-steering control algorithm based on speed-adaptive preview.
Method
2
In the face of highly complex or unknown dynamic performance of the vehicle dynamics model
accurately calculating the state equation of vehicle path tracking deviation through dynamic characteristics is impossible. However
due to the complex dynamic characteristics
the control quantity obtained through kinematic characteristics will cause many errors
especially in the case of high-speed driving
large curvature
and nondifferentiable path. The cumulative error of these two methods may lead to a self-driving car going out of control. Therefore
the model-free control method can achieve stable and accurate path tracking performance in the full speed range under complex dynamic conditions. Considering the stable tracking in scenes with non-conductance and large curvature
this paper uses the speed-adaptive preview method to enhance the stability of autopilot under complex road conditions. According to the intelligent driving vehicle model studied in this paper
the control input includes the lateral distance difference between the vehicle and the tracking path
the angle between the vehicle and the tracking path
and the coupling parameters of the longitudinal speed of the vehicle. The output of the control algorithm includes the steering wheel angle
the throttle opening
and the brake master cylinder pressure. The former mainly controls the direction of the vehicle
while the latter controls the forward speed. In this paper
the output control equation of vehicle steering control is established first according to the deviation distance and angle between the vehicle and the tracking path. This method realizes stable tracking at low speed under the condition of highly complex dynamics and differentiable tracking path. At the same time
the tracking preview distance is set adaptively according to the vehicle longitudinal speed
and the speed coupling parameters are added to the equation to realize the stable tracking of the vehicle in the full speed range and all types of paths.
Result
2
To verify the proposed path tracking algorithm based on speed-adaptive preview
we participated in the 2020 China Intelligent Vehicle Championship and World Intelligent Driving Challenge online simulation competitions. In this experiment and competition
PanoSim automatic driving simulation system and Simulink simulation software
are used for the simulation experiment. The test road is a 10 km test freeway provided by Panosim
and it includes five sections with large curvature and five sections with small curvature. In this paper
we select a typical section of the small curvature section and large curvature section to test the algorithm. Under the dynamic model with a high-degree-of-freedom dynamic model
the proposed algorithm can achieve the performance of lateral deviation |Δ
d
|
<
0.1 m on the ultra-high speed (
>
220 km/h) straight-line
and small-curvature tracking path
and |Δ
d
|
<
0.3 m on the high-speed (
>
150 km/h) high-curvature curve tracking path.
Conclusion
2
In this paper
the path tracking algorithm based on speed preview is proposed
and the model free lateral control algorithm is studied to realize the control coverage from a simple to a complex vehicle model; the optimization of vehicle lateral control by a speed coupler is studied to realize the full speed range control coverage of the vehicle; and the controller based on speed-adaptive preview is studied to realize the transition from the differentiable path to the nondifferentiable path. To some extent
the problem of control hysteresis and overshoot is solved.
Chen H Y, Chen S P and Gong J W. 2017. A review on the research of lateral control for intelligent vehicles. Acta Armamentarii, 38(6):1203-1214
陈慧岩, 陈舒平, 龚建伟. 2017.智能汽车横向控制方法研究综述.兵工学报, 38(6):1203-1214)[DOI:10.3969/j.issn.1000-1093.2017.06.021]
de Wit C C, Olsson H, Astrom K J and Lischinsky P. 1995. A new model for control of systems with friction. IEEE Transactions on Automatic Control, 40(3):419-425[DOI:10.1109/9.376053]
Guan Q Z, Bao H and Xuan Z X. 2017. The research of prediction model on intelligent vehicle based on driver's perception. Cluster Computing, 20(4):2967-2979[DOI:10.1007/s10586-017-0946-9]
Hu C, Jing H, Wang R R, Yan F J and Chadli M. 2015. Robust H ∞ output-feedback control for path following of autonomous ground vehicles. Mechanical Systems and Signal Processing, 70-71:414-427[DOI:10.1016/j.ymssp.2015.09.017 ] .
Hu C, Wang R R, Yan F J and Chen N. 2016. Output constraint control on path following of four-wheel independently actuated autonomous ground vehicles. IEEE Transactions on Vehicular Technology, 65(6):4033-4043[DOI:10.1109/TVT.2015.2472975]
Hu P, Guo J H, Li L H and Wang R B. 2011. Study on coordinated longitudinal and lateral control of intelligent vehicles using backstepping variable control. Electric Machines and Control, 15(10):88-94
胡平, 郭景华, 李琳辉, 王荣本. 2011.智能车辆纵横向反演变结构协调控制.电机与控制学报, 15(10):88-94)[DOI:10.3969/j.issn.1007-449X.2011.10.014]
Kayacan E, Ramon H and Saeys W. 2016. Robust trajectory tracking error model-based predictive control for unmanned ground vehicles. IEEE/ASME Transactions on Mechatronics, 21(2):806-814[DOI:10.1109/TMECH.2015.2492984]
Kong J, Pfeiffer M, Schildbach G and Borrelli F. 2015. Kinematic and dynamic vehicle models for autonomous driving control design//2015 IEEE Intelligent Vehicles Symposium. Seoul, South Korea: IEEE: 1094-1099[ DOI:10.1109/IVS.2015.7225830 http://dx.doi.org/10.1109/IVS.2015.7225830 ]
Li B. 2010. Study on Lateral Dynamics Control of Four Wheels Active Steering Vehicle. Shanghai: Shanghai Jiao Tong University
李彬. 2010.四轮主动转向车辆的侧向动力学控制研究.上海: 上海交通大学
Li L and Wang F Y. 2007. Advanced Motion Control and Sensing for Intelligent Vehicles. New York:Springer[DOI:10.1007/978-0-387-44409-3]
Li L, Lu Y S, Wang R R and Chen J. 2017. A three-dimensional dynamics control framework of vehicle lateral stability and rollover prevention via active braking with MPC. IEEE Transactions on Industrial Electronics, 64(6):3389-3401[DOI:10.1109/TIE.2016.2583400]
Marino R, Scalzi S and Netto M. 2011. Nested PID steering control for lane keeping in autonomous vehicles. Control Engineering Practice, 19(12):1459-1467[DOI:10.1016/j.conengprac.2011.08.005]
Paden B, Čáp M, Yong S Z, Yershov D and Frazzoli E. 2016. A survey of motion planning and control techniques for self-driving urban vehicles. IEEE Transactions on Intelligent Vehicles, 1(1):33-55[DOI:10.1109/TIV.2016.2578706]
Peng H, Hessburg T, Tomizuka M, Zhang W B, Lin Y, Devlin P, Shladover S E and Arai A. 1992. A theoretical and experimental study on vehicle lateral control//Proceedings of 1992 American Control Conference. Chicago, USA: IEEE: #4792408[ DOI:10.23919/ACC.1992.4792408 http://dx.doi.org/10.23919/ACC.1992.4792408 ]
Segel L. 1956. Theoretical prediction and experimental substantiation of the response of the automobile to steering control. Proceedings of the Institution of Mechanical Engineers:Automobile Division, 10(1):310-330[DOI:10.1243/pime_auto_1956_000_032_02]
Tagne G, Talj R and Charara A. 2016. Design and comparison of robust nonlinear controllers for the lateral dynamics of intelligent vehicles. IEEE Transactions on Intelligent Transportation Systems, 17(3):796-809[DOI:10.1109/TITS.2015.2486815]
Thrun S, Montemerlo M, Dahlkamp H, Stavens D, Aron A, Diebel J, Fong P, Gale J, Halpenny M, Hoffmann G, Lau K, Oakley C, Palatucci M, Pratt V, Stang P, Strohband S, Dupont C, Jendrossek L E, Koelen C, Markey C, Rummel C, Van Niekerk J, Jensen E, Alessandrini P, Bradski G, Davies B, Ettinger S, Kaehler A, Nefian A and Mahoney P. 2006. Stanley:the robot that won the DARPA grand challenge. Journal of Field Robotics, 23(9):661-692[DOI:10.1002/rob.20147]
Tian L. 2015. Research on Virtual Subjective Evaluation of Vehicle Steering Characters. Changchun: Jilin University
田磊. 2015.汽车转向性能虚拟主观评价方法研究.长春: 吉林大学
Wang S S. 2015. PanoSim:a new generation of advanced automobile intelligent driving simulation system. IEEE Spectrum, (10):68-71
王姗姗. 2015. PanoSim:新一代先进汽车智能驾驶模拟仿真系统.科技纵览, (10):68-71
Zhao X J and Chen H Y. 2011. A study on lateral control method for the path tracking of intelligent vehicles. Automotive Engineering, 2011(5):18-23
赵熙俊, 陈慧岩. 2011.智能车辆路径跟踪横向控制方法的研究.汽车工程, 2011(5):18-23)[ DOI:CNKI:SUN:QCGC.0.2011-05-005 http://dx.doi.org/CNKI:SUN:QCGC.0.2011-05-005 ]
相关文章
相关作者
相关机构
京公网安备11010802024621