轨迹重放方法、装置、设备、可读存储介质及程序产品与流程

摘要: 本公开涉及计算机,具体而言,本公开涉及一种轨迹重放方法、装置、设备、可读存储介质及程序产品。背景技术:1、现有技术中,机器人在接收到打断指令(例如暂停、切换轨迹...
轨迹重放方法、装置、设备、可读存储介质及程序产品与流程

本公开涉及计算机,具体而言,本公开涉及一种轨迹重放方法、装置、设备、可读存储介质及程序产品。

背景技术:

1、现有技术中,机器人在接收到打断指令(例如暂停、切换轨迹、紧急停止后恢复等)时,通常采用的策略包括策略a和策略 b。例如策略 a,直接跳转,在恢复时直接将控制指令切换到目标轨迹在当前时刻的采样值,导致机器人的关节角、关节速度、关节加速度出现不连续跳变;跳变量超过关节物理限制时,触发急停或硬件保护,从而影响了机器人的稳定性。例如策略 b,停止、复位、以及重新开始,打断后完全停止机器人,回到初始状态或安全姿态,重新播放原轨迹,从而丢失了原轨迹的执行进度,浪费时间。现有技术往往导致机器人在打断场景下的轨迹重放效率较低。

技术实现思路

1、本公开针对现有的方式的缺点,提出一种轨迹重放方法、装置、设备、计算机可读存储介质及计算机程序产品,用于解决如何提高机器人在打断场景下的轨迹重放效率的问题。

2、第一方面,本公开提供了一种轨迹重放方法,由机器人执行,包括:

3、响应于检测到机器人基于原轨迹进行轨迹重放中的打断指令,获取原轨迹的相关信息和目标轨迹段的相关信息,原轨迹的相关信息包括机器人的当前状态信息,目标轨迹段的相关信息包括机器人需到达的目标轨迹段的终点;

4、基于当前状态信息和目标轨迹段的相关信息,通过融合时长自适应计算,确定融合时长;

5、基于原轨迹的相关信息、目标轨迹段的相关信息和融合时长,通过轨迹融合处理,确定融合时长对应的融合轨迹段;

6、基于融合轨迹段和目标轨迹段,进行拼接融合处理,确定拼接融合后的轨迹;

7、通过机器人执行拼接融合后的轨迹直至到达终点,以恢复执行原轨迹的剩余轨迹。

8、在一个实施例中,当前状态信息包括机器人的各关节的当前位置,目标轨迹段的相关信息包括机器人在目标轨迹段的起点的各关节的起点位置、各关节的速度限制信息、最小融合时长和速度限制安全系数;

9、基于当前状态信息和目标轨迹段的相关信息,通过融合时长自适应计算,确定融合时长,包括:

10、基于各关节的当前位置、各关节的起点位置、各关节的速度限制信息、最小融合时长和速度限制安全系数,通过融合时长自适应计算,确定融合时长,融合时长用于表征融合轨迹段的时长。

11、在一个实施例中,速度限制安全系数的取值范围包括从0.05 至 0.5,最小融合时长的取值范围包括从 0.5 秒至 3 秒。

12、在一个实施例中,基于原轨迹的相关信息、目标轨迹段的相关信息和融合时长,通过轨迹融合处理,确定融合时长对应的融合轨迹段,包括:

13、基于融合时长和预设的控制周期,在融合时长对应的融合时间窗口内进行采样处理,得到多个采样时间点;

14、确定每个采样时间点的融合系数,融合系数用于保证机器人的关节位置连续、关节速度连续、关节加速度连续、关节加加速度连续中的至少一项;

15、基于原轨迹的相关信息,确定融合模式;

16、基于融合系数、原轨迹的相关信息和目标轨迹段的相关信息,通过融合模式对应的轨迹融合算法,得到每个采样时间点的各关节的位置信息;

17、基于各采样时间点的各关节的位置信息,确定各关节的插值器;

18、基于各关节的插值器,构建融合轨迹段和融合轨迹段的插值器。

19、在一个实施例中,融合系数为s 型融合系数,s 型融合系数支持配置连续性阶数,连续性阶数包括零阶、一阶、二阶和三阶;

20、零阶用于保证关节位置连续,相应的s型融合系数为线性函数;

21、一阶用于保证关节位置连续和关节速度连续,相应的s 型融合系数为三次多项式;

22、二阶用于保证关节位置连续、关节速度连续和关节加速度连续,相应的s 型融合系数为五次多项式;

23、三阶用于保证关节位置连续、关节速度连续、关节加速度连续和关节加加速度连续,相应的s 型融合系数为七次多项式。

24、在一个实施例中,原轨迹的相关信息包括原轨迹的插值器,目标轨迹段的相关信息包括目标轨迹段的插值器;

25、基于融合系数、原轨迹的相关信息和目标轨迹段的相关信息,通过融合模式对应的轨迹融合算法,得到每个采样时间点的各关节的位置信息,包括:

26、若融合模式为轨迹到轨迹融合模式,则基于融合系数、原轨迹的插值器和目标轨迹段的插值器,进行加权融合处理,得到每个采样时间点的各关节的位置信息;

27、若融合模式为点到轨迹融合模式,则基于融合系数、原轨迹的相关信息和目标轨迹段的相关信息,构建过渡轨迹的插值器,基于融合系数、过渡轨迹的插值器和目标轨迹段的插值器,进行加权融合处理,得到每个采样时间点的各关节的位置信息。

28、在一个实施例中,各关节的插值器的类型包括三次样条插值器、五次样条插值器、分段三次 hermite 插值器、b 样条插值器、基于最小加加速度准则构建的插值器中的任一项。

29、在一个实施例中,目标轨迹段的相关信息包括目标轨迹段的插值器;

30、所述基于融合轨迹段和目标轨迹段,进行拼接融合处理,确定拼接融合后的轨迹,包括:

31、基于融合轨迹段的插值器和目标轨迹段的插值器,进行拼接融合处理,确定拼接融合后的轨迹;

32、其中,融合轨迹段的插值器对应第一时间段,目标轨迹段的插值器对应第二时间段,第一时间段中各时间点都小于融合时长,第二时间段中各时间点都大于或等于所述融合时长,且小于或等于终点的时间点,目标轨迹段的总时长等于终点的时间点。

33、在一个实施例中,当前状态信息包括机器人的各关节的当前位置,目标轨迹段的相关信息包括机器人在目标轨迹段的终点的各关节的终点位置;

34、基于融合系数、原轨迹的相关信息和目标轨迹段的相关信息,通过融合模式对应的轨迹融合算法,得到每个采样时间点的各关节的位置信息,包括:

35、基于各关节的当前位置和各关节的终点位置,分别进行正向运动学计算,得到各关节的当前位置对应的位姿和各关节的终点位置对应的位姿,位姿包括位置分量和姿态四元数分量;

36、基于融合系数、各关节的当前位置对应的位姿和各关节的终点位置对应的位姿,进行插值处理,确定每个采样时间点的各关节的位置信息。

37、第二方面,本公开提供了一种轨迹重放装置,应用于机器人,包括:

38、获取模块,用于响应于检测到机器人基于原轨迹进行轨迹重放中的打断指令,获取原轨迹的相关信息和目标轨迹段的相关信息,原轨迹的相关信息包括机器人的当前状态信息,目标轨迹段的相关信息包括机器人需到达的目标轨迹段的终点;

39、融合时长自适应计算模块,用于基于当前状态信息和目标轨迹段的相关信息,通过融合时长自适应计算,确定融合时长;

40、轨迹融合处理模块,用于基于原轨迹的相关信息、目标轨迹段的相关信息和融合时长,通过轨迹融合处理,确定融合时长对应的融合轨迹段;

41、拼接融合处理模块,用于基于融合轨迹段和目标轨迹段,进行拼接融合处理,确定拼接融合后的轨迹;

42、执行模块,用于通过机器人执行拼接融合后的轨迹直至到达终点,以恢复执行原轨迹的剩余轨迹。

43、第三方面,本公开提供了一种电子设备,包括:处理器、存储器和总线;

44、总线,用于连接处理器和存储器;

45、存储器,用于存储操作指令;

46、处理器,用于通过调用操作指令,执行本公开第一方面的轨迹重放方法。

47、第四方面,本公开提供了一种计算机可读存储介质,存储有计算机程序,计算机程序被用于执行本公开第一方面的轨迹重放方法。

48、第五方面,本公开提供了一种计算机程序产品,包括计算机程序,计算机程序被处理器执行时实现本公开第一方面中轨迹重放方法的步骤。

49、本公开实施例提供的技术方案,至少具有如下有益效果:

50、机器人基于原轨迹进行轨迹重放中,接收到打断指令;响应于打断指令,机器人基于当前状态信息和目标轨迹段的相关信息,通过融合时长自适应计算,确定融合时长;机器人基于原轨迹的相关信息、目标轨迹段的相关信息和融合时长,通过轨迹融合处理,确定融合时长对应的融合轨迹段;通过融合轨迹段避免了机器人的关节角、关节速度、关节加速度等出现不连续跳变,从而确保了机器人的稳定性;机器人基于融合轨迹段和目标轨迹段,进行拼接融合处理,确定拼接融合后的轨迹;在机器人执行拼接融合后的轨迹直至到达终点之后,机器人恢复执行原轨迹的剩余轨迹,从而不丢失原轨迹进度,即不丢失原轨迹的剩余轨迹;如此,提高了机器人在打断场景下的轨迹重放效率。