The invention discloses a closed fruit garden tractors integrated navigation system, which includes ultra wideband positioning module, inertial measurement module, navigation line recognition module and control module. The invention uses the ultra wideband positioning module to obtain the lateral deviation of the tractors and the predetermined walking track; uses the inertial measurement module to obtain the heading deviation of the tractors and the predetermined walking track; uses the navigation line recognition module to obtain the lateral deviation and the direction angle deviation, and uses the control module to identify the ultra wideband positioning module and the navigation line. The transverse deviation obtained by the module is fused, and the direction angle deviation obtained by the inertial measurement module and the navigation line recognition module is fused, and the two navigation parameters of the lateral deviation and the heading deviation are obtained, and the decision is made using the control module to control the autonomous navigation of the tractors in the closed orchard. The invention integrates multiple sensor data, overcomes the problem of insufficient accuracy of single sensor in canopy orchard, and improves the stability and reliability of navigation.
【技术实现步骤摘要】
一种郁闭果园履带拖拉机组合导航系统
本专利技术涉及果园机械自动导航领域,具体涉及一种郁闭果园履带拖拉机组合导航系统。
技术介绍
我国是一个果业大国,果品种植面积和产量均居世界第一,其中仍有较多郁闭型果园,其特点是枝叶茂密,该类果业生产极大程度上依靠传统人工作业等落后的生产方式,生产效率低,亟需引入具有自主导航功能的智能农机装备,但是由于枝叶的遮挡,传统的GPS导航系统定位不可靠,且由于郁闭果园环境复杂,单一传感器在郁闭果园导航存在一定的局限性。
技术实现思路
为了解决上述技术问题,本专利技术提供一种郁闭果园履带拖拉机组合导航系统。本专利技术为了解决上述技术问题所采用的技术方案是:一种郁闭果园履带拖拉机组合导航系统,包括超宽带定位模块,惯性测量模块,导航线识别模块和控制模块。所述的超宽带定位模块由安装在郁闭果园内的基站和安装在履带拖拉机上的标签组成,通过测量标签和基站之间的距离,利用三点定位的方法确定标签的位置,根据预定轨迹计算得到拖拉机偏离预定轨迹的横向偏差。所述的惯性测量模块安装在履带拖拉机上,实时采集拖拉机的航向角信息,并根据预定轨迹的航向角计算得到航向角偏差。所述的导航线识别模块由安装在履带拖拉机上的摄像头和DSP数字图像处理器组成,通过摄像头实时采集郁闭果园包含导航路径的图像,经DSP数字图像处理器提取种植线的中线作为导航线,根据摄像头标定参数和坐标转换关系,计算获取横向偏差和航向角偏差。所述的控制模块将接收到的超宽带定位模块和导航线识别模块的横向偏差进行数据融合,将接收到的惯性测量模块和导航线识别模块的航向偏差进行数据融合,得到融合后的横向偏差和航向 ...
【技术保护点】
1.一种郁闭果园履带拖拉机组合导航系统,包括超宽带定位模块,惯性测量模块,导航线识别模块和控制模块,其特征在于:所述的超宽带定位模块由安装在郁闭果园内的基站和安装在履带拖拉机上的标签组成,通过测量标签和基站之间的距离,利用三点定位的方法确定标签的位置,根据预定轨迹计算得到拖拉机偏离预定行走轨迹的横向偏差;所述的惯性测量模块安装在履带拖拉机上,实时采集拖拉机的航向角信息,并根据预定行走轨迹的航向角计算得到航向角偏差;所述的导航线识别模块由安装在履带拖拉机上的摄像头和DSP数字图像处理器组成,通过摄像头实时采集郁闭果园包含导航路径的图像,经DSP数字图像处理器提取种植线的中线作为导航线,根据摄像头标定参数和坐标转换关系,计算获取横向偏差和航向角偏差;所述的控制模块包括控制器和电磁阀,控制器将接收到的超宽带定位模块和导航线识别模块的横向偏差进行数据融合,将接收到的惯性测量模块和导航线识别模块的航向偏差进行数据融合,得到融合后的横向偏差和航向偏差,然后根据这两个参数进行模糊控制决策,控制电磁阀的开闭时间从而控制履带拖拉机的行走与转向,从而实现郁闭果园内履带拖拉机自主导航控制。
【技术特征摘要】
1.一种郁闭果园履带拖拉机组合导航系统,包括超宽带定位模块,惯性测量模块,导航线识别模块和控制模块,其特征在于:所述的超宽带定位模块由安装在郁闭果园内的基站和安装在履带拖拉机上的标签组成,通过测量标签和基站之间的距离,利用三点定位的方法确定标签的位置,根据预定轨迹计算得到拖拉机偏离预定行走轨迹的横向偏差;所述的惯性测量模块安装在履带拖拉机上,实时采集拖拉机的航向角信息,并根据预定行走轨迹的航向角计算得到航向角偏差;所述的导航线识别模块由安装在履带拖拉机上的摄像头和DSP数字图像处理器组...
【专利技术属性】
技术研发人员:杨福增,谭晨佼,李轶林,
申请(专利权)人:西北农林科技大学,
类型:发明
国别省市:陕西,61
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。