CN114986132A - 一种基于视觉传感的机器人柔性轴孔装配方法及装置 - Google Patents

一种基于视觉传感的机器人柔性轴孔装配方法及装置 Download PDF

Info

Publication number
CN114986132A
CN114986132A CN202210716679.9A CN202210716679A CN114986132A CN 114986132 A CN114986132 A CN 114986132A CN 202210716679 A CN202210716679 A CN 202210716679A CN 114986132 A CN114986132 A CN 114986132A
Authority
CN
China
Prior art keywords
robot
flexible shaft
assembly
moment
visual sensing
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202210716679.9A
Other languages
English (en)
Other versions
CN114986132B (zh
Inventor
徐静
杨文昊
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tsinghua University
Original Assignee
Tsinghua University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tsinghua University filed Critical Tsinghua University
Priority to CN202210716679.9A priority Critical patent/CN114986132B/zh
Publication of CN114986132A publication Critical patent/CN114986132A/zh
Application granted granted Critical
Publication of CN114986132B publication Critical patent/CN114986132B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23PMETAL-WORKING NOT OTHERWISE PROVIDED FOR; COMBINED OPERATIONS; UNIVERSAL MACHINE TOOLS
    • B23P19/00Machines for simply fitting together or separating metal parts or objects, or metal and non-metal parts, whether or not involving some deformation; Tools or devices therefor so far as not provided for in other classes
    • B23P19/04Machines for simply fitting together or separating metal parts or objects, or metal and non-metal parts, whether or not involving some deformation; Tools or devices therefor so far as not provided for in other classes for assembling or disassembling parts
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

本发明提出一种基于视觉传感的机器人柔性轴孔装配方法及装置,属于机器人自动化装配应用领域。其中,所述方法包括:通过视觉传感获取由机器人携带的柔性轴在装配过程中的变形特征信息;根据所述变形特征信息,计算所述机器人调姿运动的控制角;根据所述控制角,计算所述机器人基于视觉传感的装配动作;将所述基于视觉传感的装配动作和预设的装配参考动作耦合叠加,得到所述机器人的装配动作。本发明将主动柔顺控制推广至视觉伺服领域,应用于机器人柔性轴孔装配控制任务中,有助于工业生产环境中开展柔性零件装配工作的机器人自动化升级替代,提高生产的效率。

Description

一种基于视觉传感的机器人柔性轴孔装配方法及装置
技术领域
本发明属于机器人自动化装配应用领域,特别涉及一种基于视觉传感的机器人柔性轴孔装配方法及装置。
背景技术
随着制造业的快速发展,对于实际环境中许多具有复杂形貌、力学特征的柔性零件(例如航空、汽车内部线缆电束、液气软管、3C电子排线等),现有的基于力反馈的主动柔顺控制技术通过感知接触力,利用机器人运动从而主动顺应接触力变化的装配方法无法输入柔性零件的变形信息,因此难以适用。柔性轴孔装配具有高维复杂形貌与接触条件,实验表明,在大变形条件下,由于环境约束的存在,现有的柔顺控制策略输出的调姿动作难以传导至目标位置,该动作会被零件变形吸收并停留在局部区域,导致在机器人末端点附近产生局部大变形,而零部件接触区域附近的接触条件却无法得到改善。因此,实现柔性轴孔零件的精确快速装配是将机器人自动装配技术推广至工业领域中需要研究的重要问题。
发明内容
本发明的目的是为克服已有技术的不足之处,提出一种基于视觉传感的机器人柔性轴孔装配方法及装置。本发明将主动柔顺控制推广至视觉伺服领域,应用于机器人柔性轴孔装配控制任务中,有助于工业生产环境中开展柔性零件装配工作的机器人自动化升级替代,提高生产的效率。
本发明第一方面实施例提出一种基于视觉传感的机器人柔性轴孔装配方法,包括:
通过视觉传感获取由机器人携带的柔性轴在装配过程中的变形特征信息;
根据所述变形特征信息,计算所述机器人调姿运动的控制角;
根据所述控制角,计算所述机器人基于视觉传感的装配动作;
将所述基于视觉传感的装配动作和预设的装配参考动作耦合叠加,得到所述机器人的装配动作。
在本发明的一个具体实施例中,所述视觉传感采用双目相机。
在本发明的一个具体实施例中,所述变形特征信息包括:
当前时刻的柔性轴末端点坐标Pt=[xt,yt,zt]和当前时刻的柔性轴末端的变形角
Figure BDA0003709774070000021
其中,下标t代表第t个时刻,xt,yt,zt分别代表第t个时刻柔性轴末端点相对于机器人末端坐标系在X,Y,Z轴方向的位置坐标,
Figure BDA0003709774070000022
分别代表第t个时刻柔性轴末端轴线方向相对于机器人末端坐标系X,Y,Z轴的旋转变形角。
在本发明的一个具体实施例中,所述根据所述变形特征信息,计算所述机器人调姿运动的控制角,表达式如下:
Figure BDA0003709774070000023
其中,
Figure BDA0003709774070000024
为第t个时刻机器人调姿运动的控制角,
Figure BDA0003709774070000025
Figure BDA0003709774070000026
为PD控制器的比例和微分系数,At-1为第t-1个时刻的柔性轴末端的变形角,当t=1时,At-At-1=0;
Figure BDA0003709774070000027
为变形角期望值,
Figure BDA0003709774070000028
分别代表调姿运动使柔性轴恢复到目标位置条件下柔性轴末端轴线方向相对于机器人末端坐标系X,Y,Z轴的旋转变形角。
在本发明的一个具体实施例中,所述计算所述机器人基于视觉传感的装配动作,包括:
将控制角
Figure BDA0003709774070000029
转化为调姿旋转矩阵
Figure BDA00037097740700000210
Figure BDA00037097740700000211
在机器人末端坐标系下求出第t个时刻齐次矩阵形式的轴末端的期望位姿矩阵Tt d_tool
Figure BDA00037097740700000212
其中,Pt T为第t个时刻以列向量形式表达的柔性轴末端点坐标Pt
求解第t个时刻机器人末端的调姿矩阵Tt d_end
Figure BDA00037097740700000213
其中,I3×3为单位阵,H=[0,0,-lt-h]为第t个时刻机器人末端在轴末端坐标系中的理想位置,lt为第t个时刻柔性轴未进入孔外露部分的长度;
将矩阵Tt d_end转换为第t个时刻基于视觉传感的装配动作
Figure BDA00037097740700000214
其中
Figure BDA00037097740700000215
分别为第t个时刻机器人在末端坐标系下沿X,Y,Z轴的平移运动值,
Figure BDA00037097740700000216
分别为第t个时刻机器人在末端坐标系下绕X,Y,Z轴的旋转运动值。
在本发明的一个具体实施例中,所述第t个时刻柔性轴未进入孔外露部分的长度计算表达式如下:
Figure BDA0003709774070000031
在本发明的一个具体实施例中,所述方法还包括:
当t≥2时,对lt进行判定:
若满足lt≤L-D,则柔性轴抵达预设的目标深度,装配完成;其中,L为柔性轴的总长度,D为装配的目标深度。
本发明第二方面实施例提出一种基于视觉传感的机器人柔性轴孔装配装置,包括:
变形特征提取模块,用于通过视觉传感获取由机器人携带的柔性轴在装配过程中的变形特征信息;
控制角计算模块,用于根据所述变形特征信息,计算所述机器人调姿运动的控制角;
视觉传感动作计算模块,用于根据所述控制角,计算所述机器人基于视觉传感的装配动作;
机器人动作计算模块,用于将所述基于视觉传感的装配动作和预设的装配参考动作耦合叠加,得到所述机器人的装配动作。
本发明第三方面实施例提出一种电子设备,包括:
至少一个处理器;以及,与所述至少一个处理器通信连接的存储器;
其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被设置为用于执行上述一种基于视觉传感的机器人柔性轴孔装配方法。
本发明第四方面实施例提出一种计算机可读存储介质,所述计算机可读存储介质存储计算机指令,所述计算机指令用于使所述计算机执行上述一种基于视觉传感的机器人柔性轴孔装配方法。
本发明的特点及有益效果在于:
1)本发明能够建立对变形特征的信息的闭环反馈控制,形成了一种基于视觉反馈的主动柔顺控制,具有对柔性大长径比轴零件的弯曲变形进行修正的能力。本发明通过视觉检测得到的柔性轴变形特征建立调姿控制策略,控制机器人携带柔性轴进行位姿调整,使柔性轴恢复至无弯曲的顺直状态以提高对柔性轴零件装配的适应能力。
2)本发明将主动柔顺控制推广至视觉伺服领域,本方法应用于机器人柔性轴孔装配控制任务中,有助于工业生产环境中开展柔性零件装配工作的机器人自动化升级替代,提高生产的效率。
附图说明
图1是本发明一个具体实施例中柔性轴孔装配系统的结构示意图。
图2是本发明一个具体实施例提出的一种基于视觉传感的机器人柔性轴孔装配方法的整体流程图。
图3是本发明一个具体实施例中装配调姿过程中原始位置和目标调姿位置的示意图。
具体实施方式
本发明提出一种基于视觉传感的机器人柔性轴孔装配方法及装置,下面结合具体实施例对本发明进一步详细说明如下。
本发明第一方面实施例提出一种基于视觉传感的机器人柔性轴孔装配方法,其中,轴孔装配系统结构如图1所示,包含:机器人1、柔性轴基座2、柔性轴3(由硅胶材质制成,具有大长径比形貌特征)、待装配孔4、双目相机、工作平台和控制计算机,其中,双目相机包括右相机5和左相机6;机器人底端与工作平台固结,机器人末端与柔性轴基座固结,柔性轴起始端固结于柔性轴基座中;未装配时柔性轴末端自由悬空,此时定义柔性轴末端点为柔性轴末端平面中心点;在装配过程中柔性轴末端与待装配孔接触,定义柔性轴末端点为柔性轴与待装配孔零件表面相交产生圆形截面的中心点。双目相机固定于机器人末端,柔性轴位于双目相机视野内,待装配孔固结在工作平台上,控制计算机通过线缆连接并控制机器人。该系统各部分均可采用常规部件。
本发明实施例提出一种基于视觉传感和力传感的机器人柔性轴孔装配方法,该方法基于视觉传感开展调姿控制,包括:
通过视觉传感获取由机器人携带的柔性轴在装配过程中的变形特征信息;
根据所述变形特征信息,计算所述机器人调姿运动的控制角;
根据所述控制角,计算所述机器人基于视觉传感的装配动作;
将所述基于视觉传感的装配动作和预设的装配参考动作耦合叠加,得到所述机器人的装配动作。
在本发明的一个具体实施例中,所述一种基于视觉传感和力传感的机器人柔性轴孔装配方法,整体流程如图2所示,包括以下步骤:
1)确定柔性轴起始端与柔性轴基座固结点到机器人末端距离h;确定柔性轴的总长度L(本发明一个具体实施例中取值152mm),直径d(本发明一个具体实施例中取值16mm),确定装配的目标深度D(本发明一个具体实施例中为40mm);
2)在任一装配回合开始时,机器人将柔性轴运动到设定的初始位置(其中,每个回合的初始位置是固定的,由人为设定),设定每个装配回合初始位置对应的时刻t=1。
3)在当前装配回合中,假设第t个时刻的柔性轴弯曲变形特征如图3(a)所示,通过双目相机检测第t个时刻的柔性轴变形特征信息为St,本实施例中,所述变形特征信息包括第t个时刻的柔性轴末端点坐标Pt=[xt,yt,zt]和第t个时刻的柔性轴末端的变形角
Figure BDA0003709774070000051
其中xt,yt,zt分别代表第t个时刻柔性轴末端点相对于机器人末端坐标系在X,Y,Z轴方向的位置坐标,
Figure BDA0003709774070000052
分别代表第t个时刻柔性轴末端轴线方向相对于机器人末端坐标系X,Y,Z轴的旋转变形角。
4)计算第t个时刻柔性轴未进入孔外露部分的长度lt
本实施例中lt取值可以利用
Figure BDA0003709774070000053
以及xt,yt,zt,通过将轴近似为圆弧估算:
Figure BDA0003709774070000054
对lt进行判定:
当t≥2时,若柔性轴外露部分长度lt满足lt≤L-D,则柔性轴抵达目标深度D,当前装配回合完成;若不满足,则进入步骤5);
5)计算第t个时刻机器人调姿运动的控制角为
Figure BDA0003709774070000055
其中
Figure BDA0003709774070000056
分别代表第t个时刻柔性轴末端轴线方向相对于机器人末端坐标系XYZ轴的旋转调姿角。
本实施例中,可以通过PD控制器根据变形角At求出控制角
Figure BDA0003709774070000057
Figure BDA0003709774070000058
其中,
Figure BDA0003709774070000059
Figure BDA00037097740700000510
为PD控制器的比例和微分系数,Ad为变形角期望值,At-1为上一时刻(第t-1个时刻)的变形角,当t=1时,令At-At-1=0。在本实施例中,
Figure BDA00037097740700000511
建议取值范围为0.01~0.1,本发明一个具体实施例中取值0.025;
Figure BDA00037097740700000512
建议取值为
Figure BDA00037097740700000513
变形角期望值
Figure BDA00037097740700000514
其中
Figure BDA00037097740700000515
分别代表调姿运动使柔性轴恢复到产生给定的期望变形状态下柔性轴末端轴线方向相对于机器人末端坐标系X,Y,Z轴的旋转变形角,在本发明一个实施例中其取值均为0。
6)将步骤5)得到的控制角
Figure BDA00037097740700000516
转化为调姿旋转矩阵
Figure BDA00037097740700000517
Figure BDA00037097740700000518
在机器人末端坐标系下求出第t个时刻齐次矩阵形式的轴末端的期望位姿矩阵Tt d_tool
Figure BDA0003709774070000061
其中,Pt T为第t个时刻以列向量形式表达的柔性轴末端点坐标Pt
7)求解第t个时刻机器人末端的调姿矩阵Tt d_end
Figure BDA0003709774070000062
其中,I3×3为单位阵,H=[0,0,-lt-h]为第t个时刻机器人末端在轴末端坐标系中的理想位置;
Figure BDA0003709774070000063
8)将齐次矩阵形式的调姿矩阵Tt d_end转换为以6维向量形式表达的第t个时刻基于视觉传感的装配动作
Figure BDA0003709774070000064
基于视觉传感的装配动作at v可以写为
Figure BDA0003709774070000065
其中
Figure BDA0003709774070000066
分别为第t个时刻机器人在末端坐标系下沿X,Y,Z轴的平移运动值,
Figure BDA0003709774070000067
分别为第t个时刻机器人在末端坐标系下绕X,Y,Z轴的旋转运动值。
本发明一个具体实施例中装配参考动作
Figure BDA0003709774070000068
可以写为
Figure BDA0003709774070000069
其中
Figure BDA00037097740700000610
代表预设的柔性轴沿机器人末端坐标系Z轴方向平移运动的动作值,在本发明一个实施例中
Figure BDA00037097740700000611
取值为固定的0.2mm/步。
9)使第t个时刻视觉传感的装配动作
Figure BDA00037097740700000612
与装配参考动作
Figure BDA00037097740700000613
耦合叠加,得到第t个时刻机器人装配动作at
Figure BDA00037097740700000614
其中,第t个时刻装配动作at可以写为
Figure BDA00037097740700000615
分别为第t个时刻机器人在末端坐标系下沿X,Y,Z轴的平移运动值,
Figure BDA00037097740700000616
分别为第t个时刻机器人在末端坐标系下绕X,Y,Z轴的旋转运动值
10)令机器人执行装配动作
Figure BDA00037097740700000617
机器人携带柔性轴运动至如图3(b)所示的下一位置,使柔性轴变形减小或消除,达到调姿修正的目的,然后令t=t+1,重新回到步骤3)。
为实现上述实施例,本发明第二方面实施例提出一种基于视觉传感的机器人柔性轴孔装配装置,包括:
变形特征提取模块,用于通过视觉传感获取由机器人携带的柔性轴在装配过程中的变形特征信息;
控制角计算模块,用于根据所述变形特征信息,计算所述机器人调姿运动的控制角;
视觉传感动作计算模块,用于根据所述控制角,计算所述机器人基于视觉传感的装配动作;
机器人动作计算模块,用于将所述基于视觉传感的装配动作和预设的装配参考动作耦合叠加,得到所述机器人的装配动作。
需要说明的是,前述对一种基于视觉传感的机器人柔性轴孔装配方法的实施例解释说明也适用于本实施例的一种基于视觉传感的机器人柔性轴孔装配装置,在此不再赘述。根据本发明实施例提出的一种基于视觉传感的机器人柔性轴孔装配装置,通过通过视觉传感获取由机器人携带的柔性轴在装配过程中的变形特征信息;根据所述变形特征信息,计算所述机器人调姿运动的控制角;根据所述控制角,计算所述机器人基于视觉传感的装配动作;将所述基于视觉传感的装配动作和预设的装配参考动作耦合叠加,得到所述机器人的装配动作。由此,实现通过视觉检测得到的柔性轴变形特征建立调姿控制策略,控制机器人携带柔性轴进行位姿调整,使柔性轴恢复至无弯曲的顺直状态以提高对柔性轴零件装配的适应能力。
为实现上述实施例,本发明第三方面实施例提出一种电子设备,包括:
至少一个处理器;以及,与所述至少一个处理器通信连接的存储器;
其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被设置为用于执行上述一种基于视觉传感的机器人柔性轴孔装配方法。
为实现上述实施例,本发明第四方面实施例提出一种计算机可读存储介质,所述计算机可读存储介质存储计算机指令,所述计算机指令用于使所述计算机执行上述一种基于视觉传感的机器人柔性轴孔装配方法。
需要说明的是,本公开上述的计算机可读介质可以是计算机可读信号介质或者计算机可读存储介质或者是上述两者的任意组合。计算机可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件,或者任意以上的组合。计算机可读存储介质的更具体的例子可以包括但不限于:具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机访问存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本公开中,计算机可读存储介质可以是任何包含或存储程序的有形介质,该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。而在本公开中,计算机可读信号介质可以包括在基带中或者作为载波一部分传播的数据信号,其中承载了计算机可读的程序代码。这种传播的数据信号可以采用多种形式,包括但不限于电磁信号、光信号或上述的任意合适的组合。计算机可读信号介质还可以是计算机可读存储介质以外的任何计算机可读介质,该计算机可读信号介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。计算机可读介质上包含的程序代码可以用任何适当的介质传输,包括但不限于:电线、光缆、RF(射频)等等,或者上述的任意合适的组合。
上述计算机可读介质可以是上述电子设备中所包含的;也可以是单独存在,而未装配入该电子设备中。上述计算机可读介质承载有一个或者多个程序,当上述一个或者多个程序被该电子设备执行时,使得该电子设备执行上述实施例的一种基于视觉传感的机器人柔性轴孔装配方法。
可以以一种或多种程序设计语言或其组合来编写用于执行本公开的操作的计算机程序代码,上述程序设计语言包括面向对象的程序设计语言—诸如Java、Smalltalk、C++,还包括常规的过程式程序设计语言—诸如“C”语言或类似的程序设计语言。程序代码可以完全地在用户计算机上执行、部分地在用户计算机上执行、作为一个独立的软件包执行、部分在用户计算机上部分在远程计算机上执行、或者完全在远程计算机或服务器上执行。在涉及远程计算机的情形中,远程计算机可以通过任意种类的网络——包括局域网(LAN)或广域网(WAN)—连接到用户计算机,或者,可以连接到外部计算机(例如利用因特网服务提供商来通过因特网连接)。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本申请的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不必须针对的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任一个或多个实施例或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。
此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本申请的描述中,“多个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。
流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为,表示包括一个或更多个用于实现特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分,并且本申请的优选实施方式的范围包括另外的实现,其中可以不按所示出或讨论的顺序,包括根据所涉及的功能按基本同时的方式或按相反的顺序,来执行功能,这应被本申请的实施例所属技术领域的技术人员所理解。
在流程图中表示或在此以其他方式描述的逻辑和/或步骤,例如,可以被认为是用于实现逻辑功能的可执行指令的定序列表,可以具体实现在任何计算机可读介质中,以供指令执行系统、装置或设备(如基于计算机的系统、包括处理器的系统或其他可以从指令执行系统、装置或设备取指令并执行指令的系统)使用,或结合这些指令执行系统、装置或设备而使用。就本说明书而言,"计算机可读介质"可以是任何可以包含、存储、通信、传播或传输程序以供指令执行系统、装置或设备或结合这些指令执行系统、装置或设备而使用的装置。计算机可读介质的更具体的示例(非穷尽性列表)包括以下:具有一个或多个布线的电连接部(电子装置),便携式计算机盘盒(磁装置),随机存取存储器(RAM),只读存储器(ROM),可擦除可编辑只读存储器(EPROM或闪速存储器),光纤装置,以及便携式光盘只读存储器(CDROM)。另外,计算机可读介质甚至可以是可在其上打印程序的纸或其他合适的介质,因为可以例如通过对纸或其他介质进行光学扫描,接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得程序,然后将其存储在计算机存储器中。
应当理解,本申请的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中,多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。例如,如果用硬件来实现,和在另一实施方式中一样,可用本领域公知的下列技术中的任一项或他们的组合来实现:具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路,具有合适的组合逻辑门电路的专用集成电路,可编程门阵列(PGA),现场可编程门阵列(FPGA)等。
本技术领域的普通技术人员可以理解实现上述实施例方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成,的程序可以存储于一种计算机可读存储介质中,该程序在执行时,包括方法实施例的步骤之一或其组合。
此外,在本申请各个实施例中的各功能单元可以集成在一个处理模块中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现,也可以采用软件功能模块的形式实现。集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时,也可以存储在一个计算机可读取存储介质中。
上述提到的存储介质可以是只读存储器,磁盘或光盘等。尽管上面已经示出和描述了本申请的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本申请的限制,本领域的普通技术人员在本申请的范围内可以对上述实施例进行变化、修改、替换和变型。

Claims (10)

1.一种基于视觉传感的机器人柔性轴孔装配方法,其特征在于,包括:
通过视觉传感获取由机器人携带的柔性轴在装配过程中的变形特征信息;
根据所述变形特征信息,计算所述机器人调姿运动的控制角;
根据所述控制角,计算所述机器人基于视觉传感的装配动作;
将所述基于视觉传感的装配动作和预设的装配参考动作耦合叠加,得到所述机器人的装配动作。
2.根据权利要求1所述的方法,其特征在于,所述视觉传感采用双目相机。
3.根据权利要求1所述的方法,其特征在于,所述变形特征信息包括:
当前时刻的柔性轴末端点坐标Pt=[xt,yt,zt]和当前时刻的柔性轴末端的变形角
Figure FDA0003709774060000011
其中,下标t代表第t个时刻,xt,yt,zt分别代表第t个时刻柔性轴末端点相对于机器人末端坐标系在X,Y,Z轴方向的位置坐标,
Figure FDA0003709774060000012
分别代表第t个时刻柔性轴末端轴线方向相对于机器人末端坐标系X,Y,Z轴的旋转变形角。
4.根据权利要求3所述的方法,其特征在于,所述根据所述变形特征信息,计算所述机器人调姿运动的控制角,表达式如下:
Figure FDA0003709774060000013
其中,
Figure FDA0003709774060000014
为第t个时刻机器人调姿运动的控制角,
Figure FDA0003709774060000015
Figure FDA0003709774060000016
为PD控制器的比例和微分系数,At-1为第t-1个时刻的柔性轴末端的变形角,当t=1时,At-At-1=0;
Figure FDA0003709774060000017
为变形角期望值,
Figure FDA0003709774060000018
分别代表调姿运动使柔性轴恢复到目标位置条件下柔性轴末端轴线方向相对于机器人末端坐标系X,Y,Z轴的旋转变形角。
5.根据权利要求4所述的方法,其特征在于,所述计算所述机器人基于视觉传感的装配动作,包括:
将控制角
Figure FDA0003709774060000019
转化为调姿旋转矩阵
Figure FDA00037097740600000110
Figure FDA00037097740600000111
在机器人末端坐标系下求出第t个时刻齐次矩阵形式的轴末端的期望位姿矩阵
Figure FDA00037097740600000112
Figure FDA00037097740600000113
其中,Pt T为第t个时刻以列向量形式表达的柔性轴末端点坐标Pt
求解第t个时刻机器人末端的调姿矩阵Tt d_end
Figure FDA0003709774060000021
其中,I3×3为单位阵,H=[0,0,-lt-h]为第t个时刻机器人末端在轴末端坐标系中的理想位置,lt为第t个时刻柔性轴未进入孔外露部分的长度;
将矩阵Tt d_end转换为第t个时刻基于视觉传感的装配动作
Figure FDA0003709774060000022
其中
Figure FDA0003709774060000023
分别为第t个时刻机器人在末端坐标系下沿X,Y,Z轴的平移运动值,
Figure FDA0003709774060000024
分别为第t个时刻机器人在末端坐标系下绕X,Y,Z轴的旋转运动值。
6.根据权利要求5所述的方法,其特征在于,所述第t个时刻柔性轴未进入孔外露部分的长度计算表达式如下:
Figure FDA0003709774060000025
7.根据权利要求6所述的方法,其特征在于,所述方法还包括:
当t≥2时,对lt进行判定:
若满足lt≤L-D,则柔性轴抵达预设的目标深度,装配完成;其中,L为柔性轴的总长度,D为装配的目标深度。
8.一种基于视觉传感的机器人柔性轴孔装配装置,其特征在于,包括:
变形特征提取模块,用于通过视觉传感获取由机器人携带的柔性轴在装配过程中的变形特征信息;
控制角计算模块,用于根据所述变形特征信息,计算所述机器人调姿运动的控制角;
视觉传感动作计算模块,用于根据所述控制角,计算所述机器人基于视觉传感的装配动作;
机器人动作计算模块,用于将所述基于视觉传感的装配动作和预设的装配参考动作耦合叠加,得到所述机器人的装配动作。
9.一种电子设备,其特征在于,包括:
至少一个处理器;以及,与所述至少一个处理器通信连接的存储器;
其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被设置为用于执行上述权利要求1-7任一项所述的方法。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储计算机指令,所述计算机指令用于使所述计算机执行权利要求1-7任一项所述的方法。
CN202210716679.9A 2022-06-23 2022-06-23 一种基于视觉传感的机器人柔性轴孔装配方法及装置 Active CN114986132B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210716679.9A CN114986132B (zh) 2022-06-23 2022-06-23 一种基于视觉传感的机器人柔性轴孔装配方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210716679.9A CN114986132B (zh) 2022-06-23 2022-06-23 一种基于视觉传感的机器人柔性轴孔装配方法及装置

Publications (2)

Publication Number Publication Date
CN114986132A true CN114986132A (zh) 2022-09-02
CN114986132B CN114986132B (zh) 2023-08-08

Family

ID=83037279

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210716679.9A Active CN114986132B (zh) 2022-06-23 2022-06-23 一种基于视觉传感的机器人柔性轴孔装配方法及装置

Country Status (1)

Country Link
CN (1) CN114986132B (zh)

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60217405A (ja) * 1984-04-12 1985-10-31 Mitsubishi Electric Corp 産業用ロボツトの制御装置
JPH09136279A (ja) * 1995-11-15 1997-05-27 Fanuc Ltd 力制御ロボットを用いた位相合わせ嵌合方法
CN106272416A (zh) * 2016-08-29 2017-01-04 上海交通大学 基于力觉和视觉的机器人细长轴精密装配系统及方法
CN108839027A (zh) * 2018-08-31 2018-11-20 河南工程学院 基于激光测距传感器的机器人自动对准控制方法
CN109940605A (zh) * 2019-01-29 2019-06-28 中国工程物理研究院激光聚变研究中心 融合三维视觉与接触力分析的柔顺装配系统及方法
CN110893534A (zh) * 2018-09-13 2020-03-20 宝山钢铁股份有限公司 基于视觉测量的冶金技术探针接插标定方法及其接插系统
CN111590594A (zh) * 2020-06-22 2020-08-28 南京航空航天大学 基于视觉引导的机器人轨迹跟踪控制方法
WO2021003869A1 (zh) * 2019-07-05 2021-01-14 清华大学 大尺寸轴孔工件装配的螺旋插装方法
CN113043010A (zh) * 2021-04-01 2021-06-29 中国工程物理研究院机械制造工艺研究所 一种大长径比轴孔自动装配装置及方法
CN113093519A (zh) * 2021-03-01 2021-07-09 东风汽车集团股份有限公司 电动调节转向柱的控制方法、系统、存储介质及电子设备
US20210252700A1 (en) * 2020-02-18 2021-08-19 Harbin Institute Of Technology Hybrid visual servoing method based on fusion of distance space and image feature space
CN113361082A (zh) * 2021-05-24 2021-09-07 山东大学 一种柔性体空间形状和位姿感知方法及系统
CN113607053A (zh) * 2021-08-13 2021-11-05 西北工业大学 基于筒体内表面特征点的位姿调整装置、方法及系统

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60217405A (ja) * 1984-04-12 1985-10-31 Mitsubishi Electric Corp 産業用ロボツトの制御装置
JPH09136279A (ja) * 1995-11-15 1997-05-27 Fanuc Ltd 力制御ロボットを用いた位相合わせ嵌合方法
CN106272416A (zh) * 2016-08-29 2017-01-04 上海交通大学 基于力觉和视觉的机器人细长轴精密装配系统及方法
CN108839027A (zh) * 2018-08-31 2018-11-20 河南工程学院 基于激光测距传感器的机器人自动对准控制方法
CN110893534A (zh) * 2018-09-13 2020-03-20 宝山钢铁股份有限公司 基于视觉测量的冶金技术探针接插标定方法及其接插系统
CN109940605A (zh) * 2019-01-29 2019-06-28 中国工程物理研究院激光聚变研究中心 融合三维视觉与接触力分析的柔顺装配系统及方法
WO2021003869A1 (zh) * 2019-07-05 2021-01-14 清华大学 大尺寸轴孔工件装配的螺旋插装方法
US20210252700A1 (en) * 2020-02-18 2021-08-19 Harbin Institute Of Technology Hybrid visual servoing method based on fusion of distance space and image feature space
CN111590594A (zh) * 2020-06-22 2020-08-28 南京航空航天大学 基于视觉引导的机器人轨迹跟踪控制方法
CN113093519A (zh) * 2021-03-01 2021-07-09 东风汽车集团股份有限公司 电动调节转向柱的控制方法、系统、存储介质及电子设备
CN113043010A (zh) * 2021-04-01 2021-06-29 中国工程物理研究院机械制造工艺研究所 一种大长径比轴孔自动装配装置及方法
CN113361082A (zh) * 2021-05-24 2021-09-07 山东大学 一种柔性体空间形状和位姿感知方法及系统
CN113607053A (zh) * 2021-08-13 2021-11-05 西北工业大学 基于筒体内表面特征点的位姿调整装置、方法及系统

Also Published As

Publication number Publication date
CN114986132B (zh) 2023-08-08

Similar Documents

Publication Publication Date Title
US9149931B2 (en) Robot system, robot control device and method for controlling robot
US20200338730A1 (en) Trajectory planning device, trajectory planning method and program
CN111360827B (zh) 一种视觉伺服切换控制方法及系统
EP2835228B1 (en) Robot apparatus and robot controlling method
CN108839025B (zh) 一种移动机械臂的运动规划方法和装置
KR20180059888A (ko) 로봇교시방법 및 로봇 암 제어장치
CN107671853B (zh) 开放式机器人轨迹规划控制方法及系统
CN109311163B (zh) 校正机器人的运动控制命令的方法及其相关设备
Nandikolla et al. Teleoperation Robot Control of a Hybrid EEG‐Based BCI Arm Manipulator Using ROS
CN112975947B (zh) 元器件引脚的矫正方法、装置、设备及存储介质
CN112045664A (zh) 一种基于ros系统的通用机械臂控制器
CN115703227A (zh) 机器人的控制方法、机器人以及计算机可读存储介质
CN114986132A (zh) 一种基于视觉传感的机器人柔性轴孔装配方法及装置
JP7256932B1 (ja) 教示装置
JP2703767B2 (ja) ロボットの教示データ作成方法
CN114179081A (zh) 角度传达误差的补偿方法、装置和计算机可读存储介质
CN109664273B (zh) 一种工业机器人光标拖动示教方法及系统
CN112118918B (zh) 折弯跟随轨迹规划方法、折弯系统、机器人和存储装置
CN116945195B (zh) 全向测量设备系统装置、配准方法、电子设备和存储介质
JP2737325B2 (ja) ロボットの軌道生成方式
CN116985147B (zh) 机械臂逆运动学求解方法及装置
US20240066700A1 (en) Device for simulating operation of robot, device for controlling robot, and method for simulating operation of robot
CN116852397B (zh) 负压理疗机器人理疗力度及理疗路径的自适应调节方法
US20230398687A1 (en) Method for generating movement route of robot, movement route generation apparatus, robot system, and program
CN113600650B (zh) 一种机器人弯管机的坐标系自动标定方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant