Obstacle Avoidance Trajectory Planning and Model-predicted Trajectory Tracking of Wheel Loaders

被引:0
|
作者
Shi J.-R. [1 ]
Sun D.-Y. [1 ]
Qin D.-T. [1 ]
Hu M.-H. [1 ]
Kan Y.-Z. [1 ]
机构
[1] The State Key Lab of Mechanical Transmission, Chongqing University, Chongqing
基金
中国国家自然科学基金;
关键词
Mechanical engineering; Model predictive control; Obstacle avoidance; Trajectory planning; Trajectory tracking; Wheel loader;
D O I
10.19721/j.cnki.1001-7372.2021.05.021
中图分类号
学科分类号
摘要
To address the problem of poor trajectory planning and tracking during obstacle avoidance for wheel loaders, a trajectory-planning method considering the constraints of the turning radius and dynamic change in vehicle speed was proposed. A model-predictive trajectory-tracking system for the entire vehicle based on the dynamic model of the wheel loader was constructed. In this method, based on the optimal rapidly exploring random tree algorithm and considering the number of inflation circles in the automobile body based on collision risk, the global optimal obstacle avoidance path was generated for the automobile wheel loader. By considering the minimum stable steering radius of the vehicle as a constraint, the path for obstacle avoidance was smoothed using the continuous curvature steer algorithm, and the path-velocity decomposition algorithm was adopted to plan the obstacle avoidance trajectory of the vehicle under the condition of variable-speed driving. Based on the dynamic model of the wheel loader and considering the lateral deviation and relative yaw angle in the course of driving, the vehicle powertrain was regarded as the first-order inertia link, and the vehicle dynamics prediction model was established based on model-predictive control. The objective function was converted into a quadratic programming problem by considering the acceleration, articulation angle, and vehicle speed as constraints, and a model-predictive trajectory-tracking control system was established to satisfy the obstacle avoidance of wheel loaders in the working area. Based on the obstacle avoidance trajectory generated by the planning, the model predictive trajectory-tracking control system was used to perform obstacle avoidance simulation. The results demonstrate that the constructed system can control the autonomous wheel loader from the initial position to the target position, realize the obstacle avoidance process of the vehicle in the working area, and meet the constraints of the vehicle to ensure the safety and stability of the vehicle during trajectory tracking. © 2021, Editorial Department of China Journal of Highway and Transport. All right reserved.
引用
收藏
页码:224 / 236
页数:12
相关论文
共 25 条
  • [1] OH K, YUN S, KO K, Et al., Gear Ratio and Shift Schedule Optimization of Wheel Loader Transmission for Performance and Energy Efficiency, Automation in Construction, 69, pp. 89-101, (2016)
  • [2] FRANK B, KLEINERT J, FILLA R., Optimal Control of Wheel Loader Actuators in Gravel Applications, Automation in Construction, 91, pp. 1-14, (2018)
  • [3] YU Zhuo-ping, LI Yi-shan, XIONG Lu, A Review of the Motion Planning Problem of Autonomous Vehicle, Journal of Tongji University: Natural Science, 45, 8, pp. 1150-1159, (2017)
  • [4] Review on China's Automotive Engineering Research Progress: 2017, China Journal of Highway and Transport, 30, 6, pp. 1-197, (2017)
  • [5] LAVALLE S M, KUFFNER J J., Randomized Kinodynamic Planning, The International Journal of Robotics Research, 20, 5, (2001)
  • [6] LEONARD J, HOW J, TELLER S, Et al., A Perception-driven Autonomous Urban Vehicle, Journal of Field Robotics, 25, 10, pp. 727-774, (2008)
  • [7] KARAMAN S, FRAZZOLI E., Incremental Sampling-based Algorithms for Optimal Motion Planning, International Journal of Robotics Research, 30, 7, pp. 846-894, (2011)
  • [8] ALSHAER B J, DARABSEH T T, ALHANOUTI M A., Path Planning, Modeling and Simulation of an Autonomous Articulated Heavy Construction Machine Performing a Loading Cycle, Applied Mathematical Modelling, 37, 7, pp. 5315-5325, (2013)
  • [9] REEDS J A, SHEPP L A., Optimal Paths for a Car That Goes Both Forwards and Backwards, Pacific Journal of Mathematics, 145, 2, pp. 367-393, (1990)
  • [10] ABBASSI Y, AIT-AMIRAT Y, OUTBIB R., Nonlinear Feedback Control and Trajectory Tracking of Vehicle, International Journal of Systems Science, 46, 16, pp. 2873-2886, (2015)