基于虚拟探照灯的离合制动履带底盘寻径跟踪.pdf
《基于虚拟探照灯的离合制动履带底盘寻径跟踪.pdf》由会员分享,可在线阅读,更多相关《基于虚拟探照灯的离合制动履带底盘寻径跟踪.pdf(10页珍藏版)》请在咨信网上搜索。
1、基于虚拟探照灯的离合制动履带底盘寻径跟踪陈子文1,熊扬凡1,胡宗锐1,李聪2,庞有伦3,杨明金1(1.西南大学工程技术学院,重庆400715;2.重庆工业职业技术学院机械工程与自动化学院,重庆401120;3.重庆市农业科学院农业机械化研究所,重庆401329)摘要:油动履带底盘由于具有成本低、技术成熟、动力充足、续航能力强、维修便捷等特点而被广泛应用于农业生产,但其操控精度低、振动严重等问题对其应用造成挑战。该研究以农用油动履带底盘为对象,根据共性传动结构提出离合制动式履带底盘,并以 STM32F303 作为主控器搭建基于实时动态差分全球导航卫星系统(real-timekinematicgl
2、obalnavigationsatellitesystem,RTK-GNSS)的自动导航系统,建立其运动学模型,提出一种改进模糊式预瞄控制算法虚拟探照灯寻径跟踪(virtualsearchlightpathfindingtracking,VSPT)算法。针对横向偏差和速度变化引起的跟踪振荡问题,提出基于横向偏差指数的视域角动态调整方法和基于行驶速度的虚拟目标点判断方法,并通过仿真和试验验证算法的有效性。仿真结果表明,在底盘前进速度 0.4m/s 时,横向偏差指数、视域增益 k1和目标增益 k2取值分别为 1/4,0.005radm 和 6s1时可获得较好的导航效果。现场试验结果表明,在水泥路面
3、,不同初始位姿下,直线导航平均上线距离为 1.64m,平均横向偏差和航向偏差为 0.44cm 和 1.57;行驶速度提高会导致导航精度降低,适当修正 k1、k2可维持较好的导航效果,3 种行驶速度下获得的平均横向和航向偏差分别为 0.75cm 和 1.05,平均纠偏次数为 4.7 次;田间路况下,由于土路附着系数增加,转向相对平稳,纠偏次数降低至 2.7 次,相同参数时 2 种路况下的导航效果接近。研究表明,VSPT 算法针对离合制动式履带底盘具有良好的跟踪效果和路况适应性,该研究可为离合制动履带平台提供一种高效、稳定的导航控制方案。关键词:精准农业;车辆;导航;RTK-GNSS;履带底盘;控
4、制算法doi:10.11975/j.issn.1002-6819.202303024中图分类号:S224.9文献标志码:A文章编号:1002-6819(2023)-12-0010-10陈子文,熊扬凡,胡宗锐,等.基于虚拟探照灯的离合制动履带底盘寻径跟踪J.农业工程学报,2023,39(12):10-19.doi:10.11975/j.issn.1002-6819.202303024http:/www.tcsae.orgCHENZiwen,XIONGYangfan,HUZongrui,etal.Pathfindingandtrackingofclutchbraketrackchassisbase
5、donvirtualsearchlightJ.TransactionsoftheChineseSocietyofAgriculturalEngineering(TransactionsoftheCSAE),2023,39(12):10-19.(inChinesewithEnglishabstract)doi:10.11975/j.issn.1002-6819.202303024http:/www.tcsae.org0引言农业机械自动导航是精准农业的关键技术,可以极大减轻操作人员的劳动强度,同时提高作业质量与作业效率1-3。底盘总成是移动式农用动力机械的核心部件之一,在通用式底盘上搭载其他功能性
6、农具可实现多种农业生产作业4。相较于普通轮式拖拉机,自走式履带底盘体积小巧,拥有更低的接地比压、滑转率和滚动阻力系数,地形适应能力广。尤其在复杂多变的山地和黏湿土壤的田间环境下,履带式底盘表现出卓越的综合性能5。目前,农机装备自动导航研究主要集中在轮式拖拉机和电驱动力平台,涉及的导航控制方法包括 PID 控制6、模糊控制7-8、预瞄跟踪控制9、非线性模型预测控制10、基于位姿偏差的转向角线性控制11-12、基于运动特性的导航控制13以及反步滑动模式控制14等。然而,针对低成本、技术成熟,采用转向离合器进行转向的油动机械换挡履带底盘的导航系统研究较少。ZHANG 等15针对单缸柴油履带车导航提出
7、一种基于虚拟阿克曼转向模型的状态反馈导航控制系统,并设计了基于脉宽调制原理的前向比例控制方法,在果园环境中的平均跟踪误差为 5.1cm,跟踪误差标准差为 8.4cm。丁幼春等16针对搭载油菜播种机的履带底盘设计了免疫 PID 导航控制器,当行驶速度为 0.5m/s 时,其平均导航偏差为 4.2cm,最大偏差为 11.9cm。刘志杰等17针对小型履带拖拉机,通过搭载组合导航系统,并利用神经网络提出了一种虚拟雷达模型的路径跟踪控制算法,当行驶速度为 0.36、0.75m/s 时,平均横向偏差分别为 3.1、5.1cm。吴才聪等18针对履带底盘提出模糊自适应纯追踪控制方法,水泥路面试验表明,当行驶速
8、度为 0.8m/s时,模糊自适应纯追踪控制器最大跟踪偏差为 3.9cm,平均绝对偏差为 1.8cm。在农业作业场景中,应用于此类农用动力机械的路径跟踪算法必须满足较高的精度要求。例如,在播种、施肥和喷药等环节,精准的路径跟踪有助于减少重复覆盖和遗漏区域,从而提高作业效率19。同时,较高的行收稿日期:2023-03-05修订日期:2023-05-11基金项目:国家重点研发计划项目(2018YFD0700603-1);重庆市技术创新与应用发展专项重点项目(cstc2021jscx-gksbX0013)作者简介:陈子文,博士,讲师,研究方向为农业机器人和机器视觉技术。Email:chenziwen_
9、通信作者:杨明金,博士,教授,博士生导师,研究方向智能农业装备和农产品产地加工技术。Email:第39卷第12期农 业 工 程 学 报Vol.39No.12102023年6月TransactionsoftheChineseSocietyofAgriculturalEngineeringJune2023驶速度也可缩减作业周期,以适应农业生产的季节性要求20。但过高的速度会导致导航系统的精度和稳定性降低,因此要求跟踪算法在保证导航精度的要求下尽可能提高行驶速度。另一方面,在实际农业作业中,自动导航系统需在较短时间内上线并开始跟踪期望路径。若上线距离过长,不但会降低作业效率,甚至影响整个农业生产过程
10、。然而,油动换挡履带底盘难以进行精准的速度控制,其速度控制只能通过调整油门和机械档位实现,速度滞后较严重,同时由于各侧履带无法单独速度控制,因此只能进行单一模式转向。值得关注的是,在离合制动式履带平台上,每一次的转向动作,尤其在直线跟踪过程中,都会对车辆造成一次刚性冲击。这主要是由于转向时,履带平台的单侧履带轮锁死,从而导致平台速度瞬间改变造成的。频繁转向会导致搭载在平台上的功能性农具的作业精度下降,甚至无法正常工作;并且过于频繁的纠偏可能会对农具或履带平台自身造成损坏。故此类履带平台在农业作业中并不适宜频繁转向纠偏。目前的各类路径跟踪算法并未充分考虑车辆在跟踪过程中的纠偏次数,尤其是针对离合
11、制动式履带平台的算法,因此,在设计适用于此类平台的跟踪算法时,既需要严格限制纠偏次数,又要确保跟踪精度得到满足。这一原则有助于提高农业作业效率,减少搭载农具的精度损失和避免农具及履带平台的损坏。本文以 3WZF-400 汽油驱动履带底盘为研究对象,提出一种虚拟探照灯寻径路径跟踪方法,通过仿真和导航试验对系统和算法性能进行验证,该方法综合考虑离合制动式履带平台在跟踪过程中的纠偏次数限制和跟踪精度需求,旨在为此类平台提供一种高效、稳定的导航解决方案。1材料与方法1.1离合制动式履带底盘构成本文以 3WZF-400 汽油驱动履带底盘(苏州博田自动化技术有限公司生产)为研究对象搭建自动导航系统,如图
12、1 所示,主要由履带总成、传动系统和操纵系统组成。履带车总长 1.2m,宽 0.9m,橡胶履带宽 0.2m,动力由 5.4kW 单缸汽油机提供,该履带底盘体积小,对各种果园、田地道路条件有较强适应性。履带底盘动力传动与转向系统如图 2 所示。发动机将动力传递给手动换挡变速箱,离合器手柄可控制动力离合器的闭合,将动力传递给驱动桥,左右两个驱动轮前端均设有常闭离合器,通过转向手闸轧线控制离合器打开,切断动力传输,实现停机或转向。由于该类动力平台通过控制离合器闭合,实现车辆制动或转向,故将此类结构和操控方式称为离合制动式履带底盘。为实现履带底盘自动操控,对手动操控系统进行升级,采用气动系统代替手动操
13、作,应用 3 组独立控制的双作用气缸拉动轧线控制 3 个离合器的闭合,实现启停、直线行驶、转向等动作21。1234568109121314151171.导航控制箱2.气泵3.转向手闸4.换挡手柄5.动力离合器手柄6.气动系统控制箱7.RTK-GNSS 移动站定位天线8.STM32F303 控制器9.RTK-GNSS 移动站接收机10.ZigBee 无线模块11.电台天线12.无线电台13.RTK-GNSS 基站接收机14.RTK-GNSS 基站天线15.上位机1.Navigationcontrolbox2.Airpump3.Steeringhandbrake4.Shifthandle5.Pow
14、erclutchhandle6.Pneumaticsystemcontrolbox7.RTK-GNSSmobilestation positioning antenna 8.STM32F303 controller 9.RTK-GNSS mobilestationreceiver10.ZigBeewirelessmodule11.Radioantenna12.Radiostation13.RTK-GNSS fixed station receiver 14.RTK-GNSS fixed station antenna15.Computer图 1离合制动式履带底盘系统组成Fig.1Composi
15、tionofclutch-braketrackchassis1234561.左转向离合器2.右转向离合器3.动力离合器4.变速箱5.发动机6.履带总成1.Left steering clutch 2.Right steering clutch 3.Power clutch 4.Gearbox5.Engine6.Trackassembly图 2履带底盘转向结构示意图Fig.2Steeringmechanismdiagramoftrackchassis1.2导航控制系统架构导航控制系统采用以 ARMCortexM4 为内核的STM30F303VCT6 单片机作为中控器,数据接收、数据解析、运算处理
16、等任务均由该单片机完成。全球卫星导航系统(globalnavigationsatellitesystem,GNSS)采用上海华测导航技术股份有限公司的 P3-DU 北斗高精度定位测向接收机,搭配有载波相位差分技术(real-timekinematic,RTK),多系统双频,支持双天线定位测向解算,在装备有移动站接收机的基础上,通过搭建基站接收机和无线电台,实现 RTK-GNSS 高精度定位数据的接收。导航控制系统整体架构如图 3 所示,RTK-GNSS定位模块利用无线电台接收差分信号,经差分系统校准后,中控器采取通用异步串行通信(universalasynchronousreceiver/tr
17、ansmitter,UART)方式获取高精度定位数据。将解析数据与设定的期望路径进行比较,利用偏差跟踪算法得到预期驾驶动作,通过控制执行机构以达到路径第12期陈子文等:基于虚拟探照灯的离合制动履带底盘寻径跟踪11跟踪的目的。上位机可以监控导航控制系统的工作状态,其与中控器之间采用 UART 方式并通过 ZigBee 无线模块进行数据的相互传输。中控器将解析后的定位信息以及导航过程中所产生的各项导航参数反馈给上位机,在系统发生异常时可通过发送相关指令终止导航作业。在本研究中,选择 ZigBee 模块主要考虑到其成本低、体积小、使用方便等优势,有利于在短时间内实现系统原型的搭建与初步测试。RTK-
18、GNSS定位模块中控器上位机输出控制电路执行机构UARTUARTZigbeeSTM32F303华测P3-DU图 3导航控制系统架构Fig.3Structureofnavigationcontrolsystem2路径跟踪控制方法2.1履带底盘运动学模型根据离合制动式履带底盘的工作原理,只能依靠单侧履带轮完全制动来实现转向,即转向时内侧履带的驱动轮角速度为零,外侧履带轮角速度不变,且履带底盘作业过程中驱动轮的速度无法随意调节,在导航平面坐标系 X-O-Y(n 系)中建立履带车运动学模型,如图 4 所示,G(x,y)为履带车几何中心坐标。考虑到农业作业中一般行驶速度较低,可做如下假设:1)履带底盘质
19、心与几何中心重合;2)履带底盘在作业过程中非制动时履带的带速恒定;3)忽略双侧履带的滑移和滑转。GbOr Gvvrv1voXY注:G 为履带底盘几何中心点,G点为转动后履带底盘几何中心点,o 为旋转中心;为履带底盘航向角,02,rad;b 为双侧履带中轴线间距,m;vl为左侧履带的带速,ms1;vr为右侧履带的带速,ms1;v 为履带底盘几何中心速度,ms1;r 为转弯半径,m;为转向角,rad。Note:Gisthegeometriccenterpointofthetrackchassis,Gisthegeometriccenterpointofthetrackchassisaftertur
20、ning,oisthecenterofrotation,istheheadingangleofthetrackchassis,02,rad;biscenteraxisspacingoftracksonbothside,m;vlisthespeedofthelefttrack,ms1;vristhespeedoftherighttrack,ms1;visthespeedofthegeometriccenterofthetrackchassis,ms1;risturningradius,m;meanssteeringangle,rad.图 4离合制动式履带底盘运动学模型Fig.4Kinematic
21、modelofclutch-braketrackchassis定义履带底盘的航向角 为 Y 轴正方向顺时针旋转至速度 v 的角度,转向角 的大小与转向对应的圆心角相等,其值与转向持续时间有关。根据运动学原理有:xy=sincos1/rv(1)其中:1r=?vlvrvl+vr?2b(2)以右转为例,在转向时有:v=rrlvl(3)式中 rl表示左侧履带几何中心相对于旋转中心 o 的距离,m。由于右转时右侧履带完全制动,即:vr=0(4)所以有:rrl=1/21b(5)将式(5)带入式(3)可得:v=vl2(6)由式(6)可看出,履带底盘的旋转中心位于履带的几何中心处,车辆进行转向时,旋转中心在左
22、右两侧履带的几何中心之间切换,故两侧履带可独立控制转速和转向的差速模型不适用于此类履带底盘。2.2虚拟探照灯寻径跟踪算法原理路径跟踪的实质是通过控制车辆的运动减少车辆与期望路径之间的偏差,在农机导航作业中,作业路径通常由直线段构成。为提高作业质量和效率,要求农机自动导航系统上线快速稳定、直线跟踪精度高以及对颠簸复杂路面抗干扰性好22。目前大多数跟踪算法按照某种控制策略计算车辆的前轮期望转角,从而通过改变前轮转角控制车辆运动轨迹的曲率,如纯跟踪算法23、Stanley 算法24、MPC 算法25-26。对于差速转向的履带底盘,可以通过改变双侧履带的速度调整履带底盘运动轨迹的曲率,所以可利用转换轮
23、式车辆的跟踪算法实现对目标路径的跟踪控制。而对于离合制动式履带底盘,双侧履带的带速不可随意调节,同时受到速度传感器缺失和路面环境等因素影响,利用转向时间间接获取期望转向角会产生较大误差。此外,为避免履带底盘在跟踪过程中频繁转向纠偏导致的作业精度下降、农具以及履带底盘自身损坏,应对纠偏次数严格限定。本文提出的虚拟探照灯寻径跟踪(virtualsearchlightpathfindingtracking,VSPT)算法假设履带底盘搭载一种光线射程为无限远的虚拟探照灯,并设定一个位于期望路径及其延长线上且不断运动的假想目标点 C,通过模拟探照灯搜索物体的方式建立履带底盘不断追逐目标点的路径跟踪方法。
24、假定该虚拟探照灯安装于履带底盘几何中心处,其视域角为,且光束投射方向与履带底盘航向一致。图 5 所示,若目标点 C 位于虚拟探照灯视域内,则履带底盘直线前进,反之,目标点 C 位于虚拟探照灯视域范围外,履带底盘通过转向寻找该目标点并使其位于视域内。12农业工程学报(http:/www.tcsae.org)2023年GCCGGC右转Turn right左转Turn left vvva.右转a.Turn rightb.直行b.Go straightc.左转c.Turn left注:为虚拟探照灯的视域角,rad;C 为假想目标点;为 v 与 GC 之间的夹角,,rad。Note:isthevisua
25、langleofvirtualsearchlight,rad;Cistheimaginarytargetpoint;istheanglebetweenvandGC,rad.图 5基于虚拟探照灯的履带底盘转向示意图Fig.5Trackchassissteeringdiagrambasedonvirtualsearchlight设履带底盘导航路径坐标点序列 A1,A2,Ai,An,如图 6 所示,以 AiAi+1为期望路径进行分析,视域角的大小影响导航作业的稳定性,当履带底盘逐渐靠近期望路径时,视域角 不变,由于视场变小,则视域内可见的期望路径变短,类比于真实场景中驾驶员视野变窄,此时算法对横向偏
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 虚拟 探照灯 离合 制动 履带 底盘 跟踪
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。