1.一种多传感器融合的拖拉机导航控制系统的定位方法,所述的导航控制系统,包括上位机和下位机,所述的上位机和下位机通过串口通信模块相互连接,共同实现拖拉机位置精准定位和设定路径的精确跟踪;所述的上位机连接触摸屏、北斗定位接收模块、图像采集模块、位姿检测模块、串口通信模块;所述的下位机连接数据存储模块、压力检测模块、CAN通信模块、换向阀控制模块、电压检测模块、车速检测模块、车轮转角检测模块、电源模块、报警及紧急处理模块和串口通信模块;所述的换向阀控制模块分别与电压检测模块和液压转向系统电连接;所述的压力检测模块还与液压转向系统电连接,其特征在于:所述的定位方法,通过上位机对拖拉机进行定位,上位机通过串口通信模块发送给下位机用于路径跟踪的数据包括:当前航线偏移量、当前航向角偏移量、预估行驶距离、当前行驶速度、预估路径曲度;
所述的定位方法,包括如下步骤:
(1)通过触摸屏设定拖拉机工作田间模式:无农作物田地,有农作物田地;
(2)采用双天线的北斗接收装置,用北斗定位接收模块获取拖拉机的绝对位置、行驶速度和航向角信息;
(3)采用位姿检测模块获取拖拉机的航向角、横滚角、俯仰角数据,并依据这些数据对北斗定位信息进行修正,得到的拖拉机位置数据更精确;拖拉机当前航线偏移量、当前航向角偏移量、拖拉机预估路径曲度值由上位机通过北斗导航数据或图像数据计算输出;拖拉机参考车速VU(s)由上位机发送的车速VR(s)和车速采集VM(s)决定,按照如下公式确定:;
因拖拉机在低速行驶时,通过北斗导航获得的行驶速度其准确度低于车速检测模块获得的车速,所以在确定车速时,如果车速检测模块采集的车速VM(s)小于等于2米/秒或接收的上位机的车速VR(s)等于0时,则确定的参考车速为VM(s),这样可以避免因北斗导航在低速或故障时造成的速度误差;当车速检测模块采集的车速VM(s)大于2米/秒或车速检测模块出现故障时,确定参考车速为上位机发送车速VR(s);
(4)如果田间模式设定为无农作物田地,则关闭图像采集模块,不采用机器视觉定位方式;如果田间模式设定为有农作物田地,则开启图采集模块,对采集图像数据进行处理,并生成导航基准线、获取表征农作物特征的基本点;
(5)如果田间模式设定为无农作物田地,则完全采用经过位姿信息修正的北斗定位和路径数据;如果田间模式设定为有农作物田地,则采用模糊自适应扩展卡尔曼滤波器对北斗定位数据和机器视觉数据进行融合,其中北斗定位提供拖拉机的绝对位置坐标、航向角度和行驶速度,机器视觉提供导航路径中已知点的相对位置坐标,北斗定位系统和机器视觉系统坐标统一后,由滤波器对北斗提供的位置数据和机器视觉提供的位置数据进行滤波,生成精确的拖拉机位置数据和路径规划数据。