一种猪场巡检机器人的自适应对位控制方法、装置及设备与流程
本发明涉及智能巡检机器人,具体为一种猪场巡检机器人的自适应对位控制方法、装置及设备。
背景技术:
1、随着规模化养殖的发展,猪场对猪只健康状态和饲喂状态的自动化监测需求日益迫切。传统人工巡检存在劳动强度大、效率低、主观性强且易传播疫病等问题,业界逐渐采用自主移动的巡检机器人替代人工巡检。典型的猪场巡检机器人多为轮式机器人,其通过激光雷达扫描构建猪场栋舍环境地图,在地图上设定巡检路线和巡检点位,并通过软件设置定时巡检任务,从而自动导航至各巡检点位执行巡检。为提升检测能力,此类机器人通常在可升降且可旋转的云台上集成可见光摄像头、红外摄像头和深度摄像头,通过多模态数据融合来估算猪只相关的检测指标。
2、在现有巡检作业方式中,机器人依托导航定位到达预设点位后,通常采用固定或简单调整的拍摄高度和角度采集数据,数据的采集几何关系较大程度依赖于机器人驻停位置的准确性以及拍摄位姿与目标实际位置之间的匹配程度。然而,在猪场实际场景中,受导航定位偏差、被检测目标位置变化、地面条件以及栋舍建筑差异等多种因素影响,机器人难以稳定保证理想的采集几何关系。若仅依靠导航停车将机器人大致送至地图坐标点,并在固定高度和角度下采集数据,容易导致采集数据不完整、不准确,进而影响后端算法对各项检测指标的估算准确性。因此,现有技术缺乏一种能够在驻停后适应猪场复杂现场条件、自动获得高质量采集数据的对位控制方案。
技术实现思路
1、本发明目的在于提供一种猪场巡检机器人的自适应对位控制方法、装置及设备,旨在解决现有猪场巡检机器人因采用固定采集位姿而难以适应猪场复杂现场条件、导致检测结果准确性不高等问题。
2、为实现上述目的,本发明提供一种猪场巡检机器人的自适应对位控制方法,所述方法包括:
3、获取巡检任务,所述巡检任务包括当前巡检点位对应的检测项、每个检测项对应的检测类别以及每个检测项对应配置的云台高度区间和云台角度区间;
4、控制巡检机器人沿预先建立的地图导航至当前巡检点位,并在巡检机器人的位姿进入导航容差时驻停;
5、对于每一检测项,在对应的所述云台高度区间内按照预设高度步距确定多个高度档位,并在对应的所述云台角度区间内按预设角度步距确定多个角度档位,将各所述高度档位与各所述角度档位组合形成多个采集位姿;
6、控制巡检机器人的云台依次运动至各所述采集位姿,在每个采集位姿同步采集包括可见光图像、红外图像和深度图像的多模态数据,并基于预先标定的内参和外参建立多模态数据的空间对齐关系,得到每个所述采集位姿对应的多模态对齐数据;
7、对每个所述采集位姿对应的所述多模态对齐数据执行所述检测项对应的检测,得到对应各所述采集位姿的检测结果,根据所述检测项所属的检测类别从各所述采集位姿的检测结果中确定所述检测项的最终检测结果。
8、为实现上述目的,本发明提供一种猪场巡检机器人的自适应对位控制装置,所述装置包括:
9、获取任务单元,用于获取巡检任务,所述巡检任务包括当前巡检点位对应的检测项、每个检测项对应的检测类别以及每个检测项对应配置的云台高度区间和云台角度区间;
10、导航单元,用于控制巡检机器人沿预先建立的地图导航至当前巡检点位,并在巡检机器人的位姿进入导航容差时驻停;
11、位姿生成单元,用于对于每一检测项,在对应的所述云台高度区间内按照预设高度步距确定多个高度档位,并在对应的所述云台角度区间内按预设角度步距确定多个角度档位,将各所述高度档位与各所述角度档位组合形成多个采集位姿;
12、对齐单元,用于控制巡检机器人的云台依次运动至各所述采集位姿,在每个采集位姿同步采集包括可见光图像、红外图像和深度图像的多模态数据,并基于预先标定的内参和外参建立多模态数据的空间对齐关系,得到每个所述采集位姿对应的多模态对齐数据;
13、检测结果确定单元,用于对每个所述采集位姿对应的所述多模态对齐数据执行所述检测项对应的检测,得到对应各所述采集位姿的检测结果,根据所述检测项所属的检测类别从各所述采集位姿的检测结果中确定所述检测项的最终检测结果。
14、为了实现上述目的,本发明还提出一种猪场巡检机器人的自适应对位控制设备,包括处理器、存储器以及存储在所述存储器内的计算机程序,所述计算机程序被所述处理器执行以实现如上述实施例所述的一种猪场巡检机器人的自适应对位控制方法的步骤。
15、有益效果:
16、以上方案,通过获取包含检测项、检测类别、云台高度区间和云台角度区间的巡检任务,使机器人能够针对不同巡检点位和不同检测项分别配置采集范围;在驻停后,按照高度步距和角度步距在受限区间内形成多个采集位姿,并由云台依次运动采集可见光、红外和深度三模态数据,建立空间对齐关系,得到多模态对齐数据;最后对每个采集位姿执行检测,并根据检测类别从各采集位姿的检测结果中确定最终检测结果。由此,机器人不再依赖单一固定位姿采集,而是能够在驻停位姿存在偏差、被检测目标位置不固定、现场存在高度差和遮挡的情况下,通过多视角、多距离、多俯仰覆盖获得的采集数据,并通过分项择优输出更适合各检测项的检测结果,从而提升检测准确性,同时兼顾采集覆盖率与巡检耗时,并降低了对导航定位精度的依赖。
17、通过将检测项分为计数类检测项和测量识别类检测项,并分别采用不同选取策略,能够使不同特性的检测项以适合自身的方式输出结果;计数类检测项取各采集位姿下本栏计数结果的最大值,可有效避免因视角遮挡或目标重叠造成的漏检,使计数结果更接近真实值;测量识别类检测项取几何质量评分最高采集位姿的检测结果,能够降低视角不佳、目标不完整等因素对测量精度的影响。通过明确了被检测目标与检测项的具体类型,为方案在猪场实际场景中的实施提供了清晰的应用指向。通过深度图像剔除非本栏位目标,消除了相邻栏位或过道物体的干扰,进一步提升了计数类检测项的准确性。通过本栏位目标三维空间范围的确定和深度反投影剔除,提高了非本栏目标剔除的准确性。通过目标完整性、目标居中度、目标尺寸占比和目标遮挡程度四个因子综合评分,使几何质量最优视角的选择更加客观、可量化。整体提高了各类检测项在复杂猪场环境下的准确性和可靠性。
18、通过获取预先标定的可见光内参、红外内参、深度内参,以及红外摄像头和深度摄像头相对可见光摄像头的外参,能够在每个采集位姿同步触发三摄像头采集后,将可见光图像中的像素点准确映射至红外图像和深度图像中的对应像素点,能够在像素级实现三模态数据的空间对齐,为跨模态检测提供准确的数据基础;由此,可以充分利用可见光图像分辨率高、利于目标识别定位的优势,先在可见光图像中定位目标区域,再通过空间对齐关系引导红外图像读取温度和深度图像进行三维测量,避免因三摄像头光心不重合而测到非目标区域。通过给出像素级反投影、坐标系变换和投影归一化的具体映射过程,保证了对齐过程的可实现性和计算精度,使多模态数据在空间上精确对应,从而提高红外测温、深度测量及各检测项融合检测的可靠性。
1.一种猪场巡检机器人的自适应对位控制方法,其特征在于,所述方法包括:
2.根据权利要求1所述的一种猪场巡检机器人的自适应对位控制方法,其特征在于,所述检测类别包括计数类检测项和测量识别类检测项;所述根据所述检测项所属的检测类别从各所述采集位姿的检测结果中确定所述检测项的最终检测结果,包括:
3.根据权利要求2所述的一种猪场巡检机器人的自适应对位控制方法,其特征在于,所述测量识别类检测项对应的被检测目标包括母猪个体、母猪身体部位、料槽槽口,所述母猪身体部位包括肛门部位、躯干部位、背部部位;所述计数类检测项包括肥猪数量、肥猪异常体温头数,所述测量识别类检测项包括母猪肛温、母猪体重、母猪体长、母猪背膘和料槽剩料。
4.根据权利要求3所述的一种猪场巡检机器人的自适应对位控制方法,其特征在于,对于所述肥猪数量,由所述可见光图像识别肥猪,基于所述深度图像剔除非本栏位目标后,对本栏位内的肥猪进行计数;
5.根据权利要求2所述的一种猪场巡检机器人的自适应对位控制方法,其特征在于,所述基于所述深度图像剔除非本栏位目标,包括:
6.根据权利要求2所述的一种猪场巡检机器人的自适应对位控制方法,其特征在于,所述几何质量评分根据公式q=w1·f1+w2·f2+w3·f3+w4·f4进行计算得到,式中,f1为目标完整性,f2为目标居中度,f3为目标尺寸占比,f4为目标遮挡程度,w1、w2、w3、w4表示对应的权重;其中,
7.根据权利要求1所述的一种猪场巡检机器人的自适应对位控制方法,其特征在于,所述基于预先标定的内参和外参建立多模态数据的空间对齐关系,得到每个所述采集位姿对应的多模态对齐数据,包括:
8.根据权利要求7所述的一种猪场巡检机器人的自适应对位控制方法,其特征在于,所述利用所述可见光内参、红外内参、第一旋转矩阵和第一平移向量,将所述可见光图像中的像素点映射至所述红外图像中的对应像素点,以及利用所述可见光内参、深度内参、第二旋转矩阵和第二平移向量,将所述可见光图像中的像素点映射至所述深度图像中的对应像素点,得到所述多模态对齐数据,包括:
9.一种猪场巡检机器人的自适应对位控制装置,其特征在于,所述装置包括:
10.一种猪场巡检机器人的自适应对位控制设备,其特征在于,包括处理器、存储器以及存储在所述存储器内的计算机程序,所述计算机程序被所述处理器执行时实现如权利要求1至8任意一项所述的一种猪场巡检机器人的自适应对位控制方法的步骤。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com