一种用于鸡舍病死弱鸡和低产鸡处置的柔顺抓取控制方法与流程

摘要: 本发明涉及机器人控制,具体而言,涉及一种用于鸡舍病死弱鸡和低产鸡处置的柔顺抓取控制方法。背景技术:1、鸡舍内病死弱鸡和低产鸡的处置长期依赖人工完成,不仅劳动强度...
一种用于鸡舍病死弱鸡和低产鸡处置的柔顺抓取控制方法与流程

本发明涉及机器人控制,具体而言,涉及一种用于鸡舍病死弱鸡和低产鸡处置的柔顺抓取控制方法。

背景技术:

1、鸡舍内病死弱鸡和低产鸡的处置长期依赖人工完成,不仅劳动强度大,而且人员频繁进入鸡舍增加了交叉污染风险和人畜共患病传播隐患,同时人工操作容易对鸡群造成较大应激。

2、随着畜禽养殖智能化发展,已有研究提出利用视觉技术识别死鸡并结合机械臂进行抓取,但仍存在以下问题:

3、其一,现有方案在识别后缺少对目标姿态的精确定位和复核,导致抓取精度不足,成功率偏低;其二,抓取过程缺乏对夹持力的实时感知与闭环调节,难以在抓取病死弱鸡或低产鸡时控制夹持力大小,容易因夹持力过大造成二次损伤或因夹持力不足导致目标滑落;其三,传统刚性夹爪或单一吸附工具缺乏对活体或柔软目标的适应性,在鸡只姿态随机、位置受限且周边存在健康鸡的狭窄笼养环境中,难以实现低扰动、高可靠性的抓取;其四,现有抓取装置多为单纯的夹持或吸附方式,缺少在夹持前建立底部支撑的托举机制,对于姿态不稳定或位于狭窄空间内的目标,单纯依靠夹持难以保证转运过程中的稳定性;其五,现有方案在抓取前缺少对目标周边健康鸡分布和笼具边界的综合感知,抓取路径和夹持轨迹的规划未充分考虑避让约束,机械臂末端直接伸入目标邻域时容易误碰健康鸡或与笼具发生碰撞。

技术实现思路

1、本发明解决的问题是上述相关技术问题中的一个或者多个。

2、为解决上述问题,本发明提供一种用于鸡舍病死弱鸡和低产鸡处置的柔顺抓取控制方法。

3、第一方面,本发明提供了一种用于鸡舍病死弱鸡和低产鸡处置的柔顺抓取控制方法,包括:

4、采集待处置鸡所在区域的近距视觉数据和热红外数据;根据所述近距视觉数据和所述热红外数据,得到待处置鸡精确姿态和待处置鸡精确位置;

5、根据所述近距视觉数据,识别所述待处置鸡周边预设范围内的健康鸡分布信息及笼具边界信息;

6、根据所述待处置鸡精确姿态、所述待处置鸡精确位置、所述笼具边界信息和所述健康鸡分布信息,生成位于所述待处置鸡体表的接触区域,并规划机械臂末端的接近路径、柔顺包覆夹瓣的闭合轨迹以及可伸缩托举滑台的伸出路径;

7、根据待处置鸡类别和风险等级,确定本次抓取任务的允许夹持力范围和末端移动速度上限;

8、根据所述接近路径、所述末端移动速度上限以及所述待处置鸡精确位置,控制机械臂移动;根据所述待处置鸡精确姿态,控制所述可伸缩托举滑台按照所述伸出路径伸出至所述待处置鸡下方形成承托支撑;

9、在所述托举滑台伸出到位后,控制所述柔顺包覆夹瓣按照所述闭合轨迹对所述待处置鸡进行包覆夹持;

10、在夹持过程中,实时获取夹持力、接触面积数据和滑移率,并根据所述夹持力、所述接触面积数据和所述滑移率动态调节所述夹瓣的闭合量,使所述夹持力维持在所述允许夹持力范围内;

11、在确认抓取稳定后,根据所述待处置鸡精确位置和预设的隔离转运容器位置,控制所述机械臂将所述待处置鸡转移至所述隔离转运容器内;控制所述夹瓣打开并回收所述托举滑台,完成所述待处置鸡释放。

12、可选地,所述规划机械臂末端的接近路径、柔顺包覆夹瓣的闭合轨迹以及可伸缩托举滑台的伸出路径之前还包括:

13、根据所述健康鸡分布信息提取各健康鸡的轮廓边界,并根据所述轮廓边界和所述笼具边界信息,计算所述机械臂末端的工作空间与所述轮廓边界的重叠度以及可进入空域面积;

14、若所述重叠度大于预设阈值或所述可进入空域面积小于预设阈值,控制设置于所述机械臂末端的定向超声波驱散组件向远离所述待处置鸡的方向输出短时脉冲声束,驱散占据所述机械臂末端的工作空间的健康鸡;

15、当驱散完成后,重新采集所述近距视觉数据以更新所述健康鸡分布信息,并重新计算所述重叠度和所述可进入空域面积,直至满足抓取窗口条件。

16、可选地,所述近距视觉数据包括rgb图像和深度图像,所述待处置鸡精确姿态包括方向角度;所述用于鸡舍病死弱鸡和低产鸡处置的柔顺抓取控制方法还包括:

17、将所述rgb图像和所述深度图像输入预设的实例分割模型,输出待处置鸡轮廓和关键点,以及各健康鸡的轮廓掩膜;

18、基于所述待处置鸡轮廓和所述关键点的空间坐标计算待处置鸡躯干朝向和重心位置;其中,所述待处置鸡躯干朝向为所述方向角度中沿待处置鸡头尾方向的分量;

19、将各所述健康鸡的轮廓掩膜结合所述深度图像映射至世界坐标系,得到各所述健康鸡的轮廓边界坐标和二维分布密度图,作为所述健康鸡分布信息;其中,所述轮廓边界坐标用于计算与所述机械臂末端的工作空间的重叠度,所述二维分布密度图用于统计健康鸡密度。

20、可选地,在执行所述托举滑台伸出之前,还包括:

21、根据所述待处置鸡躯干朝向、所述重心位置以及所述深度图像中待处置鸡底部的点云空间,判断所述待处置鸡底部是否存在可供托举滑台伸入的自由空间;

22、若存在所述自由空间,执行托举优先模式;

23、若不存在所述自由空间,切换至备选抓取模式;

24、其中,所述备选抓取模式包括纯夹持模式,或夹持加负压辅助模式。

25、可选地,所述抓取窗口条件通过计算抓取窗口评分进行判断;

26、所述抓取窗口评分为:

27、;

28、其中,为所述抓取窗口评分,所述可进入空域面积,为由所述热红外数据或视觉数据计算得到的所述待处置鸡与所述健康鸡的最小安全距离,为视野清晰度,为由所述健康鸡分布信息统计得到的健康鸡密度,为所述末端工作空间与健康鸡边界的重叠面积,、、、、分别为对应权重数据;

29、当大于或等于预设的最小阈值,且健康鸡应激评分小于预设上限时,判定满足所述抓取窗口条件。

30、可选地,所述根据所述待处置鸡精确姿态、所述待处置鸡精确位置、所述笼具边界信息和所述健康鸡分布信息,生成位于所述待处置鸡体表的接触区域,并规划机械臂末端的接近路径、柔顺包覆夹瓣的闭合轨迹以及可伸缩托举滑台的伸出路径,包括:

31、将所述待处置鸡精确姿态、所述待处置鸡精确位置、所述待处置鸡轮廓、所述笼具边界信息和所述健康鸡分布信息输入预设的视觉语言动作策略模型或扩散策略模型,得到位于所述待处置鸡体表的接触区域和候选动作序列;

32、其中,所述候选动作序列包含机械臂末端位姿增量、夹瓣开合角度和托举滑台伸出位置,用于分别形成所述接近路径、所述闭合轨迹和所述伸出路径;所述候选动作序列中的接触点位于所述待处置鸡体表轮廓范围内,且避开所述笼具边界和所述健康鸡分布信息中的禁入区域;

33、通过规则安全约束对所述候选动作序列进行校验;若所述候选动作序列违反所述规则安全约束中任一约束,通过所述规则安全约束对所述候选动作序列进行裁剪或拒绝执行;

34、其中,所述规则安全约束包含:夹持力不超过预设最大限幅、末端移动速度不超过预设速度上限、末端轨迹与所述笼具边界和健康鸡禁入区的距离大于预设安全距离、机械臂关节角度不处于奇异位形。

35、可选地,所述柔顺包覆夹瓣采用可变刚度结构;所述柔顺包覆夹瓣的闭合控制采用阻抗-导纳混合控制律公式,所述阻抗-导纳混合控制律公式包括:

36、;

37、其中,为机械臂末端实际位姿,为期望位姿,为由六维力/力矩传感器采集的外部接触力,为预设的参考接触力,、、分别为期望惯性矩阵、期望阻尼矩阵和期望刚度矩阵,为末端实际速度,为期望速度,为末端实际加速度,为期望加速度。

38、可选地,所述夹持力的动态调节采用限幅控制律公式;

39、所述限幅控制律公式为:

40、

41、其中,为所述夹瓣的夹持力控制令,为滑移率,为由腕部近距感知组件测得的实际位置与期望位置的偏差,为速度误差,、、分别为对应的滑移增益系数、位置误差增益系数和速度误差增益系数,和分别为所述允许夹持力范围的下限值和上限值;为截断函数,计算结果限制在与之间,超出时取边界值;

42、当所述滑移率增大时,所述控制律增大所述夹持力;当所述夹持力达到所述最大安全夹持力且所述滑移率持续增加时,控制所述机械臂执行撤退动作并触发异常报警。

43、可选地,所述用于鸡舍病死弱鸡和低产鸡处置的柔顺抓取控制方法还包括:

44、根据所述接触面积数据、夹持力偏差和滑移率,计算抓取稳定度:

45、;

46、其中,、、分别为对应的权重系数,为所述接触面积数据,为所述夹持力偏差,为所述滑移率,为抓取稳定度;为夹持力,为参考夹持力;

47、当所述抓取稳定度低于预设稳定阈值时,控制所述托举滑台增加支撑力或控制所述夹瓣微调夹持角度,并在调整后重新计算所述抓取稳定度;若连续多次调整后所述抓取稳定度均低于所述预设稳定阈值,控制所述机械臂将所述待处置鸡放回原位并触发失败恢复流程;

48、在所述机械臂转移所述待处置鸡的过程中,根据鸡舍数字孪生地图规划协同轨迹;

49、当所述机械臂转移所述待处置鸡时,保持所述隔离转运容器的开口方向朝上且姿态稳定;

50、若在转运过程中检测到所述滑移率超过预设滑移阈值,或检测到健康鸡进入预设安全边界,控制所述机械臂暂停移动并调整所述托举滑台的高度,待所述滑移率恢复至所述预设滑移阈值以下且所述健康鸡离开所述预设安全边界后,继续执行转运动作;

51、若暂停调整后异常状态未消除,控制所述机械臂沿预设安全回撤轨迹撤退至安全观察位,并根据异常类型执行复核过程,或触发远程人工接管模式。

52、可选地,在完成待处置鸡释放之后,还包括:

53、将所述待处置鸡的编号、所述待处置鸡类别、所述风险等级、处置时间和所述待处置鸡精确位置关联存储,形成作业日志归档;并根据所述风险等级选择对应的清洁消杀等级;

54、按照所述清洁消杀等级对所述柔顺包覆夹瓣的内侧接触面和所述托举滑台的承托面执行清洁消杀流程;

55、在清洁完成后,采集清洁状态反馈数据,并根据所述清洁状态反馈数据确认是否达到允许执行下一次抓取任务的标准。

56、本发明的一种用于鸡舍病死弱鸡和低产鸡处置的柔顺抓取控制方法的有益效果是:

57、通过将近距视觉数据与热红外数据融合用于目标精确定位与姿态获取,并结合托举滑台优先承托、柔顺包覆夹瓣与力触觉实时闭环控制,实现了对鸡舍复杂环境中异常鸡只的低扰动、高成功率的自动化处置。该方法在抓取前利用近距视觉与热红外数据对目标进行精确定位与姿态复核,有效克服了上游识别系统粗定位在狭窄鸡舍环境中精度不足的问题;通过控制可伸缩托举滑台优先伸出至目标下方形成承托支撑,再闭合柔顺包覆夹瓣进行包覆夹持的托举优先策略,在夹持前即建立底部支撑面,显著降低了目标在抓取和转运过程中的滑落风险,同时减少了对鸡只的挤压应力;在夹持过程中,通过实时获取夹持力、接触面积和滑移率等多维力触觉反馈信号并据此动态调节夹瓣闭合量,使实际夹持力始终维持在根据目标类别与风险等级预定的安全范围内,既防止了因夹持力不足导致的目标滑脱,又避免了因夹持力过大对弱鸡或低产鸡造成二次伤害,真正实现了对不同状态鸡只的自适应柔顺安全抓取;此外,该方法在完成抓取后直接将目标转移至隔离转运容器并释放,形成了从识别定位到隔离转运的完整处置闭环,有效减少了人员频繁进入鸡舍所带来的劳动强度和交叉污染风险,为规模化养殖场的智能化防疫运维提供了可靠的技术支撑。