一种父本水稻植株粉碎作业的自主导航方法、系统及设备
本发明属于农业机械自主导航与杂交水稻制种作业控制,具体涉及一种利用互补图像特征解析父本作物行、在rtk导航和视觉导航之间分段切换并约束粉碎刀具作业范围的自主导航方法、系统及设备。
背景技术:
1、杂交水稻制种过程中,父本植株完成授粉作用后需要在母本收获前及时清除。父本按照单行间隔设置在母本种植区域之间,父本行作业空间较窄,粉碎设备发生横向偏移或转弯扫掠时容易伤及相邻母本。
2、rtk定位能够提供连续的全局位置,但其按照预先记录的路径进行引导,不能直接反映作物实际倒伏、缺苗、种植偏差及母本侵入情况。视觉导航能够获得设备相对作物行的位置关系,但单一颜色或亮度特征容易受到光照变化、积水反光、杂草和叶片遮挡影响。
3、现有组合导航往往对rtk误差和视觉误差进行固定融合,或者仅根据车辆中心点跟踪导航线。在父本粉碎作业中,作物行内需要视觉贴合作物结构,地头和无作物区又需要rtk全局引导;同时安全判断对象应当包括粉碎刀具的预测扫掠范围,而不能只判断车体中心。
4、因此,需要一种不依赖特定图像识别模型、能够利用互补图像特征提取作物行,并根据作业分段在视觉和rtk之间平稳切换的导航方法;该方法还应将父本标签、母本保护边界和刀具作业包络用于粉碎安全联锁。
技术实现思路
1、有鉴于此,本发明的目的在于提供一种父本水稻植株粉碎作业的自主导航方法、系统及设备,以兼顾地头及无作物区的全局引导、父本行内的局部对行和相邻母本保护,以期部分或全部解决上述背景技术中所指出的技术问题。
2、为达到上述目的,本发明之一提供如下技术方案:
3、一种父本水稻植株粉碎作业的自主导航方法,包括:获取带父本属性标签的种植轨迹、父本水稻植株粉碎设备前方的图像及其深度数据、rtk定位数据、左右履带轮速和机型标定参数;
4、根据所述rtk定位数据和左右履带轮速确定车体位姿;
5、根据所述图像中的至少两种互补图像特征生成植被特征区域,从所述植被特征区域中提取不同尺度的作物特征,并利用所述深度数据将作物特征转换至地面坐标系,对地面坐标系中的作物特征进行分行,
6、根据所述种植轨迹中的父本属性标签、种植行序和各作物行的空间位置确定目标父本行、父本中心线及与目标父本行相邻的母本边界;
7、根据所述母本边界、机型标定参数和导航不确定度生成安全走廊,根据父本中心线和带父本属性标签的种植轨迹生成位于安全走廊内的约束导航路径,并根据预测车体位姿和粉碎刀具相对车体的安装位置确定粉碎刀具预测扫掠包络;
8、在目标父本行之外采用rtk导航模式,在目标父本行内且视觉有效时采用视觉主导导航模式,在目标父本行内视觉无效且rtk有效时切换至rtk接管模式;仅在视觉主导导航模式下,且父本行匹配条件、视觉有效条件、安全净距条件和粉碎刀具预测扫掠包络条件均满足时,允许粉碎机构启动或保持运转;
9、进入rtk导航模式或rtk接管模式时关闭粉碎机构。
10、进一步地,所述种植轨迹包括按时间或里程排序的地理坐标、航向、作物属性标签、种植行标识和种植行序;根据种植轨迹确定目标父本行、位于目标父本行左右两侧的相邻母本行以及父本行端点,并根据父本行端点生成地头转行路径和导航模式分段。
11、进一步地,建立以车体平面位置和航向为状态量、以左右履带轮速为控制输入的差速运动模型,根据左右履带轮速进行状态预测,并利用rtk输出的位置、航向和定位质量更新状态量,获得车体位姿及表示车体位姿不确定度的状态信息。
12、进一步地,生成所述植被特征区域包括:对图像进行平滑去噪;分别根据第一颜色特征和第二植被增强特征生成两个候选植被区域;根据候选植被区域的互补关系和置信判据生成融合植被区域;对融合植被区域进行区域连通处理和小区域过滤,得到所述植被特征区域。
13、进一步地,对所述植被特征区域建立至少两个不同尺度的图像层级,在各图像层级提取作物关键点并抑制空间重复的关键点,将各图像层级的关键点转换到统一图像坐标;利用深度数据和相机标定参数得到关键点的空间位置,根据种植轨迹对应的预计行数对关键点进行空间分组,并按照关键点组与父本标签轨迹的距离及行序一致性确定目标父本行,当目标父本行特征缺失而其两侧作物行有效时,根据两侧作物行确定虚拟父本中心线。
14、进一步地,根据与目标父本行相邻的作物特征组在植被特征区域中的内侧连续边界确定所述母本边界;根据粉碎刀具相对车体参考点的侧向作业范围以及由定位误差、边界拟合误差、路径跟踪误差和制动距离确定的安全裕量,将两侧母本边界分别向目标父本行一侧收缩,得到用于约束车体参考点的安全走廊。
15、进一步地,rtk导航模式与视觉主导导航模式之间以及视觉主导导航模式与rtk接管模式之间通过连续变化的切换权重进行过渡;将rtk路径对应的跟踪误差和父本中心线对应的跟踪误差转换到统一坐标系,并按照所述切换权重得到过渡跟踪误差,所述切换权重的变化率受预设上限约束。
16、进一步地,根据约束导航路径或过渡跟踪误差选择预瞄目标,确定期望线速度和期望角速度,并转换为左右履带目标速度;在预测时域内根据左右履带目标速度外推车体位姿,将粉碎刀具在各预测车体位姿下的作业范围求并集,得到粉碎刀具预测扫掠包络;所述预测扫掠包络进入母本保护区域时降低速度或调整预瞄目标,重新计算后仍进入母本保护区域时关闭粉碎机构并制动。
17、本发明之二提供如下技术方案:
18、一种用于执行如上所述的一种父本水稻植株粉碎作业的自主导航方法的自主导航系统,包括:
19、数据获取模块,用于获取带父本属性标签的种植轨迹、图像及其深度数据、rtk定位数据、左右履带轮速和机型标定参数;
20、位姿确定模块,用于根据rtk定位数据和左右履带轮速确定车体位姿;
21、植被特征提取模块,用于根据至少两种互补图像特征生成植被特征区域并提取不同尺度的作物特征;
22、作物行空间解析模块,用于将作物特征转换至地面坐标系,对作物特征进行分行,并根据父本属性标签、种植行序和空间位置确定父本中心线及相邻母本边界;
23、安全规划模块,用于生成安全走廊、约束导航路径及粉碎刀具预测扫掠包络;
24、导航模式管理模块,用于在rtk导航模式、视觉主导导航模式和rtk接管模式之间切换;
25、以及作业安全联锁模块,用于仅在视觉主导导航模式及各安全条件满足时允许粉碎机构运转,并在rtk导航模式、rtk接管模式或安全条件不满足时关闭粉碎机构。
26、本发明之三提供如下技术方案:
27、一种父本水稻植株粉碎设备,用于装载如上所述的自主导航系统执行如前所述的一种父本水稻植株粉碎作业的自主导航方法,包括:差速履带底盘、车体、父本植株粉碎机构、rgb-d图像采集单元、rtk接收单元、左右履带轮速编码器、控制器、制动单元和报警单元;所述rgb-d图像采集单元、rtk接收单元及左右履带轮速编码器均与控制器通信连接;所述控制器分别与差速履带底盘的左右驱动单元、父本植株粉碎机构、制动单元和报警单元控制连接。
28、本发明的有益效果在于:
29、1、采用两套互补图像特征融合生成植被区域,降低光照、积水、杂草对作物分割的干扰;采用多尺度关键点提取,兼顾远近不同距离作物特征提取效果;
30、2、不依靠图像颜色直接区分父本母本,视觉仅提取作物行几何结构,父本身份依靠预存标签轨迹+行序一致性校验联合确认,避免田间环境变化造成父母本识别混淆;父本行缺苗断垄工况可生成虚拟父本中心线用于低速对行,同时强制锁止粉碎机构,保障安全;
31、3、安全走廊构建时叠加刀具侧向作业宽度、定位、拟合、跟踪、制动多重安全裕量;以预测时域内粉碎刀具扫掠包络(而非车体本体)作为安全约束对象,从源头规避刀具扫掠误伤母本;
32、4、设置rtk导航模式、视觉主导导航模式、rtk接管模式三种业务模式;模式之间采用带变化率上限的连续权重平滑过渡,避免硬切换带来底盘冲击抖动;专门设置rtk接管模式,行内视觉失效时禁止粉碎,仅允许低速撤离,区别于普通直接切全局rtk的方案;
33、5、设置多条件耦合的安全联锁机制,导航模式、父本行身份校验、视觉质量、安全走廊、刀具扫掠包络全部作为粉碎机构开启的必要条件;视觉恢复后需要人工确认,避免视觉瞬时跳变误触发粉碎,完整实现母本植株保护;
34、总之,本发明针对杂交水稻制种父本粉碎特有工况,将感知、空间规划、导航模式控制、作业机构安全联锁闭环结合,显著降低母本误切割风险,适配倒伏、缺苗、光照变化等复杂田间条件。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com