CN206224239U - 一种多传感器融合的拖拉机导航控制系统 - Google Patents
一种多传感器融合的拖拉机导航控制系统 Download PDFInfo
- Publication number
- CN206224239U CN206224239U CN201621322403.9U CN201621322403U CN206224239U CN 206224239 U CN206224239 U CN 206224239U CN 201621322403 U CN201621322403 U CN 201621322403U CN 206224239 U CN206224239 U CN 206224239U
- Authority
- CN
- China
- Prior art keywords
- module
- tractor
- host computer
- serial communication
- slave computer
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Landscapes
- Guiding Agricultural Machines (AREA)
Abstract
本实用新型公开了多传感器融合的拖拉机导航控制系统,包括上位机、下位机,上位机和下位机通过串口通信模块相互连接,上位机连接触摸屏、北斗定位接收模块、图像采集模块、位姿检测模块、串口通信模块;下位机连接数据存储模块、压力检测模块、CAN通信模块、换向阀控制模块、电压检测模块、车速检测模块、车轮转角检测模块、电源模块、报警及紧急处理模块和串口通信模块,液压转向系统分别与压力检测模块和换向阀控制模块相连接,电压检测模块还与换向阀控制模块相连接,具有精确的车辆定位和路径跟踪性能。
Description
技术领域
本实用新型涉及拖拉机自动导航领域,具体地讲,是一种多传感器融合的拖拉机导航控制系统。
背景技术
目前的农业作业中,通常由驾驶员独自操作,劳动强度大且重复单调,容易使人疲劳并产生误操作。农机自动导航技术是精细农业的一项重要技术,该技术可以自动获得导航路径并控制农业机械沿着目标路径行驶,辅助驾驶员操作农业机械进行作业。拖拉机自动导航是农业现代化的重要基础,实现拖拉机自动导航可以让农业作业者降低工作强度,并且能显著地提高农机的作业精度,提高农田的土地利用率,降低生产成本,提高作物产量与经济效益,将劳动者从繁重的农田作业中解放出来。
拖拉机导航技术在北美、日本和欧洲一些国家中研究起步较早,并取得了较多研究成果,国内的专家学者也做了广泛的研究,取得了一定的成果。如申请号为2014101751440的发明专利公开了一种对射式激光拖拉机辅助导航控制系统,授权号101833334A的发明专利公开了一种拖拉机自动导航控制系统及其方法,申请号为104656647A的发明专利公开了一种低矮作物田间自走拖拉机导航控制系统等。可以看出,采用的都是单一导航定位技术,比如GPS导航、激光发射导航技术等,每种导航方式各有优点,但是因单一导航技术受条件限制都存在一定的使用条件,很难能够提供连续、稳定高质量的定位信息;另外,目前拖拉机路径跟踪控制算法中,大多都仅仅将拖拉机航向角和偏移量做为被控量或参考量,但没有考虑到选取了拖拉机预估路径曲度和当前行驶速度;导致现有的技术方案往往只能保证直线行驶时的控制效果,而很难保证曲线行驶或拐弯时的路径跟踪效果。
实用新型内容
本实用新型要解决的技术问题是提供一种多传感器融合的拖拉机导航控制系统,具有精确的车辆定位和路径跟踪性能。
本实用新型采用如下技术方案实现实用新型目的:
一种多传感器融合的拖拉机导航控制系统,包括上位机和下位机,所述的上位机和下位机通过串口通信模块相互连接,实现拖拉机位置的精准定位和设定路径的精确跟踪;所述的上位机连接触摸屏、北斗定位接收模块、图像采集模块、位姿检测模块、串口通信模块;所述的下位机连接数据存储模块、压力检测模块、CAN通信模块、换向阀控制模块、电压检测模块、车速检测模块、车轮转角检测模块、电源模块、报警及紧急处理模块和串口通信模块。
(1)本技术方案中导航控制系统通过采用北斗定位和机器视觉定位相结合的方式,能够实现两种导航技术的优势互补,可以避免使用单一定位造成的车辆位置误差;组合导航功能既可以用在有作物的农田作业中也可以用在无作物的农田中,组合导航定位技术在可靠性、准确性等方面都较单独导航情况要好。(2)采用双天线的北斗信号接收装置,并且采用位姿检测模块的数据对北斗定位信息进行修正,得到的拖拉机位置数据更精确;(3)不仅选取了拖拉机当前航线偏移量、当前航向角偏移量,而且选取了拖拉机预估路径曲度和参考车速进行处理,使导航控制系统具有良好的路径控制效果。
拖拉机当前航线偏移量、当前航向角偏移量、拖拉机预估路径曲度值由上位机通过北斗导航数据或图像数据计算输出;拖拉机参考车速VU(s)由上位机发送的车速VR(s)和车速采集VM(s)决定,按照如下公式确定:
因拖拉机在低速行驶时,通过北斗导航获得的行驶速度其准确度低于车速检测模块获得的车速,所以在确定车速时,如果车速检测模块采集的车速VM(s)小于等于2公里/秒或接收的上位机的车速VR(s)等于0时,则确定的参考车速为VM(s),这样可以避免因北斗导航在低速或故障时造成的速度误差;当车速检测模块采集的车速VM(s)大于2公里/秒或车速检测模块出现故障时,确定参考车速为上位机发送车速VR(s)。
作为对本技术方案的进一步限定:
换向阀控制模块分别与电压检测模块和液压转向系统电连接。
压力检测模块还与液压转向系统电连接。
上位机采用EPCS-8980型工控机。
触摸屏选用四线电阻式触摸屏SV0804S-03。
北斗定位接收模块采用UM220模块。
图像采集模块由OKAC1310CCD摄像头和信号调理电路组成。
位姿检测模块选用AHRS-3000小型航姿测量模块。
下位机采用16位飞思卡尔单片机MC9S12XS128MAL。
数据存储模块采用两片32MB的SDRAM MT48LC4M32B2数据存储芯片。
压力检测模块由压力传感器MBS1250和信号调理电路组成。
CAN通信模块由TJA1043T芯片与其外围电路组成,通过该模块,下位机能够将根据预估行驶距离和预估路径曲度确定的拖拉机期望速度发送给拖拉机控制器,确保在拖拉机行驶至终点或拐弯时的控制效果,特别在当前航线偏移量OR(s)超过可允许最大航线偏移量OM时,通过该模块给拖拉机控制器发送停车信号。
换向阀控制模块由D/A转换芯片DAC0832、运算放大器LM358N及外围电路组成。
电压检测模块由运算放大器AD741和外围电路组成。
通过设计电压检测模块,能够对换向阀控制模块的输出电压实施闭环控制,通过实时检测输出电压,避免输出电压失控现象发生。
车速检测模块由测速传感器VB-Z9400及信号调理电路组成。
车轮转角检测模块由线位移传感器HPS-M1和信号调理电路组成。
电源模块由产生24V电压芯片LT4356IS、产生5V电压芯片LM7805、产生正负15电压芯片MD20-12D15、产生10V电压芯片AD581及外围电路组成。
串口通信模块由串口通信芯片MAX232芯片及其外围电路组成。
报警及紧急处理模块由喇叭、发光灯、光耦和继电器等组成。报警和紧急处理模块能够在液压阀运行至最大或当曲线路径弯度过大时发出报警信息并启动相应的紧急响应动作。
上位机通过串口通信模块发送给下位机用于路径跟踪的数据包括:当前航线偏移量、当前航向角偏移量、预估行驶距离、当前行驶速度、预估路径曲度。
多传感器融合的拖拉机导航控制系统的定位方法,通过上位机进行拖拉机定位,包括如下步骤:
(1)通过触摸屏设定拖拉机工作田间模式:无农作物田地,有农作物田地;
(2)采用双天线的北斗接收装置,用北斗定位接收模块获取拖拉机的绝对位置、行驶速度和航向角信息;
(3)采用位姿检测模块获取拖拉机的航向角、横滚角、俯仰角数据,并依据这些数据对北斗定位信息进行修正;
(4)如果田间模式设定为无农作物田地,则关闭图像采集模块,不采用机器视觉定位方式;如果田间模式设定为有农作物田地,则开启图采集模块,对采集图像数据进行处理,并生成导航基准线、获取表征农作物特征的基本点。
(5)如果田间模式设定为无农作物田地,则完全采用经过位姿信息修正的北斗定位和路径数据;如果田间模式设定为有农作物田地,则采用模糊自适应扩展卡尔曼滤波器对北斗定位数据和机器视觉数据进行融合,其中北斗定位提供拖拉机的绝对位置坐标、航向角度和行驶速度,机器视觉提供导航路径中已知点的相对位置坐标,北斗定位系统和机器视觉系统坐标统一后,由滤波器对北斗提供的位置数据和机器视觉提供的位置数据进行滤波,得到精确的位置数据和路径数据。
与目前多传感器融合技术中常用的扩展卡尔曼滤波器和无迹卡尔曼滤波器相比,模糊自适应扩展卡尔曼滤波算法能够通过实时得到的测量新息方差和理论方差的比值,并利用模糊自适应控制器不断调整量测噪声协方差阵的加权系数,减少校正位置误差,提高拖拉机定位数据的准确性和稳定性。
多传感器融合的拖拉机导航控制系统的控制方法,控制方法为路径跟踪控制,包括如下步骤:
(1)路径跟踪控制系统采用串级控制结构进行设计,其中主回路采取前馈加反馈控制方法,副回路采用单位负反馈方法,整个系统结构由偏移量设定值OS(s)、当前航线偏移量OR(s)、偏移量控制器C0(s)、转角控制器CS(s)、换向阀控制器CV(s)、电压采集VM(s)、转向系统G(s)、预估路径曲度PCR(s)、当前航向角偏移量AR(s)、航向角控制器CA(s)、车轮转角反馈A(s)、上位机发送的车速VR(s)、车速采集VM(s)、参考车速VU(s)组成;
(2)主回路中的反馈控制器为偏移量控制器C0(s),其设定值输入为偏移量设定值OS(s)和当前航线偏移量OR(s)的差值,偏移量控制器C0(s)的输出为转向角度θFB,通过如下公式计算:
其中ΔO=OS(s)-OR(s),KFB1为偏移量控制器比例系数,KFB2为偏移量控制器微分系数,KFB3为偏移量控制器二阶微分系数。因拖拉机路径跟踪的直接控制量是航线偏移量,本实用新型通过对偏移量差值实施比例、微分和二阶微分的控制,可减少控制过程中的超调,克服振荡现象发生;通过设定可允许最大航线偏移量OM,可使拖拉机在航线偏差超过可允许范围时不再继续执行转向,并且控制偏移量控制器输出为0,避免损坏液压阀或安全事故发生;
(3)主回路中的前馈控制器为航向角控制器CA(s),其参考输入为预估路径曲度PCR(s)、当前航向角偏移量AR(s)和当前航线偏移量OR(s),航向角控制器CA(s)的输出为转向角度θFF,通过如下公式计算:
其中KFF1为航向角控制器路径曲度控制比例系数,KFF2为航向角控制器比例系数,KFF3为航向角控制器微分比例系数。在航线偏移量允许值OP范围内,通过将航向角作为参考量,可实施预先控制,减少路径跟踪过程的波动;将预估路径曲度作为参考量,可实现曲线行驶或拐弯时的预先控制,提高非直线路径的跟踪效果。
(4)副回路控制器为转角控制器CS(s),其设定值为θFB与θFF之和与车轮转角反馈A(s)的差值,参考输入量为车轮转角反馈A(s)和参考车速VU(s),其中参考车速VU(s)由上位机发送的车速VR(s)和车速采集VM(s)决定,按照如下公式确定参考车速:
转角控制器CS(s)的输出为车轮转角设定值θ,通过如下公式计算:其中Kθ为转角控制器CS(s)的比例系数。因拖拉机在低速行驶时,通过北斗导航获得的行驶速度其准确度低于车速检测模块获得的车速,所以在确定车速时,如果车速检测模块采集的车速VM(s)小于等于2公里/秒或接收的上位机的车速VR(s)等于0时,则确定的参考车速为VM(s),这样可以避免因北斗导航在低速或故障时造成的速度误差;当车速检测模块采集的车速VM(s)大于2公里/秒或车速检测模块出现故障时,确定参考车速为上位机发送车速VR(s)。将车速信号作为确定车轮转角设定值的参数,可减少系统调整时间;
(5)换向阀控制器CV(s)的设定值为车轮转角设定值θ,其通过换向阀控制模块输出负10V至正10V范围的电压控制液压转向系统实施转向。
与现有技术相比,本实用新型在控制量和参考量设定时,不仅选取了拖拉机当前航线偏移量、当前航向角偏移量,而且选取了拖拉机预估路径曲度和当前行驶速度,提出的拖拉机路径跟踪串级控制结构,主回路采取前馈加反馈控制方法,副回路采取单位负反馈方法,该控制方法不仅保证直线行驶时的路径跟踪效果,而且在拐弯时也具有很高的控制精度。
附图说明
图1为本实用新型的原理框图。
图2为本实用新型所采用的控制方法结构示意图。
图3为本实用新型的换向阀控制模块的电路原理图。
图4为本实用新型的电压检测模块的电路原理图。
图5为本实用新型的车速检测模块的电路原理图。
图6为本实用新型的转角检测模块的电路原理图。
附图标记说明:1-触摸屏;2-数据存储模块;3-压力检测模块;4-北斗定位接收模块;5-上位机;6-报警及紧急处理模块;7-下位机;8-CAN通信模块;9-图像采集模块;10-串口通信模块;11-换向阀控制模块;12-液压转向系统;13-拖拉机;14-位姿检测模块;15-电源模块;16-车速检测模块;17-车轮转角检测模块;18-电压检测模块。
具体实施方式
为了使本实用新型的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本实用新型进行进一步详细说明。此处所描述的具体实施例仅用以解释本实用新型,并不用于限定本实用新型。本实用新型涵盖任何由权利要求定义的在本实用新型的精髓和范围上做的替代、修改、等效方法及方案。为了使公众对本实用新型有更好的了解,在具体实施方式中对本实用新型的细节描述中,详尽描述了一些特定的细节部分,对于未描述的部分,均为本领域技术的常规技术。
结合图1、图2可知,本实用新型实施例提供了一种多传感器融合的拖拉机导航控制系统,由上位机5和下位机7组成,上位机5和下位机7通过串口通信模块10相互连接,实现拖拉机13位置的精准定位和设定路径的精确跟踪;所述的上位机5连接触摸屏1、北斗定位接收模块4、图像采集模块9、位姿检测模块14、串口通信模块10;所述的下位机7连接数据存储模块2、压力检测模块3、CAN通信模块8、换向阀控制模块11、电压检测模块、车速检测模块16、车轮转角检测模块17、电源模块15、报警及紧急处理模块6和串口通信模块10;换向阀控制模块11分别与电压检测模块18和液压转向系统12电连接,压力检测模块3还与液压转向系统12电连接。
本实用新型中上位机5选用EPCS-8980型工控机,它是整个导航系统中进行车辆位置信息处理的核心部件以及人机对话的中心,与触摸屏1结合完成田间模式设定、导航参数配置、路径下载、导航任务设定、路径规划、车辆运行轨迹实时显示等功能。
触摸屏1与上位机5通过功能引脚相互连接,作为拖拉机13作业时的人机交互界面,可实现导航模式选择、导航参数输入和车辆运行轨迹显示等功能,方便操作人员对拖拉机13导航系统工作状态进行判断,本实用新型选用四线电阻式触摸屏1SV0804S-03。
北斗定位接收模块4与上位机5通过串行通信引脚相互连接,本实用新型采用UM220模块接收北斗卫星信号用来确定车辆位置,因采用的是北斗常规接收技术,在此不再赘述。
图像采集模块9与上位机5通过串行通信引脚相互连接,由OKAC1310CCD摄像头采集农作物图像,经过信号调理电路后经串口送至上位机5,经灰度变换、图像分割、图像去噪后提取出导航基准线,确定导航路径特征值。
位姿检测模块14与上位机5通过串行通信引脚相互连接,选用AHRS-3000小型航姿测量模块将拖拉机13动静态环境下的横滚角、俯仰角和航向角通过串口发送至上位机5,上位机5利用这些参数对北斗定位数据进行补偿,可减少或避免因受地面起伏影响车体产生倾斜而导航的定位误差。
下位机7采用16位飞思卡尔单片机MC9S12XS128MAL,是拖拉机13路径跟踪控制的核心,通过串口通信模块10接收上位机5发送的拖拉机13位置信息并经过控制运算后,由换向阀控制模块11输出电压信号实现对液压转向系统12的控制。
数据存储模块2,采用两片32MB的SDRAM MT48LC4M32B2,分别与飞思卡尔单片机通过功能引脚相互连接,用于存储导航状态信息和控制输出信息,方便后期对导航系统工作效果进行评估和分析。
压力检测模块3与下位机7和液压转向系统12电连接,用于判断拖拉机13的驾驶模式,由安装在导航阀组上的压力传感器MBS1250检测阀组压力并转换成电压信号送至下位机7的数字量输入口,传感器输出低压信号表示拖拉机13处于自动导航模式,传感器输出高压信号表示拖拉机13处于人工驾驶模式。
CAN通信模块8由TJA1043T芯片与其外围电路组成,通过该模块,下位机7能够将根据预估行驶距离和预估路径曲度确定的拖拉机13期望速度发送给拖拉机控制器,确保在拖拉机13行驶至终点或拐弯时的控制效果,特别在当前航线偏移量OR(s)超过可允许最大航线偏移量OM时,通过该模块给拖拉机控制器发送停车信号。
结合图3可知,换向阀控制模块11分别与电压检测模块18和液压转向系统12电连接,选用D/A转换芯片DAC0832输出0-255的数字量,该数字量经过放大器U18-U21产生正10V至负10V范围内的电压用于控制换向电磁阀,实现对液压转向系统12的控制。本实用新型选用4WRA6E20-10B/24Z4型号的比例方向阀。
结合图4可知,电压检测模块18由运算放大器和外围电路组成,通过设计电压检测模块,能够对换向阀控制模块11的输出电压实施闭环控制,通过实时检测输出电压,避免输出电压失控现象发生。
结合图5可知,车速检测模块16与下位机7的中断输入口相连接,该模块由测速传感器和调理电路组成,测速传感器选用VB-Z9400霍尔转速传感器,它通过感应导磁体上凸起的齿或是凹下的槽,输出方波信号,该方波信号经过四分之一个LM339和电阻R38,R39,R40构成的滞回比较电路去除噪声干扰,送至下位机7的外部中断引脚,下位机7通过下降沿触发的外部中断方式对车速信号进行捕捉。
结合图6可知,车轮转角检测模块17与下位机7电连接,该模块用于完成对车轮转角的实时检测,选用HPS-M1型线位移传感器将车轮转角信号转换成电压信号后经过电阻R13和电容C11滤波后进入放大器U12的反向输入端,放大器U12的正向输入端经电阻R15接地,U12的输出端经电阻R14后接入其反向输入端,同时U12的输出端经电阻R16后接入放大器U13的反向输入端,放大器U13的同向输入端经电阻R18后接地,U13的输出端经电阻R17后接入其反向输入端,同时与下位机7的模拟量输入口PA5相接。
电源模块15与下位机7电连接,由车载蓄电池供电,分别经过LT4356IS电路和LM7805电路产生24V防浪涌电压和5V电压,经过MD20-12D15模块产生正负15的电压,经过AD581产生10V的基准电压,为保证下位机7系统的供电电压不至于过高或过低,设计了电源监控保护电路。
串口通信模块10分别与上位机5和下位机7相连接,该模块由串口通信芯片MAX232芯片及其外围电路组成,通过串口通信模块10可完成下位机7和上位机5的数据交换。
报警及紧急处理模块6与下位机7电连接,用于在液压阀运行至最大或当曲线路径弯度过大时,下位机7可以控制继电器打开,使与蜂鸣器和发光灯相连的引脚为高电平,发出报警信息,并且控制输出电压为零使换向阀回归中心位置,同时置位手动模式。
上位机5通过串口通信模块10发送给下位机7用于路径跟踪的数据包括:当前航线偏移量、当前航向角偏移量、预估行驶距离、当前行驶速度、预估路径曲度。
多传感器融合的拖拉机导航控制系统的定位方法,通过上位机5对拖拉机13进行定位,包括如下步骤:
(1)通过触摸屏1设定拖拉机13工作田间模式:无农作物田地,有农作物田地;
(2)采用双天线的北斗接收装置,用北斗定位接收模块4获取拖拉机13的绝对位置、行驶速度和航向角信息;
(3)采用位姿检测模块14获取拖拉机13的航向角、横滚角、俯仰角数据,并依据这些数据对北斗定位信息进行修正;
(4)如果田间模式设定为无农作物田地,则关闭图像采集模块9,不采用机器视觉定位方式;如果田间模式设定为有农作物田地,则开启图像采集模块9,对采集图像数据进行处理,并生成导航基准线、获取表征农作物特征的基本点。
(5)如果田间模式设定为无农作物田地,则完全采用经过位姿信息修正的北斗定位和路径数据;如果田间模式设定为有农作物田地,则采用模糊自适应扩展卡尔曼滤波器对北斗定位数据和机器视觉数据进行融合,其中北斗定位提供拖拉机13的绝对位置坐标、航向角度和行驶速度,机器视觉提供导航路径中已知点的相对位置坐标,北斗定位系统和机器视觉系统坐标统一后,由滤波器对北斗提供的位置数据和机器视觉提供的位置数据进行滤波,得到精确的位置数据和路径数据。
与目前多传感器融合技术中常用的扩展卡尔曼滤波器和无迹卡尔曼滤波器相比,模糊自适应扩展卡尔曼滤波算法能够通过实时得到的测量新息方差和理论方差的比值,并利用模糊自适应控制器不断调整量测噪声协方差阵的加权系数,减少校正位置误差,提高拖拉机13定位数据的准确性和稳定性。
一种多传感器融合的拖拉机导航控制系统的控制方法,控制方法为路径跟踪控制,包括如下步骤:
(1)路径跟踪控制系统采用串级控制结构进行设计,其中主回路采取前馈加反馈控制方法,副回路采用单位负反馈方法,整个系统结构由偏移量设定值OS(s)、当前航线偏移量OR(s)、偏移量控制器C0(s)、转角控制器CS(s)、换向阀控制器CV(s)、电压采集VM(s)、转向系统G(s)、预估路径曲度PCR(s)、当前航向角偏移量AR(s)、航向角控制器CA(s)、车轮转角反馈A(s)、上位机5发送的车速VR(s)、车速采集VM(s)、参考车速VU(s)组成;
(2)主回路中的反馈控制器为偏移量控制器C0(s),其设定值输入为偏移量设定值OS(s)和当前航线偏移量OR(s)的差值,偏移量控制器C0(s)的输出为转向角度θFB,通过如下公式计算:
其中ΔO=OS(s)-OR(s),KFB1为偏移量控制器比例系数,KFB2为偏移量控制器微分系数,KFB3为偏移量控制器二阶微分系数。因拖拉机13路径跟踪的直接控制量是航线偏移量,本实用新型通过对偏移量差值实施比例、微分和二阶微分的控制,可减少控制过程中的超调,克服振荡现象发生;通过设定可允许最大航线偏移量OM,可使拖拉机13在航线偏差超过可允许范围时不再继续执行转向,并且控制偏移量控制器输出为0,避免损坏液压阀或安全事故发生;
(3)主回路中的前馈控制器为航向角控制器CA(s),其参考输入为预估路径曲度PCR(s)、当前航向角偏移量AR(s)和当前航线偏移量OR(s),航向角控制器CA(s)的输出为转向角度θFF,通过如下公式计算:
其中KFF1为航向角控制器路径曲度控制比例系数,KFF2为航向角控制器比例系数,KFF3为航向角控制器微分比例系数。在航线偏移量允许值OP范围内,通过将航向角作为参考量,可实施预先控制,减少路径跟踪过程的波动;将预估路径曲度作为参考量,可实现曲线行驶或拐弯时的预先控制,提高非直线路径的跟踪效果。
(4)副回路控制器为转角控制器CS(s),其设定值为θFB与θFF之和与车轮转角反馈A(s)的差值,参考输入量为车轮转角反馈A(s)和参考车速VU(s),其中参考车速VU(s)由上位机5发送的车速VR(s)和车速采集VM(s)决定,按照如下公式确定参考车速:
转角控制器CS(s)的输出为车轮转角设定值θ,通过如下公式计算:其中Kθ为转角控制器CS(s)的比例系数。因拖拉机13在低速行驶时,通过北斗导航获得的行驶速度其准确度低于车速检测模块16获得的车速,所以在确定车速时,如果车速检测模块16采集的车速VM(s)小于等于2公里/秒或接收的上位机5的车速VR(s)等于0时,则确定的参考车速为VM(s),这样可以避免因北斗导航在低速或故障时造成的速度误差;当车速检测模块16采集的车速VM(s)大于2公里/秒或车速检测模块16出现故障时,确定参考车速为上位机5发送车速VR(s)。将车速信号作为确定车轮转角设定值的参数,可减少系统调整时间。
(5)换向阀控制器CV(s)的设定值为车轮转角设定值θ,其通过换向阀控制模块11输出负10V至正10V范围的电压控制液压转向系统12实施转向。
与现有技术相比,本实用新型在控制量和参考量设定时,不仅选取了拖拉机13当前航线偏移量、当前航向角偏移量,而且选取了拖拉机13预估路径曲度和当前行驶速度。提出的拖拉机13路径跟踪串级控制结构,主回路采取前馈加反馈控制方法,副回路采取单位负反馈方法,该控制方法不仅保证直线行驶时的路径跟踪效果,而且在拐弯时也具有很高的控制精度。
最后应说明的是:以上所述仅为本实用新型的优选实施例而已,并不用于限制本实用新型,尽管参照前述实施例对本实用新型进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换。凡在本实用新型的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本实用新型的保护范围之内。
Claims (2)
1.一种多传感器融合的拖拉机导航控制系统,包括上位机和下位机,其特征在于:所述的上位机和下位机通过串口通信模块相互连接,上位机连接触摸屏、北斗定位接收模块、图像采集模块、位姿检测模块、串口通信模块;下位机连接数据存储模块、压力检测模块、CAN通信模块、换向阀控制模块、电压检测模块、车速检测模块、车轮转角检测模块、电源模块、报警及紧急处理模块和串口通信模块;所述的换向阀控制模块分别与电压检测模块和液压转向系统电连接;所述的压力检测模块还与液压转向系统电连接。
2.根据权利要求1所述的一种多传感器融合的拖拉机导航控制系统,其特征在于:所述的上位机通过串口通信模块发送给下位机用于路径跟踪的数据包括:当前航线偏移量、当前航向角偏移量、预估行驶距离、当前行驶速度、预估路径曲度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201621322403.9U CN206224239U (zh) | 2016-12-05 | 2016-12-05 | 一种多传感器融合的拖拉机导航控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201621322403.9U CN206224239U (zh) | 2016-12-05 | 2016-12-05 | 一种多传感器融合的拖拉机导航控制系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN206224239U true CN206224239U (zh) | 2017-06-06 |
Family
ID=58784372
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201621322403.9U Expired - Fee Related CN206224239U (zh) | 2016-12-05 | 2016-12-05 | 一种多传感器融合的拖拉机导航控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN206224239U (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108181909A (zh) * | 2018-01-30 | 2018-06-19 | 青岛河澄知识产权有限公司 | 一种用于无人驾驶机车的行进线路规划装置 |
CN113899363A (zh) * | 2021-09-29 | 2022-01-07 | 北京百度网讯科技有限公司 | 车辆的定位方法、装置及自动驾驶车辆 |
-
2016
- 2016-12-05 CN CN201621322403.9U patent/CN206224239U/zh not_active Expired - Fee Related
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108181909A (zh) * | 2018-01-30 | 2018-06-19 | 青岛河澄知识产权有限公司 | 一种用于无人驾驶机车的行进线路规划装置 |
CN113899363A (zh) * | 2021-09-29 | 2022-01-07 | 北京百度网讯科技有限公司 | 车辆的定位方法、装置及自动驾驶车辆 |
US11953609B2 (en) | 2021-09-29 | 2024-04-09 | Beijing Baidu Netcom Science Technology Co., Ltd. | Vehicle positioning method, apparatus and autonomous driving vehicle |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106502252A (zh) | 多传感器融合的拖拉机导航控制系统及其定位、控制方法 | |
US6445983B1 (en) | Sensor-fusion navigator for automated guidance of off-road vehicles | |
CN103287549B (zh) | 一种智能水质监测与水面清理船 | |
CN102789233B (zh) | 基于视觉的组合导航机器人及导航方法 | |
CN107607093B (zh) | 一种基于无人艇的湖泊动态库容的监测方法 | |
CN109471432B (zh) | 一种自主导航农用车最短避障路径规划方法 | |
CN101866181A (zh) | 农用机械的导航方法、导航装置和农用机械 | |
CN113359710B (zh) | 一种基于los理论的农机路径跟踪方法 | |
CN105987696A (zh) | 一种低成本车辆自动驾驶设计实现方法 | |
CN109115225A (zh) | 一种无人作业谷物联合收割机导航方法与导航装置 | |
CN109073763A (zh) | 测位检测装置、以及具备测位检测装置的工作机 | |
CN205581642U (zh) | 一种基于stm32的无人艇自适应舵机控制系统 | |
CN206224239U (zh) | 一种多传感器融合的拖拉机导航控制系统 | |
CN206696705U (zh) | 基于模糊控制的农机车载导航控制器 | |
CN105387858B (zh) | 一种游艇智能导航系统及工作方法 | |
CN106325287A (zh) | 一种基于惯性/磁传感器marg姿态检测的智能割草机直线行走控制系统 | |
CN110530361A (zh) | 一种基于农业机械双天线gnss自动导航系统的转向角度估计器 | |
CN112558642A (zh) | 一种适用于异构多无人系统的海空联合围捕方法 | |
CN109572857A (zh) | 一种麦克纳姆轮智能仓储agv及其路径规划方法 | |
Jun et al. | Autonomous driving system design for formula student driverless racecar | |
CN115903800A (zh) | 一种基于领导者协同的多无人船编队的严格安全控制方法 | |
CN203268293U (zh) | 水质监测与水面清理船 | |
CN113960994A (zh) | 一种多无人艇协同航行的s面自适应控制算法 | |
CN108287538A (zh) | 一种基于rtk技术无人驾驶船系统 | |
Lenain et al. | Sideslip angles observer for vehicle guidance in sliding conditions: Application to agricultural path tracking tasks |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170606 Termination date: 20191205 |