Obstacle Avoidance Algorithm for Autonomous Wheeled Vehicle in Unstructured Environments

doi:10.3969/j.issn.1000-1093.2020.10.020

Abstract

Abstract: An obstacle avoidance algorithm based on model prediction control is proposed for the obstacle avoidance task of autonomous ground vehicle in unstructured environments. The trajectory of vehicle, steering angle and reference acceleration can be generated by using optimization method without the offline map and the reference trajectory in unstructured environments, and the result satisfies the vehicle motion constraint in passable area. Obstacle avoidance problem is divided into multi-phrases optimal control problem by using the environment perception results according to unstructured road scenarios. The vehicle constraints and cost function for each phrase of the optimal control problem are clarified. The constraints are transformed into the formulation related to vehicle longitudinal and lateral control. Then the optimal control problem is solved by mathematical method. The results of real vehicle tests show that the proposed algorithm can generate trajectory in unstructured environments. It is also shown that the algorithm is capable for obstacle avoidance and keeps vehicle under the limits of constraint.

Key words: autonomousgroundvehicle, modelpredictioncontrol, obstacleavoidance, vehicledynamics

CLC Number:

TJ810.2

DU Guangze， ZHANG Xudong， ZOU Yuan， ZHENG Zhuangzhuang. Obstacle Avoidance Algorithm for Autonomous Wheeled Vehicle in Unstructured Environments[J]. Acta Armamentarii, 2020, 41(10): 2096-2105.

References

［1］蒋键. 智能车辆越野环境路径规划[D].北京:北京理工大学,2016.
JIANG J. Path planning of intelligent vehicles on uneven terrain[D].Beijing:Beijing Institute of Technology, 2016.(in Chinese)
[2］霍凤财,迟金,黄梓健，等.移动机器人路径规划算法综述[J].吉林大学学报(信息科学版), 2018, 36(6): 639-647.
HUO F C, CHI J, HUANG Z J, et al. Review of path planning for mobile robots[J]. Journal of Jilin University (Information Science Edition), 2018, 36(6): 639-647.(in Chinese)
[3］ BEAL C E, GERDES J C. Model predictive control for vehicle stabilization at the limits of handling[J]. IEEE Transactions on Control Systems Technology, 2013, 21(4):1258-1269.
[4］ LIU J, JAYAKUMAR P, STEIN J L, et al. Combined speed and steering control in high-speed autonomous ground vehicles for obstacle avoidance using model predictive control[J]. IEEE Tran- sactions on Vehicular Technology, 2017, 66(10): 8746-8763.
[5］ LUDERS B D, KARAMAN S, HOW J P. Robust sampling-based motion planning with asymptotic optimality guarantees[C]∥Proceedings of AIAA Guidance, Navigation, and Control (GNC) Conference. Boston, MA US: AIAA, 2013: 5097.
[6］ SHIMODA S, KURODA Y, IAGNEMMA K. High-speed navigation of unmanned ground vehicles on uneven terrain using potential fields[J]. Robotica, 2007, 25(4):409-424
[7］ HUSSEIN A, MOSTAFA H, BADREL-DIN M, et al. Metaheuristic optimization approach to mobile robot path planning[C]∥Proceedings of International Conference on Engineering and Technology (ICET'2012). Cairo, Egypt: IEEE, 2012: 1-6.
[8］ GAO Y, LIN T, BORRELLI F, et al. Predictive control of autonomous ground vehicles with obstacle avoidance on slippery roads[C]∥Proceedings of ASME 2010 Dynamic Systems and Control Conference. Cambridge, MA, US:ASME, 2010: 265-272.
[9］ ZOU Y, GUO N Y, ZHANG X D, et al. An integrated control strategy of path following and lateral motion stabilization for autonomous distributed drive electric vehicles[J]. Proceedings of the Institution of Mechanical Engineers, Part D: Journal of Automobile Engineering, 2019: 0954407019884168.
[10］任玥, 郑玲, 张巍, 等. 基于模型预测控制的智能车辆主动避撞控制研究[J]. 汽车工程, 2019, 41(4): 404-410.
REN Y, ZHENG L, ZHANG W,et al. A study on active collision avoidance control of autonomous vehicles based on model predictive control[J]. Automotive Engineering, 2019, 41(4): 404-410.(in Chinese)
[11］韩月起, 张凯, 宾洋, 等. 基于凸近似的避障原理及无人驾驶车辆路径规划模型预测算法[J]. 自动化学报, 2020, 46(1): 153-167.
HAN Y Q, ZHANG K, BIN Y, et al. Convex approximation based avoidance theory and path planning MPC for driver-less vehicle[J]. Acta Automatica Sinica, 2020, 46(1): 153-167.(in Chinese)
[12］张凤娇, 魏民祥, 黄丽琼, 等. 基于模型预测控制的汽车紧急换道控制研究[J]. 现代制造工程, 2017(3): 57-64.
ZHANG F J, WEI M X, HUANG L Q, et al. Study of vehicle emergent lane-change control based on model predictive control[J]. Modern Manufacturing Engineering, 2017(3): 57-64.(in Chinese)
[13］邓海鹏, 麻斌, 赵海光, 等. 自主驾驶车辆紧急避障的路径规划与轨迹跟踪控制[J]. 兵工学报, 2020, 41(3): 585-594.
DENG H P, MA B, ZHAO H G, et al. Path planning and tracking control of autonomous vehicle for obstacle avoidance[J].Acta Armamentarii, 2020, 41(3): 585-594.(in Chinese)
[14］ TAHIROVIC A, MAGNANI G. General framework for mobile robot navigation using passivity-based MPC[J]. IEEE Transactions on Automatic Control, 2011, 56(1): 184-190.
[15］ WANG Y J, LIU Z X, ZUO Z Q, et al. Trajectory planning and safety assessment of autonomous vehicles based on motion prediction and model predictive control[J]. IEEE Transactions on Vehicular Technology, 2019, 68(9): 8546-8556.
[16］ NILSSON J, FALCONE P, ALI M, et al. Receding horizon maneuver generation for automated highway driving[J]. Control Engineering Practice, 2015, 41:124-133.
[17］ LEMAN Z A, ARIFF M H M, ZAMZURI H, et al. Model predictive controller for path tracking and obstacle avoidance manoeuvre on autonomous vehicle[C]∥Proceedings of 2019 12th Asian Control Conference (ASCC). Kitakyushu, Japan: IEEE, 2019: 1271-1276.
[18］ DOUGLAS D H, PEUCKER T K. Algorithms for the reduction of the number of points required to represent a digitized line or its caricature[J]. Cartographica the International Journal for Geographic Information and Geovisualization, 1973, 10(2): 112-122.
[19］ DARBY C L, HAGER W W, RAO A V. An hp-adaptive pseudospectral method for solving optimal control problems[J]. Optimal Control Applications and Methods, 2011, 32(4): 476-502.
[20］ WACHTER A, BIEGLER L T. On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming[J]. Mathematical Programming, 2006, 106(1): 25-57.

[1]	LIU Cong， LIU Hui, HAN Lijin, CHEN Ke. High-speed Obstacle Avoidance and Stability Control of Distributed Electric Drive Vehicle under Extreme Off-road Conditions [J]. Acta Armamentarii, 2021, 42(10): 2102-2113.
[2]	ZHANG Chaosheng, WANG Jian, ZHANG Lin, WANG Ya. A Multi-agent System Flocking Model with Obstacle Avoidance in Complex Obstacle Field [J]. Acta Armamentarii, 2021, 42(1): 141-150.
[3]	DENG Haipeng， MA Bin， ZHAO Haiguang， L Liang, LIU Yu. Path Planning and Tracking Control of Autonomous Vehicle for Obstacle Avoidance [J]. Acta Armamentarii, 2020, 41(3): 585-594.