CN109877840A - 一种基于相机光轴约束的双机械臂标定方法 - Google Patents
一种基于相机光轴约束的双机械臂标定方法 Download PDFInfo
- Publication number
- CN109877840A CN109877840A CN201910261733.3A CN201910261733A CN109877840A CN 109877840 A CN109877840 A CN 109877840A CN 201910261733 A CN201910261733 A CN 201910261733A CN 109877840 A CN109877840 A CN 109877840A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- calibration
- coordinate system
- base
- arm
- 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
Links
- 230000003287 optical effect Effects 0.000 title claims abstract description 62
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000000007 visual effect Effects 0.000 claims abstract description 15
- 239000011159 matrix material Substances 0.000 claims description 60
- 230000009466 transformation Effects 0.000 claims description 34
- 239000013598 vector Substances 0.000 claims description 33
- 238000013461 design Methods 0.000 claims description 3
- 239000003550 marker Substances 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 5
- 230000009977 dual effect Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000005299 abrasion Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Numerical Control (AREA)
Abstract
本发明涉及一种基于相机光轴约束的双机械臂标定方法,包括以下步骤:步骤一:构建双机械臂标定系统;步骤二:建立基于误差模型的参数标定方程;步骤三:基于视觉控制的特征点对齐及位置数据获取;步骤四:求解标定方程。本发明仅利用相机和棋盘格标定板构建双机械臂标定系统,操作简便,不需要昂贵的高精度仪器和精心制作的标定工具,降低了标定成本;本发明标定精度更高,标定步骤更少,操作更加方便;本发明使用基于图像的视觉控制方法控制主动机械臂运动,使特征点自动与相机光轴对齐,标定过程无需专业人员操作,仅需操作者进行简单的监督即可;本发明适用于各类双臂协作系统,标定精度高,标定结果可满足大部分双臂协作任务的需求。
Description
技术领域
本发明涉及一种双机械臂标定方法,特别是一种基于相机光轴约束的双机械臂标定方法,属于机器人标定领域。
背景技术
双臂机器人作为机器人产业发展的重大标志性产品之一,在工业、生活、医疗、航空航天等领域有着越来越广泛的应用。双机械臂可以合作完成单个机械臂难以完成的任务,如移动质量或体积大的物体、多部件复杂装配、柔性物体的处理等,具有节约成本、节省空间、提高生产效率等优点。在双臂协作完成各种任务时,双臂系统的精度直接影响了任务的完成程度和成功率,零件装配等任务对双臂系统的精度提出了更高的要求。为了提高双臂系统的定位精度,必须对其进行有效的标定。
在双臂系统完成协作任务时,两机械臂基座的相对关系需要提前已知,即为双机械臂的基坐标标定。对于双机械臂系统,一般只进行基坐标标定,而由于制造公差、环境变化和磨损等因素的影响,机械臂实际的运动学参数与其出厂设置的名义运动学参数存在误差,导致机械臂的末端绝对定位精度降低,因此需要进行运动学参数标定。目前,机械臂运动学参数标定和基坐标系标定通常使用高精度的测量仪器或精心制作的标定工具,这类方法价格昂贵且需要专业的人员操作,不适合大多数场景中对简单有效标定的要求,并且机械臂运动学参数标定和基坐标标定通常分开进行,使用不同的标定设备和标定方法,使标定过程更加复杂。
发明内容
针对上述现有技术,本发明要解决的技术问题是提供一种不需要昂贵的标定设备,精度高且操作简单的基于相机光轴约束的双机械臂标定方法。
为解决上述技术问题,本发明提供一种基于相机光轴约束的双机械臂标定方法,包括以下步骤:
步骤一:构建双机械臂标定系统;
步骤二:建立基于误差模型的参数标定方程;
步骤三:基于视觉控制的特征点对齐及位置数据获取;
步骤四:求解标定方程。
本发明还包括:
1.步骤一中双机械臂标定系统具体为:包括两个机械臂,在其中一个机械臂的末端固定一个相机,此机械臂为被动机械臂;另一个机械臂末端固定一个棋盘格标定板,此机械臂为主动机械臂。
2.步骤二中建立基于误差模型的参数标定方程具体为:
步骤1:分别对每个机械臂建立运动学误差模型,得到机械臂的末端位置误差ΔPe与运动学参数误差向量之间的关系:其中JP为运动学位置误差雅可比矩阵;
步骤2:根据建立的运动学误差模型,推导基于直线约束的运动学误差模型,得到运动学参数标定方程:其中E为位置对齐误差,Φ为运动学误差雅可比矩阵;
步骤3:建立两机械臂的基座姿态变换误差模型,得到双臂基坐标姿态变换矩阵的标定方程,具体为:其中,{A}为主动机械臂基坐标系,{P}和{H}分别为被动机械臂基坐标系和末端坐标系,{C}为相机坐标系,AZC和PRH分别为相机Z轴向量相对于主动机械臂基坐标系的向量和被动机械臂末端相对于其基坐标的姿态矩阵;PRA和HZC分别为主动机械臂基坐标系相对于被动机械臂基坐标系的姿态矩阵和相机Z轴相对于被动机械臂末端的向量,和是HZC和PRA的名义值,ΔHZC和ΔPRA是HZC和PRA的误差;
步骤4:建立两机械臂的基座位置变换误差模型,得到双臂基坐标位置变换矩阵的标定方程,具体为:Jm[ΔAPP,A,ΔHPC,H]T=ρm,其中APP,A和HPC,H分别为在主动机械臂基坐标系中描述的被动机械臂基坐标相对于主动机械臂基坐标的位置向量和在被动机械臂末端坐标系中描述的相机到被动机械臂末端的位置向量,上述两个向量的误差分别为ΔAPP,A和ΔHPC,H,Jm为基坐标位置误差雅可比矩阵,其中μk为光轴向量,I为单位矩阵,ρm为位置误差矩阵,其中,i为特征点当前的位置数,i≤p,k为光轴当前的位置数,k≤n,·(i,k)为特征点在第k条光轴上第i个位置处变量·的值,{A}和{E}分别为主动机械臂基坐标系和末端坐标系,{P}和{H}分别为被动机械臂基坐标系和末端坐标系,{C}和{F}分别为相机坐标系和工具中心坐标系,ARP为被动机械臂基坐标系相对于主动机械臂基坐标系的姿态矩阵,PRH和ARE分别为被动机械臂末端相对于被动机械臂基座的姿态矩阵和主动机械臂末端相对于主动机械臂基座的姿态矩阵,APE,A为在主动机械臂基坐标系中描述的主动机械臂末端相对于主动机械臂基座的位置向量,EPF,E为在主动机械臂末端坐标系中描述的工具坐标系相对于主动机械臂末端的位置向量,PPH,P为在被动机械臂基坐标系中描述的被动机械臂末端相对于被动机械臂基座的位置向量,和分别为HPC,H和APP,A的名义值。
3.步骤三中基于视觉控制的特征点对齐及位置数据获取具体为:
步骤1:被动机械臂末端位姿固定,利用基于图像的视觉控制方法控制主动机械臂运动,使特征点自动运动到光轴上,记录此时两机械臂的关节角;
步骤2:改变主动机械臂末端位姿,重复步骤1,使特征点依次到达光轴上n个不同的位置,其中n≥3;
步骤3:改变被动机械臂末端位姿,重复步骤1–2;
步骤4:根据记录的特征点与光轴对齐时两机械臂的关节角,利用每个机械臂的正运动学计算每个位置点处机械臂末端相对于基坐标系的名义位姿;
步骤5:互换相机和棋盘格标定板的位置,重复步骤1–4。
4.步骤四中求解标定方程具体为:
步骤1:根据运动学参数标定方程使用迭代最小二乘法求解每个机械臂的运动学参数误差,得到两个机械臂真实的运动学参数;
步骤2:根据双臂基坐标姿态变换矩阵标定方程迭代估计基坐标姿态变换矩阵;
步骤3:根据双臂基坐标位置变换矩阵标定方程Jm[ΔAPP,A,ΔHPC,H]T=ρm,估计基坐标位置变换矩阵。
本发明有益效果:针对现有技术的缺陷和改进需求,本发明提供了一种基于相机光轴约束的双机械臂标定方法,利用相机光轴构建虚拟约束,建立基于直线约束的标定方程,令两机械臂运动到满足约束的位姿,测量的机械臂关节角及位姿数据同时用于运动学参数标定方程和基坐标标定方程,通过对标定方程求解估计得到真实的参数值。本发明不需要昂贵的标定设备,仅需相机和棋盘格标定板即可同时完成运动学参数标定和基坐标标定,标定精度高且操作简单,可直接应用于各场景的双臂系统标定中。本发明可同时实现两个机械臂的运动学参数标定和基坐标位姿变换矩阵标定。
1.本发明仅利用相机和棋盘格标定板构建双机械臂标定系统,操作简便,不需要昂贵的高精度仪器和精心制作的标定工具,降低了标定成本;
2.本发明基于相机光轴约束同时完成两个机械臂的运动学参数标定和基坐标标定,与使用不同方法分别标定运动学参数和基坐标的方法相比,本发明标定精度更高,标定步骤更少,操作更加方便;
3.本发明使用基于图像的视觉控制方法控制主动机械臂运动,使特征点自动与相机光轴对齐,标定过程无需专业人员操作,仅需操作者进行简单的监督即可;
4.本发明的标定方法适用于各类双臂协作系统,标定精度高,标定结果可满足大部分双臂协作任务的需求。
附图说明
图1是本发明的双机械臂标定系统示意图;
图2是本发明的特征点位置与光轴的相对关系图;
图3是本发明的双机械臂标定系统坐标系分布图;
图4是本发明的基于图像的视觉控制框图;
图5是本发明的特征点在一条光轴上的位置图。
具体实施方式
下面结合附图对本发明进行详细说明。
本发明提供了一种基于相机光轴约束的双机械臂标定方法。目前机器人飞速发展,越来越多的领域需要双臂协作机器人,为了顺利完成操作任务,必须对双臂系统进行标定。针对目前双臂协作机器人的定位精度较低的问题,本发明同时完成两个机械臂的运动学参数标定和基坐标标定,为双臂系统完成高精度任务提供技术支持。本发明的基本思想是令安装在一个机械臂末端的相机的光轴作为虚拟直线约束,另一个机械臂的末端位姿满足光轴虚拟约束,基于直线约束建立机械臂的运动学误差模型和基坐标误差模型,根据误差模型建立标定方程,通过对标定方程求解估计得到真实的机械臂运动学参数和基坐标位姿变换矩阵。本发明包括:构建典型的双机械臂标定系统,其中一个机械臂末端安装相机,另一个机械臂末端安装棋盘格标定板,将标定板上的中心角点作为特征点;建立双机械臂系统的参数误差模型,得到参数标定方程;将相机光轴作为虚拟约束,通过视觉控制方法控制特征点依次到达光轴上的多个不同位置,获取标定方程所需的位置信息;对标定方程求解,得到两机械臂的运动学参数和两机械臂基坐标的位姿变换矩阵,以此完成双臂系统的参数标定。本发明成本低、易操作,不需要昂贵的高精度测量设备和特定的标定工具,仅利用相机和机器人的关节角数据即可完成标定,对双机械臂系统标定具有通用性,适用于各类双臂协作环境。
本发明采用了以下技术方案:
基于相机光轴约束的双机械臂标定方法,包括构建双机械臂标定系统、建立基于误差模型的参数标定方程、基于视觉控制的特征点对齐及数据获取、标定方程求解。其中:
(1)构建双机械臂标定系统,其中一个机械臂末端固定一个相机,另一个机械臂末端固定一个棋盘格标定板;
(2)将相机光轴作为虚拟直线约束,建立基于直线约束的双臂系统的参数误差模型,包括运动学误差模型、基坐标姿态误差模型和基坐标位置误差模型,分别推导得到运动学参数和双臂基坐标位姿变换矩阵的标定方程;
(3)选择标定板的中心角点作为特征点,使用基于图像的视觉控制方法控制特征点依次到达相机光轴的多个位置,记录并保存位置对齐时两机械臂的关节角数据,并获取标定方程所需的位置信息;
(4)求解标定方程,估计真实的运动学参数及双臂基坐标位姿变换矩阵,完成双臂系统的标定。
在一些实施方式中,构建双机械臂标定系统具体为:
典型的双机械臂系统包括两个机械臂,构建双机械臂标定系统,参见图1:在其中一个机械臂的末端固定一个相机2,此机械臂称为被动机械臂4;另一个机械臂末端固定一个棋盘格标定板1,此机械臂称为主动机械臂3。
在一些实施方式中,建立基于误差模型的参数标定方程具体为:
(1)基于机械臂的正运动学方程分别对每个机械臂建立运动学误差模型,得到末端位置误差ΔPe与运动学参数误差向量之间的关系:其中JP为运动学位置误差雅可比矩阵。
(2)根据建立的运动学误差模型,推导基于直线约束的运动学误差模型,得到运动学参数标定方程。
选择标定板上的中心角点作为特征点,将特征点看作主动机械臂3的工具中心点,特征点在多个位置处与相机光轴对齐,此时主动机械臂3真实的末端位姿也满足直线约束,由于存在运动学参数误差,根据当前主动机械臂3的关节角计算的名义末端位姿也存在误差,且不满足光轴直线约束。
参见图2,假设与第k条光轴对齐的第i个位置点处主动机械臂3的真实位姿为对应的名义值为它们之间的差为:
分别将与沿着光轴方向进行分解,得到:
其中,为相机坐标系原点,μk为光轴向量,s(i,k)与分别为与沿光轴方向的分量,为与光轴方向垂直的分量,由于位于光轴上,所以它与光轴垂直的分量为0.
那么,的等式可以表示为:在其两边同乘[μk×],得到:
同理,位置处有:
上面两式相减得到:
将上式表示为:其中
对于所有与光轴对齐的位置点有:此式即为机械臂运动学参数的标定方程。
(3)建立两机械臂的基座姿态变换误差模型,得到双臂基坐标姿态变换矩阵的标定方程。
参见图3,图中在双机械臂标定系统中表示了各坐标系的符号表示,{A}和{E}分别为主动机械臂3基坐标系和末端坐标系,{P}和{H}分别为被动机械臂4基坐标系和末端坐标系,{C}和{F}分别为相机坐标系和工具中心坐标系。
根据坐标系的变换关系,得到:
PRA AZC=PRH HZC
其中,AZC和PRH分别为相机Z轴向量相对于主动机械臂3基坐标系的向量和被动机械臂4末端相对于其基坐标的姿态矩阵,它们在运动学参数标定中可获得;PRA和HZC分别为主动机械臂基坐标系相对于被动机械臂基坐标系的姿态矩阵和相机Z轴相对于被动机械臂4末端的向量,将其误差分别表示为ΔPRA和ΔHZC。那么上式可写为:
进一步得到:此式为基坐标姿态变换矩阵的标定方程,通过求解可估计得到两机械臂基坐标的姿态矩阵误差ΔPRA。
(4)建立两机械臂的基座位置变换误差模型,得到双臂基坐标位置变换的标定方程。
根据坐标系的变换关系:
ARP PRH HPC,H+ARP PPH,P+APP,A=APE,A+ARE EPF,E+APC,F
其中,ARE为主动机械臂3末端执行器相对于主动机械臂基座的姿态矩阵,可以通过机械臂运动学计算得到;PPH,P,APE,A和EPF,E分别为被动机械臂4末端到其基座的位置向量,主动机械臂3末端到其基座的位置向量和标定板到主动机械臂3末端的位置向量,他们的真实值通过机械臂运动学参数标定均可计算得到;APC,F为相机坐标系到标定板的位置矩阵,无法计算得到,下文中通过推导将其消掉;APP,A和HPC,H分别为两机械臂基座的位置向量和相机到被动机械臂4末端的位置向量,他们的误差分别为ΔAPP,A和ΔHPC,H。那么上式可以表示为:
对于与第k条光轴对齐的位置i处的特征点,用上式可表示为:
对上式两边同乘[μk×],可以得到:
将上式写为:其中,I为单位矩阵,
对于n条光轴上所有p个与光轴对齐的位置点有:Jm[ΔAPP,A,ΔHPC,H]T=ρm,其中为基坐标位置误差雅可比矩阵,为位置误差矩阵。此式即为双机械臂基坐标位置变换矩阵的标定方程。
在一些实施方式中,基于视觉控制的特征点对齐及位置数据获取具体为:
(1)被动机械臂4末端位姿固定,标定板1始终在相机的视野范围内,利用基于图像的视觉控制方法控制主动机械臂3运动,视觉控制框图参见图4,包括位置控制内环和图像控制外环,图像控制外环实时监测当前特征点与光轴在图像中的位置差,并将其转化为主动机械臂3末端的位置差,机械臂位置控制内环根据位置差不断调整机械臂位姿,直到特征点与光轴对齐。当特征点与光轴对齐时,记录此时两个机械臂的关节角。
(2)参见图5,改变主动机械臂3末端位姿后重复步骤(1),使特征点依次到达第k条光轴上n(n≥3)个不同的位置P(1,k),P(2,k),…,P(n,k)。
(3)改变被动机械臂4末端位姿,即改变相机光轴的位置,重复步骤(1)–(2)。
(4)根据记录的特征点与光轴对齐时两机械臂的关节角,利用每个机械臂的正运动学计算每个位置点处机械臂末端与基座的相对名义位姿ETA、PTH。
(5)互换相机2和标定板1的位置,重复步骤(1)–(4)。
在一些实施方式中,标定方程求解具体为:
(1)根据运动学参数标定方程迭代求解每个机械臂的运动学参数误差,得到两个机械臂真实的运动学参数。
首先根据主动机械臂3的名义位姿估计相机光轴在主动机械臂基坐标系的向量值,假设第k条光轴上位置i处主动机械臂3的名义位置坐标为那么第k条光轴向量μk(xk,yk,zk)为:
其中,n为与第k条光轴对齐的特征点的所有位置数。
然后计算得到运动学标定方程中的对齐误差矩阵E和雅可比矩阵Φ。
最后使用迭代LM(Levenberg-Marquardt)算法求解运动学标定方程,第t次迭代中,估计的运动学参数误差为:
其中λLM(t)为LM参数:
h为2~10之间的常数,ε(t)为迭代t次时运动学标定误差:
(2)根据双臂基坐标姿态变换矩阵标定方程:迭代估计基坐标姿态变换矩阵参数,包括以下步骤:
(2.1)初始化,ΔPRA=0。
(2.2)对于特征点的第i个位置,估计在第t次迭代的值:
(2.3)在特征点所有位置处估计进而估计真实的相机坐标系z轴在被动机械臂4末端坐标系下的向量
其中,q为与光轴对齐的特征点的所有位置数。
(2.4)利用重新估计ΔPRA(t):
ΔPRA(t)=S(v(t)),
其中,
n为光轴位置变化的次数。
(2.5)得到第t+1次迭代时主动机械臂3与被动机械臂4基座间的姿态变换矩阵并将其进行标准正交化。
(2.6)重复步骤(2.2)–(2.5),直至ΔPRA(t)收敛趋近于0。
(3)根据双臂基坐标位置变换标定方程Jm[ΔAPP,A,ΔHPC,H]T=ρm,估计基坐标位置变换矩阵。
根据上文计算的所有参数的真实值,可以计算Jm,因为Jm是非满秩矩阵,将其写为:
Jm=VmΣmUm,
然后估计[ΔAPP,A,ΔHPC,H]T:其中Σm +为Σm的伪逆矩阵。最后估计真实的基坐标位置变换矩阵APP,A:
Claims (5)
1.一种基于相机光轴约束的双机械臂标定方法,其特征在于,包括以下步骤:
步骤一:构建双机械臂标定系统;
步骤二:建立基于误差模型的参数标定方程;
步骤三:基于视觉控制的特征点对齐及位置数据获取;
步骤四:求解标定方程。
2.根据权利要求书1所述的一种基于相机光轴约束的双机械臂标定方法,其特征在于:
步骤一所述的双机械臂标定系统具体为:包括两个机械臂,在其中一个机械臂的末端固定一个相机,此机械臂为被动机械臂;另一个机械臂末端固定一个棋盘格标定板,此机械臂为主动机械臂。
3.根据权利要求书1中所述的一种基于相机光轴约束的双机械臂标定方法,其特征在于:
步骤二所述的建立基于误差模型的参数标定方程具体为:
步骤1:分别对每个机械臂建立运动学误差模型,得到机械臂的末端位置误差ΔPe与运动学参数误差向量之间的关系:其中JP为运动学位置误差雅可比矩阵;
步骤2:根据建立的运动学误差模型,推导基于直线约束的运动学误差模型,得到运动学参数标定方程:其中E为位置对齐误差,Φ为运动学误差雅可比矩阵;
步骤3:建立两机械臂的基座姿态变换误差模型,得到双臂基坐标姿态变换矩阵的标定方程,具体为:其中,{A}为主动机械臂基坐标系,{P}和{H}分别为被动机械臂基坐标系和末端坐标系,{C}为相机坐标系,AZC和PRH分别为相机Z轴向量相对于主动机械臂基坐标系的向量和被动机械臂末端相对于其基坐标的姿态矩阵;PRA和HZC分别为主动机械臂基坐标系相对于被动机械臂基坐标系的姿态矩阵和相机Z轴相对于被动机械臂末端的向量,和是HZC和PRA的名义值,ΔHZC和ΔPRA是HZC和PRA的误差;
步骤4:建立两机械臂的基座位置变换误差模型,得到双臂基坐标位置变换矩阵的标定方程,具体为:Jm[ΔAPP,A,ΔHPC,H]T=ρm,其中APP,A和HPC,H分别为在主动机械臂基坐标系中描述的被动机械臂基坐标相对于主动机械臂基坐标的位置向量和在被动机械臂末端坐标系中描述的相机到被动机械臂末端的位置向量,上述两个向量的误差分别为ΔAPP,A和ΔHPC,H,Jm为基坐标位置误差雅可比矩阵,其中μk为光轴向量,I为单位矩阵,ρm为位置误差矩阵,其中,i为特征点当前的位置数,i≤p,k为光轴当前的位置数,k≤n,·(i,k)为特征点在第k条光轴上第i个位置处变量·的值,{A}和{E}分别为主动机械臂基坐标系和末端坐标系,{P}和{H}分别为被动机械臂基坐标系和末端坐标系,{C}和{F}分别为相机坐标系和工具中心坐标系,ARP为被动机械臂基坐标系相对于主动机械臂基坐标系的姿态矩阵,PRH和ARE分别为被动机械臂末端相对于被动机械臂基座的姿态矩阵和主动机械臂末端相对于主动机械臂基座的姿态矩阵,APE,A为在主动机械臂基坐标系中描述的主动机械臂末端相对于主动机械臂基座的位置向量,EPF,E为在主动机械臂末端坐标系中描述的工具坐标系相对于主动机械臂末端的位置向量,PPH,P为在被动机械臂基坐标系中描述的被动机械臂末端相对于被动机械臂基座的位置向量,和分别为HPC,H和APP,A的名义值。
4.根据权利要求书1中所述的一种基于相机光轴约束的双机械臂标定方法,其特征在于:
步骤三所述的基于视觉控制的特征点对齐及位置数据获取具体为:
步骤1:被动机械臂末端位姿固定,利用基于图像的视觉控制方法控制主动机械臂运动,使特征点自动运动到光轴上,记录此时两机械臂的关节角;
步骤2:改变主动机械臂末端位姿,重复步骤1,使特征点依次到达光轴上n个不同的位置,其中n≥3;
步骤3:改变被动机械臂末端位姿,重复步骤1–2;
步骤4:根据记录的特征点与光轴对齐时两机械臂的关节角,利用每个机械臂的正运动学计算每个位置点处机械臂末端相对于基坐标系的名义位姿;
步骤5:互换相机和棋盘格标定板的位置,重复步骤1–4。
5.根据权利要求书1中所述的一种基于相机光轴约束的双机械臂系统及标定方法,其特征在于:
步骤四所述的求解标定方程具体为:
步骤1:根据运动学参数标定方程使用迭代最小二乘法求解每个机械臂的运动学参数误差,得到两个机械臂真实的运动学参数;
步骤2:根据双臂基坐标姿态变换矩阵标定方程迭代估计基坐标姿态变换矩阵;
步骤3:根据双臂基坐标位置变换矩阵标定方程Jm[ΔAPP,A,ΔHPC,H]T=ρm,估计基坐标位置变换矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910261733.3A CN109877840B (zh) | 2019-04-02 | 2019-04-02 | 一种基于相机光轴约束的双机械臂标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910261733.3A CN109877840B (zh) | 2019-04-02 | 2019-04-02 | 一种基于相机光轴约束的双机械臂标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109877840A true CN109877840A (zh) | 2019-06-14 |
CN109877840B CN109877840B (zh) | 2021-09-28 |
Family
ID=66935793
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910261733.3A Active CN109877840B (zh) | 2019-04-02 | 2019-04-02 | 一种基于相机光轴约束的双机械臂标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109877840B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110405731A (zh) * | 2019-07-19 | 2019-11-05 | 南京理工大学 | 一种快速双机械臂基坐标系标定方法 |
CN111055287A (zh) * | 2020-01-13 | 2020-04-24 | 广州启帆工业机器人有限公司 | 一种双机器人协作同步的方法、系统、装置和存储介质 |
CN112815848A (zh) * | 2021-02-02 | 2021-05-18 | 中国人民解放军陆军装甲兵学院 | 一种双目相机与机械臂坐标系配准方法 |
CN113093356A (zh) * | 2021-03-18 | 2021-07-09 | 北京空间机电研究所 | 一种基于机械臂的大型分块光学组件装配方法 |
CN113386130A (zh) * | 2021-05-21 | 2021-09-14 | 北部湾大学 | 一种仿生蛇形机器人控制系统及其控制方法 |
CN113524183A (zh) * | 2021-07-14 | 2021-10-22 | 广东智源机器人科技有限公司 | 相对位置获得方法、机械臂控制方法以及机械臂系统 |
CN113799127A (zh) * | 2021-09-15 | 2021-12-17 | 华南理工大学 | 光学双目定位系统下六自由度机械臂无标定位姿定位方法 |
CN113858266A (zh) * | 2020-06-30 | 2021-12-31 | 上海微创数微医疗科技有限公司 | 机械臂的位姿误差的检测方法及系统 |
CN114713890A (zh) * | 2021-12-13 | 2022-07-08 | 上海工程技术大学 | 基于双臂协作的环面蜗轮滚刀前刀面加工系统及其方法 |
CN115227398A (zh) * | 2022-09-19 | 2022-10-25 | 杭州三坛医疗科技有限公司 | 一种配准板自动摆位方法和装置 |
CN118596157B (zh) * | 2024-08-05 | 2024-10-01 | 成都博恩思医学机器人有限公司 | 一种机械臂控制方法、装置、电子设备及存储介质 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080084566A1 (en) * | 2004-10-15 | 2008-04-10 | Mtu Aero Engines Gmbh | Method And System For Synchronising Angles |
CN102848389A (zh) * | 2012-08-22 | 2013-01-02 | 浙江大学 | 基于视觉运动捕捉的机械臂标定及跟踪系统实现方法 |
CN103791871A (zh) * | 2014-02-20 | 2014-05-14 | 国家电网公司 | 多关节机械臂标定方法 |
DE102012112025A1 (de) * | 2012-12-10 | 2014-06-12 | Carl Zeiss Ag | Verfahren und Vorrichtungen zur Positionsbestimmung einer Kinematik |
CN104215206A (zh) * | 2014-09-28 | 2014-12-17 | 东南大学 | 一种双机器人协作系统的基坐标标定方法 |
CN105751245A (zh) * | 2016-03-30 | 2016-07-13 | 广东工业大学 | 一种用于标定多机器人系统基坐标系的方法及其设备 |
CN107030679A (zh) * | 2017-05-31 | 2017-08-11 | 贾相晟 | 一种针对机械臂的主从模式示教系统及示教方法 |
CN108519055A (zh) * | 2018-04-26 | 2018-09-11 | 华中科技大学 | 一种基于视觉的双机器人相对位姿在线标定方法 |
-
2019
- 2019-04-02 CN CN201910261733.3A patent/CN109877840B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080084566A1 (en) * | 2004-10-15 | 2008-04-10 | Mtu Aero Engines Gmbh | Method And System For Synchronising Angles |
CN102848389A (zh) * | 2012-08-22 | 2013-01-02 | 浙江大学 | 基于视觉运动捕捉的机械臂标定及跟踪系统实现方法 |
DE102012112025A1 (de) * | 2012-12-10 | 2014-06-12 | Carl Zeiss Ag | Verfahren und Vorrichtungen zur Positionsbestimmung einer Kinematik |
CN103791871A (zh) * | 2014-02-20 | 2014-05-14 | 国家电网公司 | 多关节机械臂标定方法 |
CN104215206A (zh) * | 2014-09-28 | 2014-12-17 | 东南大学 | 一种双机器人协作系统的基坐标标定方法 |
CN105751245A (zh) * | 2016-03-30 | 2016-07-13 | 广东工业大学 | 一种用于标定多机器人系统基坐标系的方法及其设备 |
CN107030679A (zh) * | 2017-05-31 | 2017-08-11 | 贾相晟 | 一种针对机械臂的主从模式示教系统及示教方法 |
CN108519055A (zh) * | 2018-04-26 | 2018-09-11 | 华中科技大学 | 一种基于视觉的双机器人相对位姿在线标定方法 |
Non-Patent Citations (1)
Title |
---|
朱齐丹等: "基于光轴约束的机械臂运动学标定方法", 《哈尔滨工程大学学报》 * |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110405731A (zh) * | 2019-07-19 | 2019-11-05 | 南京理工大学 | 一种快速双机械臂基坐标系标定方法 |
CN111055287A (zh) * | 2020-01-13 | 2020-04-24 | 广州启帆工业机器人有限公司 | 一种双机器人协作同步的方法、系统、装置和存储介质 |
CN111055287B (zh) * | 2020-01-13 | 2021-06-08 | 广州机械科学研究院有限公司 | 一种双机器人协作同步的方法、系统、装置和存储介质 |
CN113858266A (zh) * | 2020-06-30 | 2021-12-31 | 上海微创数微医疗科技有限公司 | 机械臂的位姿误差的检测方法及系统 |
CN112815848A (zh) * | 2021-02-02 | 2021-05-18 | 中国人民解放军陆军装甲兵学院 | 一种双目相机与机械臂坐标系配准方法 |
CN112815848B (zh) * | 2021-02-02 | 2022-06-03 | 中国人民解放军陆军装甲兵学院 | 一种双目相机与机械臂坐标系配准方法 |
CN113093356A (zh) * | 2021-03-18 | 2021-07-09 | 北京空间机电研究所 | 一种基于机械臂的大型分块光学组件装配方法 |
CN113093356B (zh) * | 2021-03-18 | 2022-08-12 | 北京空间机电研究所 | 一种基于机械臂的大型分块光学组件装配方法 |
CN113386130A (zh) * | 2021-05-21 | 2021-09-14 | 北部湾大学 | 一种仿生蛇形机器人控制系统及其控制方法 |
CN113386130B (zh) * | 2021-05-21 | 2023-02-03 | 北部湾大学 | 一种仿生蛇形机器人控制系统及其控制方法 |
CN113524183A (zh) * | 2021-07-14 | 2021-10-22 | 广东智源机器人科技有限公司 | 相对位置获得方法、机械臂控制方法以及机械臂系统 |
CN113799127A (zh) * | 2021-09-15 | 2021-12-17 | 华南理工大学 | 光学双目定位系统下六自由度机械臂无标定位姿定位方法 |
CN113799127B (zh) * | 2021-09-15 | 2023-05-23 | 华南理工大学 | 光学双目定位系统下六自由度机械臂无标定位姿定位方法 |
CN114713890A (zh) * | 2021-12-13 | 2022-07-08 | 上海工程技术大学 | 基于双臂协作的环面蜗轮滚刀前刀面加工系统及其方法 |
CN114713890B (zh) * | 2021-12-13 | 2023-08-29 | 上海工程技术大学 | 基于双臂协作的环面蜗轮滚刀前刀面加工系统及其方法 |
CN115227398A (zh) * | 2022-09-19 | 2022-10-25 | 杭州三坛医疗科技有限公司 | 一种配准板自动摆位方法和装置 |
CN115227398B (zh) * | 2022-09-19 | 2023-03-03 | 杭州三坛医疗科技有限公司 | 一种配准板自动摆位方法和装置 |
CN118596157B (zh) * | 2024-08-05 | 2024-10-01 | 成都博恩思医学机器人有限公司 | 一种机械臂控制方法、装置、电子设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN109877840B (zh) | 2021-09-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109877840B (zh) | 一种基于相机光轴约束的双机械臂标定方法 | |
CN108789404B (zh) | 一种基于视觉的串联机器人运动学参数标定方法 | |
CN111775146B (zh) | 一种工业机械臂多工位作业下的视觉对准方法 | |
CN109859275B (zh) | 一种基于s-r-s结构的康复机械臂的单目视觉手眼标定方法 | |
CN107738254B (zh) | 一种机械臂坐标系的转换标定方法与系统 | |
US20200298411A1 (en) | Method for the orientation of an industrial robot, and industrial robot | |
CN109304730B (zh) | 一种基于激光测距仪的机器人运动学参数标定方法 | |
CN111415391B (zh) | 一种采用互拍法的多目相机外部方位参数标定方法 | |
CN110253574B (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
CN110919658B (zh) | 一种基于视觉和多坐标系闭环转换的机器人标定方法 | |
CN113160334B (zh) | 一种基于手眼相机的双机器人系统标定方法 | |
Hu et al. | Automatic calibration of hand–eye–workspace and camera using hand-mounted line laser | |
CN113386136A (zh) | 一种基于标准球阵目标估计的机器人位姿矫正方法及系统 | |
CN109176487A (zh) | 一种联动关节段标定方法、系统、设备、存储介质 | |
CN113211445B (zh) | 一种机器人参数标定方法、装置、设备及存储介质 | |
CN112958960B (zh) | 一种基于光学靶标的机器人手眼标定装置 | |
CN111360585B (zh) | 一种机器人铣削系统中刀具端实时位置误差的获取方法 | |
CN110962127B (zh) | 一种用于机械臂末端位姿辅助标定装置及其标定方法 | |
CN114654466A (zh) | 自动标定方法、装置、系统、电子设备及存储介质 | |
King et al. | Vision guided robots for automated assembly | |
CN112123329A (zh) | 一种机器人3d视觉手眼标定方法 | |
Geng et al. | Calibration of Kinematic Parameters of Industrial Robot Based on Binocular Vision and Distance Error Model | |
Weber et al. | Visual servoing using triangulation with an omnidirectional multi-camera system | |
CN113894809B (zh) | 一种工业机器人运动学模型几何参数的获取方法 | |
CN114643599B (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 |