基于Bezier曲线优化的茶园拖拉机避障稳定控制方法  

Obstacle-avoiding stability control method of tractor in tea plantation based on Bezier curve optimization

作　　者：梁军[1] 任明辉[1] 陈龙[1] 徐永龙[1,2] 陈逢强 杜万兵 LIANG Jun;REN Minghui;CHEN Long;XU Yonglong;CHEN Fengqiang;DU Wanbing(Automotive Engineering Research Institute,Jiangsu University,Zhenjiang,Jiangsu 212013,China;Tencent Yantai New Engineering Research Institute,Yantai,Shandong 264000,China;Baosheng System Integration Technology Co.,Ltd.,Yangzhou,Jiangsu 225800,China)

机构地区：[1]江苏大学汽车工程研究院,江苏镇江212013 [2]腾讯烟台新工科研究院,山东烟台264000 [3]宝胜系统集成科技股份有限公司,江苏扬州225800

出　　处：《江苏大学学报（自然科学版）》2023年第6期665-671,679,共8页Journal of Jiangsu University：Natural Science Edition

基　　金：国家重点研发计划项目(2018YFB1600500)。

摘　　要：针对茶园拖拉机(tractor in tea plantation,TTP)在作业时进行避障转弯极易发生侧翻、倾覆等安全问题,提出一种基于Bezier曲线优化的避障稳定路径控制方法.首先,从作业场景和运行稳定性两个方面进行运动学分析,系统分析了TTP安全作业特点;然后,针对TTP设计了一种避障路径规划系统方案及Bezier曲线路径优化控制方法,该方法拟合出的路径具有路径光滑、曲率连续、初末位置曲率相同等优点;最后,在CarSim仿真平台搭建TTP模型和坡道避障作业的环境模型,验证并分析横摆角速度、质心侧偏角两项重要的操稳性参数.结果表明:TTP在Bezier曲线拟合的避障路径控制方法下当运行速度小于转向极限速度时,运行稳定性良好,当转向速度超过极限速度的65.1%,其横摆角速度和质心侧偏角的超调量变化率分别达到了50.3%和78.6%;同时在该避障控制方法下,随着坡度的增加,即使速度保证在极限速度以下,TTP稳定性也会进一步恶化;在极限坡度角范围内,坡度角增大10°,其横摆角速度和质心侧偏角的超调量变化率平均达到了32.8%和14.5%.To solve the safety problems of tractors in tea plantation(TTP)in obstacle avoidance turning with rollover and overturn,an obstacle avoidance stable path control method was proposed based on Bezier curve optimization.The kinematics analysis was carried out according to operation scene and operation stability,and the safety operation characteristics of TTP were systematically analyzed.The obstacle avoidance path planning system framework and the Bezier curve path optimization method were designed.The path fitted by this method had the advantages of smooth path,continuous curvature with the same curvature at the beginning and end.TTP model and ramp obstacle avoidance environment model were established on CarSim simulation platform to verify and analyze two important operation stability parameters of yaw velocity and sideslip angle.The results show that TTP has good running stability when the running speed is less than the steering limit speed under the path fitted by Bezier curve.When the steering speed exceeds 65.1%of the steering limit speed,the overshooting rates of yaw velocity and the centroid sideslip angle reach 50.3%and 78.6%,respectively.At the same time,with the increasing of slope,TTP stability can be further deteriorated even if the speed is kept below the limit speed.When the slope angle is increased by 10°,the overshoot rates of yaw velocity and the centroid sideslip angle reach 32.8%and 14.5%on average,respectively.

关 键 词：茶园拖拉机 Bezier曲线优化 避障 路径优化 CARSIM 

分 类 号：S219[农业科学—农业机械化工程]