摘要
为实现农用拖挂车的避障控制,设计了一种基于非线性模型预测控制的避障控制器。考虑到农用拖挂车的避障控制需要同时顾及拖车与挂车的位姿状态,基于刚体运动学和非完整约束条件推导了农用拖挂车的运动学模型,并基于该运动学模型建立了农用拖挂车的位姿状态预测模型。在此基础上,基于改进的禁区惩罚函数设计了优化目标函数,从而完成了基于非线性模型预测控制的农用拖挂车避障控制器的设计。仿真结果表明,农用拖挂车避障控制器能够在较复杂工况下同时控制拖车与挂车实现避障,农用拖挂车各车桥端点轨迹与障碍物中心之间的最小距离减去障碍物半径与安全裕度之和的结果均大于或等于0 m。
For the obstacle avoidance control of agricultural tractor-trailers, a controller based on nonlinear model predictive control was proposed. Since the obstacle avoidance control of the agricultural tractor-trailer should take the position state and the attitude state of the tractor and trailer into account, the kinematics model of the agricultural tractor-trailer was derived based on rigid body kinematics and non-holonomic constraints. And based on this kinematics model, the position state and the attitude state prediction model of the agricultural tractor-trailer was established. Thereafter, the optimization function was designed based on the improved forbidden zone penalty function, and the proposed obstacle avoidance controller design was completed. In the simulation results, by comparing with the obstacle avoidance controller that did not consider the position state and the attitude state of the trailer, it can be known that the proposed obstacle avoidance controller of agricultural tractor-trailers can control the tractor and the trailer to avoid the obstacle simultaneously. And under the control of the proposed obstacle avoidance controller of agricultural tractor-trailers, the minimum distance between the trajectory of the end point of each axle and the center of the obstacle minus the sum of the obstacle radius and the safety margin was not less than 0 m.
作者
白国星
刘立
孟宇
罗维东
顾青
梁晨
BAI Guoxing;LIU Li;MENG Yu;LUO Weidong;GU Qing;LIANG Chen(School of Mechanical Engineering, University of Science and Technology Beijing, Beijing 100083, China)
出处
《农业机械学报》
EI
CAS
CSCD
北大核心
2019年第4期356-362,共7页
Transactions of the Chinese Society for Agricultural Machinery
基金
国家重点研发计划项目(2018YFC0604403
2016YFC0802905)
国家高技术研究发展计划(863计划)项目(2011AA060408)
中央高校基本科研业务费专项资金项目(FRF-TP-17-010A2)
关键词
农用拖挂车
运动学
模型预测控制
避障控制
agriculture tractor-trailer
kinematics
model predictive control
obstacle avoidance
作者简介
白国星(1992—),男,博士生,主要从事汽车自动化控制和模型预测控制研究,E-mail:bgxgzy@163.com;通信作者:孟宇(1981—),男,副教授,博士,主要从事汽车电子及自动化、机器视觉和智能车辆研究,E-mail:myu@ustb.edu.cn.
