基于Bezier曲线优化的茶园拖拉机避障稳定控制方法.pdf
《基于Bezier曲线优化的茶园拖拉机避障稳定控制方法.pdf》由会员分享,可在线阅读,更多相关《基于Bezier曲线优化的茶园拖拉机避障稳定控制方法.pdf(8页珍藏版)》请在咨信网上搜索。
1、江苏大學学报(自然科学版)JOURNAL OF JIANGSU UNIVERSITY(Natural Science Edition)D0I:10.3969/j.issn.1671-7775.2023.06.0072023年11月第44卷第6 期Nov.2023Vol.44No.6开放科学(资源服务)标识码(OSID):5基于Bezier曲线优化的茶园拖拉机避障稳定控制方法梁军,任明辉,陈龙,徐永龙12,陈逢强3,杜万兵3(1.江苏大学汽车工程研究院,江苏镇江2 12 0 13;2.腾讯烟台新工科研究院,山东烟台2 6 40 0 0;3.宝胜系统集成科技股份有限公司,江苏扬州2 2 58 0
2、0)摘要:针对茶园拖拉机(tractor inteaplantation,T T P)在作业时进行避障转弯极易发生侧翻、倾覆等安全问题,提出一种基于Bezier曲线优化的避障稳定路径控制方法.首先,从作业场景和运行稳定性两个方面进行运动学分析,系统分析了TTP安全作业特点;然后,针对TTP设计了一种避障路径规划系统方案及Bezier曲线路径优化控制方法,该方法拟合出的路径具有路径光滑、曲率连续、初末位置曲率相同等优点;最后,在CarSim仿真平台搭建TTP模型和坡道避障作业的环境模型,验证并分析横摆角速度、质心侧偏角两项重要的操稳性参数.结果表明:TTP在Bezier曲线拟合的避障路径控制方法
3、下当运行速度小于转向极限速度时,运行稳定性良好,当转向速度超过极限速度的65.1%,其横摆角速度和质心侧偏角的超调量变化率分别达到了50.3%和7 8.6%;同时在该避障控制方法下,随着坡度的增加,即使速度保证在极限速度以下,TTP稳定性也会进一步恶化;在极限坡度角范围内,坡度角增大10,其横摆角速度和质心侧偏角的超调量变化率平均达到了32.8%和14.5%.关键词:茶园拖拉机;Bezier曲线优化;避障;路径优化;CarSim中图分类号:S219引文格式:梁军,任明辉,陈龙,等基于Bezier曲线优化的茶园拖拉机避障稳定控制方法 J.江苏大学学报(自然科学版),2023,44(6):665
4、671,679.Obstacle-avoiding stability control method of tractor intea plantation based on Bezier curve optimizationLIANG Jun,REN Minghui,CHEN Long,XU Yonglong2,CHEN Fengqiang,DU Wanbing(1.Automotive Engineering Research Institute,Jiangsu University,Zhenjiang,Jiangsu 212013,China;2.Tencent Yantai NewEn
5、gineering Research Institute,Yantai,Shandong 264000,China;3.Baosheng System Integration Technology Co.,Ltd.,Yangzhou,Jiangsu 225800,China)Abstract:To solve the safety problems of tractors in tea plantation(TTP)in obstacle avoidance turningwith rollover and overturn,an obstacle avoidance stable path
6、control method was proposed based onBezier curve optimization.The kinematics analysis was carried out according to operation scene andoperation stability,and the safety operation characteristics of TTP were systematically analyzed.Theobstacle avoidance path planning system framework and the Bezier c
7、urve path optimization method weredesigned.The path fitted by this method had the advantages of smooth path,continuous curvature with收稿日期:2 0 2 2-0 2-2 5基金项目:国家重点研发计划项目(2 0 18 YFB1600500)作者简介:梁军(19 7 6 一),男,江苏扬州人,教授,博士生导师(),主要从事智能交通与智能车辆的研究.任明辉(19 9 8 一),男,安徽准北人,硕士研究生(),主要从事智能交通仿真模型的研究,文献标志码:A文章编号:1
8、6 7 1-7 7 7 5(2 0 2 3)0 6-0 6 6 5-0 7666江苏大学学报(自然科学版)第44卷the same curvature at the beginning and end.TTP model and ramp obstacle avoidance environment modelwere established on CarSim simulation platform to verify and analyze two important operation stabilityparameters of yaw velocity and sideslip an
9、gle.The results show that TTP has good running stability whenthe running speed is less than the steering limit speed under the path fitted by Bezier curve.When thesteering speed exceeds 65.1%of the steering limit speed,the overshooting rates of yaw velocity and thecentroid sideslip angle reach 50.3%
10、and 78.6%,respectively.At the same time,with the increasing ofslope,TTP stability can be further deteriorated even if the speed is kept below the limit speed.When theslope angle is increased by 10,the overshoot rates of yaw velocity and the centroid sideslip angle reach32.8%and 14.5%on average,respe
11、ctively.Key words:tractor in tea plantation;Bezier curve optimization;obstacle avoidance;path optimization;CarSim随着中国制造2 0 2 5发展战略的顺利推进,我国的农业机械化水平不断提升,同时物联网和人工智能领域的发展也使得农业机械进人到智能化时代,如无人驾驶拖拉机技术的不断升级和推广应用.目前无人驾驶拖拉机主要应用于平原田地环境,而我国茶园大多分布在山地丘陵地带,则适用于茶园山地工况的“茶园拖拉机”(tractor in teaplantation,TTP)应运而生.文中所研究的
12、茶园拖拉机也称“茶园耕作机”,是一种后轮驱动前轮转向的小型轮式拖拉机,具有转向灵活通过性强的特点.不同的工况环境对于拖拉机的操稳性有很大影响,由于丘陵山地环境工况作业的特殊性和复杂性,则保证拖拉机避障运行安全稳定尤为重要,所以研究茶园拖拉机避障稳定运行具有一定的实际应用价值和理论意义.目前针对拖拉机的避障路径规划算法和拖拉机操稳性分析已经有了大量研究 2-8 。如韩冰等 2 提出用五次多项式规划避障路径;郭成洋等 3 提出改进的人工势场法对农机避障进行路径规划;陶金京等 4 对农机静态纵向稳定性进行了分析;唐兆家等 5 对轮式拖拉机稳定性进行分析;张战文等 6 对履带式拖拉机坡道行驶稳定性进行
13、分析.但是这些研究都是限定在水平路面或者平原田地工况展开避障路径规划,或者单独进行水平路面和坡道静态稳定性研究.针对茶园丘陵工况的拖拉机避障方法及稳定性研究分析较少,针对这些不足,文中首先从作业场景和运行稳定性两个方面进行运动学分析,系统分析TTP安全作业特点,接着针对TTP设计一种避障路径规划方案及Bezier曲线路径优化方法,通过在CarSim平台搭建模型验证TTP运行的安全稳定性.1TTP安全作业特点1.1TTP 作业环境茶园山地一般多为丘陵坡道路况,地面附着系数容易受到气候和环境湿度等因素的影响而发生显著变化,由于其地理环境的复杂性和特殊性,农业机械在其环境下运行失稳可能会导致发生滑移
14、、侧翻、倾覆等危险事故 7 .为避免这些危险事故的发生,文中以TTP在茶园山地进行自主避障为背景,研究其在Bezier曲线优化的避障路径上的运行稳定性.对于坡道工况下进行的避障路径规划,必须保证以下要求:避障转向速度不能过快,避免重心失稳,从而导致侧翻;避障路径的曲率一定要连续,尽可能保证结束位置的曲率等于避障初始位置的曲率;在保证拖拉机稳定运行的前提下,避障路径尽可能短。为进一步简化研究对象,便于研究TTP在茶园坡道地形的爬坡性能和运行稳定性,同时还需要对坡道环境和拖拉机性能做出如下假设:假设坡面条件良好,TTP车轮无纵向滑移;忽略空气动力学对TTP的影响;假设TTP匀速行驶,无明显纵向加速
15、度;假设TTP质量分布均匀,重心处于前后轮接地点的中心位置,1.2TTP坡道运行稳定性1.2.1坡面行驶纵向稳定性分析纵向稳定性包括纵向不翻倾和纵向不滑移两种情况 5-8 ,其上坡的受力情况如图1所示,其中:F为前轮所受地面支持力;F,为后轮所受地面支持力;L为前后轮距;b为重心位置到后轮所受地面支持力方向的距离;为重心位置到前轮所受地面支持力方向的距离;G为拖拉机所受重力;LL,分667第6 期梁军等:基于Bezier曲线优化的茶园拖拉机避障稳定控制方法别为重心在坡道上的投影点距离后轮接地点0 2、0 1的距离;h为后轮直径;为坡度角.GsinFL2L1图1TTP上坡受力分析图根据动力学分析
16、,TTP不发生纵向翻倾的条件是TTP处于坡道行驶方向前方的轮胎所受到的地面支持力要大于0.由图1可得其上坡时前后轮所受地面支持力.前轮接地点0,所受到的地面支持力为LGcos.L,+L2后轮接地点0,所受到的地面支持力L2-Gcos.L+L2随着坡度角的不断增大,轮式拖拉机重心在坡面的投影点后移到后轮接地点0,处,如图2 所示.要保证拖拉机上坡不发生纵向滑移,就要使得拖拉机后轮提供的最大驱动力Fxmax(也即地面提供b的最大附着力)大于重力的分力,即Famx=FaCGsin,Fa=L-b)o a hsin a.式中:Fxmax为后轮最大驱动力;为地面附着系数.从而由公式(7)简化得出拖拉机上坡
17、极限滑移坡度角为=arctan同理拖拉机下坡极限滑移坡度角为=arctan(L-soh)L-b)1.2.2坡面行驶横向稳定性分析(1)横向稳定性包括横向行驶不打滑和横向坡道转向不翻倾的稳定性 .TTP坡道横向运行受力如图3所示.(2)(7)LL-aL-oh)Gsin(8)(9)Z1Z2GO图2 TTP上坡极限角分析图前轮接地点所受到的地面支持力为LGcos =0,L+L2后轮接地点所受到的地面支持力为L2Gcos =Gcos.L,+L2此时拖拉机重力的分力全部集中在后轮接地点0,处,前轮会发生纵向翻倾。由图1和图2 可得,TTP上坡极限翻倾角度为lim=arctan(5)h同理,TTP下坡极限
18、翻倾角度为L-L2lim=arctan(h图3TTP坡道横向运行受力图坡道横向直行的受力情况为Fylm=oFa,FFyamx=eFa,FF,=Fymx+Fpam-Ggcos Gsin,L。=a r c t a n p.(3)由上式可得拖拉机在坡度为的坡面上横向直行运行不打滑的条件:只要保证两制动轮所受附着力F要大于重力分力Gsin.其中Fylmax为左侧制动(4)轮所受地面最大附着力;F,z2max为右侧制动轮所受地面最大附着力;F。为两制动轮所受地面最大附着力;。为横向运动时的最大滑移角.TTP在坡面上转向(转向瞬间假设做理想的圆L-L周运动)时的受力如下:Fi=%GRo,Fi=F,cos:
19、C3R。2R(6)3=g(10)(11)(12)RgR,668江苏大学学报(自然科学版)第44卷(BFz1B2tan=2hBhgRsinF,=Gpcos Gsin+gR式中:F,为拖拉机转向时做圆周运动的向心力;F为向心力在坡面的分力;F。为地面附着力;R为拖拉机最小转弯半径;B为拖拉机机体宽度为转向速度;h为后轮直径;为坡度角.对式(11)-(15)计算得v V(-tan)gRcos,则TTP在坡道运行进行自主避障的过程中为保证运行安全稳定,需对速度进行限制,并保持在此极限速度以下.2TTP避障路径规划2.1TTP避障路径规划系统架构TTP坡道避障路径规划系统架构包括信息采集模块、信息传输模
20、块、信息编码处理模块以及路径规划模块,如图4所示.系统首先通过信息采集模块对周边环境信息和自身运行数据信息进行采集,然后信息编码模块对采集的信息进行编码处理,传输模块将信息传输到ECU进行处理和判断,避障路径规划模块根据ECU发出的指令和数据完成 TTP 的避障路径规划.信息采集模块传感器技术采集周边环境及位置信息自身运行数据信息传输数据编码与解码图4避障路径规划系统架构图2.1.1信息采集模块信息采集模块包括周边环境信息感知模块和自身运行数据信息感知模块,两模块中的各类传感器实时采集拖拉机运行时的数据,并将其存储在信息存储模块中.信息采集模块结构如图5所示.周边环境信息感知模块包括障碍物检测
21、模块、道路坡度信息采集模块、环境湿度信息采集模块和北斗定位系统接收器模块.障碍物检测模块为一个hu2cos-hsingR路径规划模块读取坡度倾角选取路面附着系数9确定障碍物距离L障碍物特征圆半径R计算确定转向速度U确定前轮转向倾角传感器单元,传感器单元为一个微波雷达;坡度信(13)息采集模块为一个传感器单元,传感器单元为一个(14)倾角传感器;环境湿度信息采集模块为一个传感器单元,传感器单元为一个湿度传感器;北斗定位传(15)感器为一个传感器单元.自身信息采集模块包括车速信息采集模块、转向系统信息采集模块、制动系统采集模块以及车身稳定系统采集模块.车速信息采集模块为一个传感器单元,传感器单元为
22、两个车轮转速传感器;转向系统信息采集模块包括信息采集单元,信息采集单元为一个转速传感器和一个加速度传感器,转速传(16)感器检测油泵转速,加速度传感器检测转向节的加速度;制动系统采集模块为一个角度传感器组成单元;车身稳定系统采集模块由横摆角速度传感器和侧向加速度传感器组成单元,微波雷达传感器车轮转速传感器加速度传感器倾角传感器车速信息采集模块转向系统信息采集模块湿度传感器自身信息采集模块角度传感器横摆角速度传感器北斗定位传感器侧向加速度传感器车身稳定系统环境信息感知模块环境信息感知模块信息采集模块图5信息采集模块结构图2.1.2信息传输和编码模块信息编码模块由寻呼机电路板组成,该模块将采集模块
23、采集到的信息进行编码,通过无线局域网将编码信息传输到远程监控终端进行信息处理.信息处理模块包括信息接收模块、信息解码模块、信息分析模块和信息显示模块.信息接收模块由无线接收器组成,通过无线局域网接收传输过来的编码信息;信息解码模块采用单片机对收到的编码信息进行解码处理;信息分析模块由装有MATLAB的计算机组成,采集到的环境数据和自身数据对拖拉机自身控制系统进行反馈,及时修正拖拉机避障转向速度以及前轮转向倾角,实时保证拖拉机运行的稳定性;显示模块主要由一块LED显示屏组成,用于显示拖拉机的实时信息.2.1.3避障路径规划模块TTP在坡道上运行作业进行避障时,首先需要通过信息采集模块确定障碍物的
24、距离以及障碍物特征圆大小,根据TTP在丘陵坡地作业的情形,可认为障碍物主要包括树木、田、水井等,其轮廓一转速传感器加速度传感器采集模块669第6 期梁军等:基于Bezier曲线优化的茶园拖拉机避障稳定控制方法般小于拖拉机最小转弯半径,可以得出障碍物特征圆半径R=Tmin同时为了保证TTP避障过程中的安全通过性以及保证前轮转角骤变幅度易于控制,提出一种基于最短切线法的避障路径,通过对 TTP 的运动状态分析,确定避障路径中各拐点坐标,从而可以快速完成路径规划.虽然最短路切线法规划的路径光滑平顺,但是路径的曲率变化并不连续,从而导致拖拉机在路径中由圆弧向直线过渡过程中前轮的转角会发生骤变,不利于拖
25、拉机转向控制从而影响其轨迹跟踪控制的精确度 10-12 1.2.2基于Bezier 曲线的路径优化算法采用Bezier曲线进行路径拟合优化,可以保证避障轨迹曲率连续性.2.2.1Bezier曲线路径优化模型给定n+1个控制点P,i=0,1,2,n,则n次Bezier曲线P(t)的定义为P(t)=Z P,Bi.,(t),t e 0,1,(17)i=0式中:t为位置参数;Bin(t)为Bernstein基函数.对Bezier曲线进行求导可得P(t)=n Z Bi-1.-1(t)(P,-P.),(18)ni=0把t=0和t=1代人上式可得P(0)=P(1)=n(P,-Pn-1).由式(15)可得,B
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 Bezier 曲线 优化 茶园 拖拉机 稳定 控制 方法
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。