一种机械臂末端工具对接控制方法及系统与流程

摘要: 本发明涉及自动控制,尤其是涉及一种机械臂末端工具对接控制方法及系统。背景技术:1、随着智能电网与无人化运维技术的发展,巡检作业日趋多样化。为适应不同任务需求,机...
一种机械臂末端工具对接控制方法及系统与流程

本发明涉及自动控制,尤其是涉及一种机械臂末端工具对接控制方法及系统。

背景技术:

1、随着智能电网与无人化运维技术的发展,巡检作业日趋多样化。为适应不同任务需求,机械臂需按作业类型自动更换对应的末端工具,而末端工具的自动对接是实现工具更换的前提。如何在无人干预条件下,使机械臂与目标工具完成精确、可靠的自动对接,已成为制约全流程无人巡检自主化的关键技术问题。

2、在现有技术中,是采用外贴物理标记的定位方式实现工具识别与位姿估计,进而完成机械臂与目标工具的对接。具体的,预先在工具或工具存放位置粘贴刚体标记(如反光标记点或二维码标记),并人工测量标记尺寸、工具物理尺寸以及标记坐标系与机械臂坐标系之间的相对关系,通过人工操作完成坐标标定。运行时,相机识别物理标记并据此推算工具的空间位置,进而引导机械臂完成对接。

3、然而,这种方式在进行机械臂与末端工具对接时高度依赖外贴物理标记的稳定性,而在实际作业环境中,外贴物理标记容易松动、脱落、翘曲或被遮挡,一旦其稳定性发生变化,机械臂将无法根据工具的实际位置与其进行对接,进而影响后续巡检任务的正常执行。

技术实现思路

1、本发明提供一种机械臂末端工具对接控制方法及系统,以解决依赖外贴物理标记进行机械臂与目标工具对接不稳定的技术问题,以实现机械臂与目标工具稳定准确对接的效果。

2、为了解决上述技术问题,一方面,本发明提供了一种机械臂末端工具对接控制方法,包括:

3、获取机械臂接口端的当前位姿和待对接目标工具的当前图像数据;

4、提取所述当前图像数据中的目标工具特征信息;

5、对所述目标工具特征信息进行分析,确定所述待对接目标工具的工具位姿;

6、基于预构建的对接工具信息库,确定所述待对接目标工具对应的接口位姿;

7、对所述机械臂接口端的所述当前位姿和所述待对接目标工具的所述工具位姿进行分析,得到相对位置关系,根据所述相对位置关系,对所述接口位姿进行相对位姿转换,得到所述待对接目标工具的接口相对于所述机械臂接口端的目标位姿;

8、根据所述目标位姿,确定对接控制指令,所述对接控制指令用于控制所述机械臂接口端与所述待对接目标工具的所述接口进行对接。

9、作为其中一种优选方案,所述对接工具信息库的构建过程包括:

10、获取各个待对接工具的二维图像数据和三维点云数据;

11、对各个所述二维图像数据进行分析,得到各个所述待对接工具的几何形态特征信息;

12、对各个所述三维点云数据进行分析,得到各个所述待对接工具的空间特征信息;

13、对所述几何形态特征信息和所述空间特征信息进行处理,得到各个所述待对接工具与其对应的所述接口的位姿关系,并对各个所述位姿关系进行规整,得到所述对接工具信息库。

14、作为其中一种优选方案,所述对接工具信息库至少包括:各个所述待对接工具的参考表征信息和各个所述待对接工具与其对应的所述接口的所述位姿关系。

15、作为其中一种优选方案,所述基于预构建的对接工具信息库,确定所述待对接目标工具对应的接口位姿,包括:

16、将所述待对接目标工具的所述目标工具特征信息与所述对接工具信息库中的所述参考表征信息进行匹配,确定所述待对接目标工具与其对应的所述接口的所述位姿关系;

17、对所述位姿关系和所述工具位姿进行分析,得到所述待对接目标工具对应的所述接口位姿。

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、相比于现有技术,本发明实施例的有益效果在于以下所述中的至少一点:本发明通过对接工具信息库的预构建和数据关联,使系统能够在获取当前图像数据后自动完成目标工具的身份识别、工具整体位姿估计和对应接口位姿的确定,为后续的机械臂精准对接提供了完整的数据基础,提高了对接过程的自动化程度和效率。本发明通过引入机械臂接口端与目标工具之间的相对位置关系分析,以及基于该相对关系对预存的接口位姿进行坐标变换,将视觉定位得到的工具整体位姿信息进一步转换为工具侧快换接口相对于机械臂末端的精确目标位姿,使机械臂能够以快换接口为直接目标进行运动控制,提高了对接的精度和可靠性。本发明将经过位姿转换得到的目标位姿直接用于生成机械臂的对接控制指令,使整个对接过程不依赖人工干预或外贴辅助标记,在无人车载平台振动、光照变化等复杂环境下仍能自主完成从图像采集到接口对接的全流程闭环控制,提高了巡检作业的自动化水平和环境适应性。