一种基于嗅觉反馈的机器人轨迹动态修正方法及系统与流程

摘要: 本发明涉及机器人运动控制,尤其涉及一种基于嗅觉反馈的机器人轨迹动态修正方法及系统。背景技术:1、随着移动机器人在工业巡检、危险气体检测和泄漏源搜索中的应用不断增...
一种基于嗅觉反馈的机器人轨迹动态修正方法及系统与流程

本发明涉及机器人运动控制,尤其涉及一种基于嗅觉反馈的机器人轨迹动态修正方法及系统。

背景技术:

1、随着移动机器人在工业巡检、危险气体检测和泄漏源搜索中的应用不断增加,基于嗅觉反馈调整机器人运动轨迹的技术受到广泛关注。现有方法主要依据气体浓度、浓度差值或浓度变化趋势确定移动方向,但是在实际应用中普遍存在以下问题:

2、气体传感器在接触目标气体和脱离目标气体后分别存在吸附时滞和恢复时滞,导致嗅觉响应对应的轨迹位置偏离真实气味边界;固定响应时间补偿难以适应机器人移动速度、气体浓度和环境状态变化;气味扩散具有波动性和不连续性,依据瞬时浓度或相邻采样结果修正轨迹,容易将传感器拖尾误判为空间方向变化,进而造成气味边界确定不准确、机器人反复转向及轨迹偏移。

3、因此,如何提供一种基于嗅觉反馈的机器人轨迹动态修正方法及系统是本领域技术人员亟需解决的问题。

技术实现思路

1、本发明的一个目的在于提出一种基于嗅觉反馈的机器人轨迹动态修正方法及系统,本发明通过在第一探测横段和第二探测横段进行异速往返探测,基于正反向边沿组的交叉对应联立确定吸附时滞和恢复时滞,校正正反向边沿组的轨迹位置并形成第一气味区间、第二气味区间和气味带,解决现有技术中吸附时滞和恢复时滞造成嗅觉响应对应的气味边界偏移以及机器人轨迹修正不准确的问题,实现基于气味带和中轴方向的机器人轨迹动态修正,提高气味边界确定的准确性和机器人运动轨迹的稳定性。

2、根据本发明实施例的一种基于嗅觉反馈的机器人轨迹动态修正方法,包括如下步骤:

3、s1、控制机器人沿基准轨迹移动并采集嗅觉响应,确定目标修正区段;

4、s2、在目标修正区段的第一轨迹位置和第二轨迹位置分别建立第一探测横段和第二探测横段,第一探测横段和第二探测横段分别沿基准轨迹在对应轨迹位置处的法向延伸;

5、s3、控制机器人以第一探测速度沿第一探测横段正向移动,并以不同于第一探测速度的第二探测速度沿第一探测横段反向移动,根据正向移动和反向移动的嗅觉响应确定正反向边沿组;所述正反向边沿组包括正向入味边沿、正向离味边沿、反向入味边沿和反向离味边沿;

6、s4、根据第一探测速度、第二探测速度和正反向边沿组的轨迹位置,基于正向入味边沿与反向离味边沿、正向离味边沿与反向入味边沿的交叉对应,联立确定吸附时滞和恢复时滞;

7、s5、基于吸附时滞和恢复时滞校正正反向边沿组的轨迹位置,确定第一气味边界和第二气味边界,形成第一气味区间;

8、s6、对第二探测横段执行异速往返探测,确定第二气味区间;

9、s7、分别连接第一气味区间与第二气味区间的第一气味边界和第二气味边界,形成气味带,根据第一气味区间和第二气味区间的中点确定中轴方向,依据气味带和中轴方向重构目标修正区段,得到目标修正轨迹。

10、可选的,所述s1具体为:

11、根据机器人位姿、任务目标和可通行区域生成基准轨迹;

12、控制机器人沿基准轨迹按照预设采样间隔采集嗅觉响应,记录嗅觉响应对应的轨迹位置,并按照轨迹位置顺序形成嗅觉响应序列;

13、计算嗅觉响应序列中相邻嗅觉响应的响应增量,将连续预设数量的正响应增量对应的首个轨迹位置确定为初始入味位置;

14、从初始入味位置沿基准轨迹向前方和后方分别截取预设轨迹长度,形成目标修正区段。

15、可选的,所述s2具体为:

16、在目标修正区段内沿基准轨迹选取第一轨迹位置和第二轨迹位置,第一轨迹位置与第二轨迹位置之间的轨迹距离为预设纵向距离,第二轨迹位置位于第一轨迹位置沿机器人移动方向的前方;

17、分别确定基准轨迹在第一轨迹位置处的法向和第二轨迹位置处的法向;

18、将第一轨迹位置设置为第一探测横段的中点,沿第一轨迹位置处的法向向两侧延伸形成第一探测横段,将第二轨迹位置设置为第二探测横段的中点,沿第二轨迹位置处的法向向两侧延伸形成第二探测横段,第一探测横段和第二探测横段的端点均位于可通行区域内;

19、将第一探测横段和第二探测横段位于基准轨迹同一侧的端点确定为正向起点,位于基准轨迹另一侧的端点确定为正向终点。

20、可选的,所述s3具体为:

21、控制机器人从第一探测横段的正向起点至正向终点按照第一探测速度移动,形成正向响应序列,并按照第二探测速度反向移动,形成反向响应序列;

22、分别计算正向响应序列和反向响应序列中相邻嗅觉响应的响应增量;

23、将正向响应序列中连续预设数量的正响应增量和负响应增量对应的首个轨迹位置分别确定为正向入味边沿和正向离味边沿;

24、将反向响应序列中连续预设数量的正响应增量和负响应增量对应的首个轨迹位置分别确定为反向入味边沿和反向离味边沿,形成正反向边沿组。

25、可选的,所述s4具体为:

26、将第一探测横段的正向起点设置为探测坐标原点,按照正向移动方向确定正反向边沿组的坐标位置;

27、计算正向入味边沿与反向离味边沿的坐标位置之差,得到第一位置差,计算正向离味边沿与反向入味边沿的坐标位置之差,得到第二位置差;

28、将第一位置差确定为第一探测速度与吸附时滞乘积、第二探测速度与恢复时滞乘积之和,将第二位置差确定为第二探测速度与吸附时滞乘积、第一探测速度与恢复时滞乘积之和,联立确定吸附时滞和恢复时滞。

29、可选的,所述s5具体为:

30、根据吸附时滞校正正向入味边沿和反向入味边沿的轨迹位置,根据恢复时滞校正正向离味边沿和反向离味边沿的轨迹位置;

31、基于校正后的正向入味边沿和反向离味边沿确定第一气味边界,基于校正后的正向离味边沿和反向入味边沿确定第二气味边界,将第一气味边界与第二气味边界之间的区段确定为第一气味区间。

32、可选的,所述s6具体为:

33、控制机器人从第二探测横段的正向起点至正向终点按照第一探测速度移动,并按照第二探测速度反向移动,采集正向移动和反向移动的嗅觉响应;

34、根据正向移动和反向移动的嗅觉响应确定正反向边沿组;

35、根据第一探测速度、第二探测速度和正反向边沿组的轨迹位置联立确定吸附时滞和恢复时滞,校正正反向边沿组的轨迹位置,确定第二探测横段上的第一气味边界和第二气味边界,将第一气味边界与第二气味边界之间的区段确定为第二气味区间。

36、可选的,所述分别连接第一气味区间与第二气味区间的第一气味边界和第二气味边界,形成气味带,根据第一气味区间和第二气味区间的中点确定中轴方向,具体为:

37、连接第一气味区间与第二气味区间的第一气味边界,形成第一边界线,连接第一气味区间与第二气味区间的第二气味边界,形成第二边界线;

38、将第一边界线与第二边界线之间的区域确定为气味带;

39、分别确定第一气味区间和第二气味区间的中点,将第一气味区间的中点指向第二气味区间的中点的方向确定为中轴方向。

40、可选的,所述依据气味带和中轴方向重构目标修正区段,得到目标修正轨迹,具体为:

41、确定目标修正区段的起点和终点,将起点、第一气味区间的中点、第二气味区间的中点和终点依次确定为轨迹控制点;

42、按照中轴方向限定第一气味区间的中点与第二气味区间的中点之间的轨迹切向,根据轨迹控制点重构目标修正区段,形成候选修正轨迹;

43、对候选修正轨迹进行气味带边界、可通行区域边界和最大曲率约束,得到目标修正轨迹。

44、可选的,一种基于嗅觉反馈的机器人轨迹动态修正系统,包括以下模块:

45、轨迹采集模块,用于控制机器人沿基准轨迹移动并采集嗅觉响应,确定目标修正区段;

46、横段建立模块,用于在目标修正区段的第一轨迹位置和第二轨迹位置分别建立第一探测横段和第二探测横段,第一探测横段和第二探测横段分别沿基准轨迹在对应轨迹位置处的法向延伸;

47、边沿识别模块,用于控制机器人以第一探测速度沿第一探测横段正向移动,并以不同于第一探测速度的第二探测速度沿第一探测横段反向移动,根据正向移动和反向移动的嗅觉响应确定正反向边沿组;所述正反向边沿组包括正向入味边沿、正向离味边沿、反向入味边沿和反向离味边沿;

48、时滞确定模块,用于根据第一探测速度、第二探测速度和正反向边沿组的轨迹位置,基于正向入味边沿与反向离味边沿、正向离味边沿与反向入味边沿的交叉对应,联立确定吸附时滞和恢复时滞;

49、区间形成模块,用于基于吸附时滞和恢复时滞校正正反向边沿组的轨迹位置,确定第一气味边界和第二气味边界,形成第一气味区间;

50、异速探测模块,用于对第二探测横段执行异速往返探测,确定第二气味区间;

51、轨迹修正模块,用于分别连接第一气味区间与第二气味区间的第一气味边界和第二气味边界,形成气味带,根据第一气味区间和第二气味区间的中点确定中轴方向,依据气味带和中轴方向重构目标修正区段,得到目标修正轨迹。

52、本发明的有益效果是:

53、(1)本发明通过在目标修正区段设置第一探测横段和第二探测横段,控制机器人按照第一探测速度和第二探测速度进行异速往返探测,能够获得正向移动和反向移动对应的嗅觉响应,为气味边界确定提供不同运动方向和不同探测速度下的响应数据;

54、(2)基于正向入味边沿与反向离味边沿、正向离味边沿与反向入味边沿的交叉对应,联立确定吸附时滞和恢复时滞,能够区分气体传感器接触气味和脱离气味产生的响应延迟,降低嗅觉响应拖尾对轨迹位置判断的影响;

55、(3)根据吸附时滞和恢复时滞校正正反向边沿组的轨迹位置,形成第一气味区间和第二气味区间,能够提高第一气味边界和第二气味边界的确定准确性,减少气味区域宽度及位置偏差;

56、(4)根据第一气味区间和第二气味区间形成气味带并确定中轴方向,依据气味带和中轴方向重构目标修正区段,得到目标修正轨迹,能够降低机器人反复转向和轨迹偏移,提高机器人轨迹动态修正的准确性和稳定性。