CN105180962A - 一种基于空间两点投影的协同机器人基座标系标定方法 - Google Patents
一种基于空间两点投影的协同机器人基座标系标定方法 Download PDFInfo
- Publication number
- CN105180962A CN105180962A CN201510289603.2A CN201510289603A CN105180962A CN 105180962 A CN105180962 A CN 105180962A CN 201510289603 A CN201510289603 A CN 201510289603A CN 105180962 A CN105180962 A CN 105180962A
- Authority
- CN
- China
- Prior art keywords
- robot
- coordinate system
- calibration
- relative
- base coordinate
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种基于空间两点投影的协同机器人基座标系标定方法。将所有机器人以最小标定单位进行分组,建立两台机器人基座标系,在两台机器人各自基座标系原点连线的两侧各任意确定一标定点,将机器人末端点在标定点处以握手方式接触获得关节转角信息;建立D-H坐标系计算末端姿态矩阵、末端RPY转角以及两个标定点在基座标系下的坐标值;将机器人与标定点进行投影,计算得到三个矩阵,将三个矩阵相组合得到相对位姿变换矩阵,每个最小标定单位均重复步骤而完成协同机器人基座标系的标定。本发明依靠空间投影充分利用机器人***自身设施,需要标定空间点数量少,有效降低了成本,显著缩短了时间,有效提高了效率,适应范围广。
Description
技术领域
本发明涉及了一种机器人标定方法,尤其是涉及了一种基于空间两点投影的协同机器人基座标系标定方法,涉及工业生产中的焊接,搬运,雕刻以及喷涂等诸多工业机器人复杂柔性化***制造领域。
背景技术
随着工业4.0时代的到来,许多领域诸如大型复杂零部件的加工,装配和搬运,无夹具***的焊接,喷涂以及雕刻等,传统的单个机器人已经不能很好的满足其加工要求,因此研究具有协同作业关系的多机器人***将成为工业发展的必然趋势。多机器人***在协同作业时需要预先对其每个机器人的相对位置进行标定确认,即对于具有协同作业关系的机器人之间需要精确的对其基座标系进行标定,从而准确的知道每个机器人基座标系之间的相对位姿关系,然后才能对其运行的轨迹进行准确规划。
当前工业生产中,针对多机器人***的基座标系标定依然缺乏较为有效的方法,主要分为两大类:接触式标定方法和非接触式标定方法,非接触式标定方法中一般都需要增加外部传感器和测量仪等装置,标定步骤繁琐以及精度也较为有限。现有的接触式标定方法中,已经提出有通过插孔、法兰盘接触等方法,标定步骤较非接触式标定方法也有了一定优化,但插孔、法兰盘重合等方式中示教的难度较大,需要选定的标定点数量较多并且选择规则复杂。
发明内容
为了解决多机器人协同作业***的基座标系标定问题,本发明的目的是提出了一种基于空间两点投影的协同机器人基座标系标定方法,针对基座标系z轴垂直于同一平面的协同机器人***,不需要增加外部的精密传感仪器以及其他测量工具,更简单,高效,可行性更强,通过让具有协同作业关系的两机器人以任意姿态握手到达空间的两个标定点,基于空间投影的几何约束关系,从而快速,精确的对其机器人基座标系进行相对位姿的标定。
本发明采用的技术方案是采用以下步骤:
第一步:将所有n台机器人以相互之间具有协同关系的任意两台机器人为一个小组作为最小标定单位进行划分;
所述第一步中所有n台机器人划分后至少共划分有n-1个小组。
第二步:在最小标定单位的两台机器人Ri,Rj中,建立两台机器人各自的基座标系Fi,Fj,在两台机器人各自基座标系原点Oi,Oj连线的两侧各任意确定一个标定点,作为公共工作空间中的两个标定点P1和P2;
第三步:将该两台机器人的末端点分别在标定点P1和标定点P2处以握手方式接触,获得以下各自机器人的关节转角信息;
iR1(iθ1,iθ2,iθ3…iθn)jR1(iθ1,iθ2,iθ3…iθn)
iR2(iθ1,iθ2,iθ3…iθn)jR2(iθ1,iθ2,iθ3…iθn)
其中,iR1(iθ1,iθ2,iθ3…iθn)表示机器人Ri在第一标定点P1处各关节转角值,iR2(iθ1,iθ2,iθ3…iθn)表示机器人Ri在第二标定点P2处各关节转角值,jR1(iθ1,iθ2,iθ3…iθn)表示机器人Rj在第一标定点P1处各关节转角值;jR2(iθ1,iθ2,iθ3…iθn)表示机器人Rj在第二标定点P2处各关节转角值。
第四步:分别建立该两台机器人的D-H坐标系,利用关节转角信息计算出以下各自的末端姿态矩阵和末端姿态矩阵
其中,k=1或2,k=1分别表示机器人在标定点P1处,k=2分别表示机器人在标定点P2处, 分别表示该两机器人在标定点P1,P2处末端点姿态相对于各基座标系的旋转矩阵,分别表示机器人Ri的末端点在基座标系Fi中的x,y,z坐标值;分别表示机器人Rj的末端点在基座标系Fj中的x,y,z坐标值;再计算出各末端对应的RPY转角中绕基座标系z轴旋转角γ。
第五步:将该两台机器人以及两个标定点P1和P2进行投影,利用其平面几何约束关系,计算得到相对水平平移矩阵相对水平旋转矩阵和相对垂直平移矩阵
所述的第五步具体为:
将该两台机器人以及两个标定点P1和P2向水平面投影,利用其平面几何约束关系,计算出水平面上该两台机器人基座标Fi,Fj之间的相对水平平移矩阵和相对水平旋转矩阵
将两台协同作业的机器人以及两个标定点向垂直面投影,利用其平面几何约束关系,计算出垂直面上两台协作机器人基座标Fi,Fj之间的相对垂直平移矩阵
所述相对水平平移矩阵和相对水平旋转矩阵具体采用以下方式得到:
建立XYZ坐标系,z轴方向竖直向上,将该两台机器人以及标定点P1和标定点P2向水平的X-Y平面投影,利用X-Y平面投影的几何约束关系以及RPY角中的绕z轴旋转角γ,计算出其中一机器人Rj相对于另一机器人Ri的基座标系在X-Y平面上的x方向偏移量px和y方向偏移量py以及相对于绕z轴的旋转量θrotz,由x方向偏移量px和y方向偏移量py组合得到相对水平平移矩阵由旋转量θrotz得到相对水平旋转矩阵
如附图4所示,P1′,P2′为标定点P1和标定点P2在x-y平面上的两个投影点,和分别表示两台机器人Ri,Rj末端点处于标定点P1和标定点P2时在x-y平面上的投影,Oi′,Oj′分别为两台协同机器人的基座标系原点在x-y平面的投影点,ri-1,ri-2分别表示机器人Ri末端点在P1和P2处位姿的RPY转角γi-1,γi-2在x-y平面的投影,rj-1,rj-2分别表示机器人Rj末端点在P1和P2处位姿的RPY转角γj-1,γj-2在x-y平面的投影。
在x-y平面确定两协同关系的机器人基座标系的相对位姿,采用以下公式先求解得到标定点与基座标系原点之间的距离,再进一步求解出两基座标系之间在x-y平面上投影的旋转角θrotz和平移偏量(px,py):
其中,|o′ipi1|,|o′ip′1|表示机器人Ri的末端点在P1处与基坐标系Fi原点Oi之间的连线长度的水平投影,|o′jpj1|,|o′jp′1|表示机器人Rj的末端点在标定点P1处与基坐标系Fj原点Oj之间的连线长度的水平投影,|o′ipi2|,|o′ip′2|表示机器人Ri的末端点在标定点P2处与基坐标系Fi原点Oi之间的连线长度的水平投影,|o′jpj2|,|o′jp′2|表示机器人Rj的末端点在标定点P2处与基坐标系Fj原点Oj之间的连线长度的水平投影。
附图4所示的三角形Vo′ip′1p′2中,已知第一机器人Ri在两个标定点之间的旋转角ri=|ri-1-ri-2|和第二机器人Rj在两个标定点之间的旋转角rj=|rj-1-rj-2|利用余弦定理,可计算出∠1以及|p1′p2′|,其中|p′1p′2|表示两标定点P1和P2连线在x-y水平面的投影长度,∠1表示|o′ipi2|与|p′1p′2|之间的夹角。
同理在Vo′jp′1p′2中,可计算出∠2,在Vo′iAp′2,Vo′jBp′2中采用以下公式可依次计算出:
∠3=π-(∠1+|ri-2|)
∠4=π-(∠2+|rj-2|)
∠5=∠1+∠2
其中,∠3表示机器人Ri的基坐标系Fi中x轴与|p′1p′2|之间的夹角,∠4表示机器人Rj的基坐标系Fj中x轴与|p′1p′2|之间的夹角,∠5表示|o′ip′2|与|o′jp′2|之间的夹角;
在三角形Vo′ip′2o′j中,利用余弦定理可以计算出:|o′io′j|以及∠6,∠7=|ri-2|-∠6,其中|o′io′j|表示机器人Ri和机器人Rj各基坐标系原点连线的水平投影长度,∠6表示|o′ip′2|与|o′io′j|之间的夹角,∠7表示机器人Ri的基坐标系Fi中x轴与|o′io′j|之间的夹角。
因此得到旋转角θrotz和平移偏量(px,py):
所述相对垂直平移矩阵具体采用以下方式得到:
建立XYZ坐标系,z轴方向竖直向上,将该两台机器人以及标定点P1和标定点P2向垂直的Y-Z平面投影,利用Y-Z平面投影的几何约束关系以及P1,P2点在各自基座标系下的z轴坐标值,计算出其中一机器人Rj相对于另一机器人Ri的基座标系在z轴竖直方向上的z方向偏移量pz,由z方向偏移量pz得到相对垂直平移矩阵具体如下述方式可得:
pz1=pi z-1-pj z-1
pz2=pi z-2-pj z-2
其中,pi z-1,pj z-1表示机器人Ri和机器人Rj的末端点在标定点P1处在各基坐标系中z轴上的坐标值,pi z-2,pj z-2表示机器人Ri和机器人Rj的末端点在标定点P2处在各基坐标系中z轴上的坐标值;根据上述步骤已经求解得到了全部参数和信息(即相对水平平移矩阵相对水平旋转矩阵和相对垂直平移矩阵),从而根据坐标变换,对协同作业的机器人基座标系进行相对位姿的标定,根据步骤四的标定方程如下:
(1)针对该两台机器人Ri和Rj均安装在水平地面的情况,即该两台机器人的基座标系Fi和Fj的z轴垂直于水平地面向上,两机器人基座标系Fi和Fj之间的相对位姿变换矩阵为:
其中Rot(Z,θrotz)表示机器人Rj的基坐标系Fj相对于机器人Ri的基坐标系Fi绕z轴旋转的矩阵,表示表示机器人Rj的基坐标系Fj相对于机器人Ri的基坐标系Fi的平移矩阵,表示机器人Rj的基坐标系Fj相对于机器人Ri的基坐标系Fi的变换矩阵;
将上述相对水平平移矩阵相对垂直平移矩阵与相对水平旋转矩阵相组合得到两机器人基座标系之间最终的相对位姿变换矩阵
(2)针对该两台机器人Ri和Rj,其中机器人Ri安装在水平地面,另外一台机器人Rj安装在顶面的情况,即该机器人Ri的基座标系Fi中的z轴垂直于水平地面向上,机器人Rj的基座标系Fj中的z轴垂直于水平地面向下,两机器人基座标系Fi和Fj之间的相对位姿变换矩阵为:
其中表示机器人Rj的基坐标系Fj相对于机器人Ri的基坐标系Fi的旋转的矩阵,表示表示机器人Rj的基坐标系Fj相对于机器人Ri的基坐标系Fi的平移矩阵,表示机器人Rj的基坐标系Fj相对于机器人Ri的基坐标系Fi的变换矩阵;
第六步:将上述相对水平平移矩阵相对垂直平移矩阵与相对水平旋转矩阵相组合得到两机器人基座标系之间最终的相对位姿变换矩阵
第七步:对于由具有协同关系的两台机器人组成的每个最小标定单位均重复以上步骤二~六,完成协同机器人基座标系的标定。
基于空间两点投影的协同作业机器人基座标系标定方法的基本原理在于:在具有协同关系的两台机器人基座标系原点的连线异侧,预先在其公共工作空间范围内确定两个标定点,让两协同机器人通过握手的方式,以任意空间姿态分别到达两标定点,从而获取相应的各机器人关节转角信息以及RPY角数值,利用协同作业机器人***以及确定的两标定点在空间平面投影的几何约束关系,求解出两协同作业机器人基座标之间的旋转及平移偏量,最终完成两基座标系之间的位姿标定。
本发明的优势和有益效果在于如下几点:
1.针对协同作业的多机器人***,本发明作为协同作业的多机器人基座标系的标定是保证***正常工作的前提,是使得机器人***能高效,快速,精确的完成工作任务的技术基础,本发明在标定过程中没有使用任何的附加外部传感器以及测量仪器,完全依靠机器人***自身的内部测量传感器,通过让协同作业的机器人末端点以任意姿态到达标定点,从而获得标定需要的全部信息。本发明在保证标定的高精度的同时充分利用了机器人***自身的硬件条件和设施,有效的降低了标定成本,依靠空间投影建立协同机器人***的几何约束关系图,从而完成基座标系的标定。
2.本发明方法,在现有的所有针对协同作业的多机器人***基座标系标定的接触式方法中,需要标定的空间点的数量是最少的,只需要在具有协同关系的两机器人基座标系原点连线的异侧以及重叠公共工作空间内,确定两个标定点即可完成标定,显著缩短了标定的时间,有效提高了标定的效率。
3.本发明方法,相比于现有的标定方法,在标定点的选取规则上更加的简单,只需要在具有协同关系的两机器人基座标系原点连线的异侧以及重叠公共工作空间内,任意的选定两个不重复的点即可,具有操作步骤简单,标定精度较高,适应范围广,能运用于工业生产中的各类工作环境,为今后协同作业的多机器人***的大规模推广提供了技术基础和支持。
附图说明
图1是本发明的方法流程框图。
图2是本发明中任意两机器人均是基于水平地面安装的协同方式示意图,即该两台机器人Ri和Rj的基座标系Fi和Fj的z轴垂直于水平地面向上。
图3是本发明中任意两机器人的协同方式示意图,其中一台是基于水平地面安装,另外一台是基于顶面安装,即该机器人Ri的基座标系Fi中的z轴垂直于水平地面向下,机器人Rj的基座标系Fj中的z轴垂直于水平地面向上。
图4为本发明的机器人和空间两标定点在X-Y平面进行投影形成的几何约束关系图。
图5为本发明的两基坐标系Z轴同向的情况下两机器人和空间两标定点在Y-Z平面投影的几何约束关系图。
图6为为本发明的两基坐标系Z轴反向情况下两机器人和空间两标定点在Y-Z平面投影的几何约束关系图。
图7为本发明的具有3台机器人的协同***的安装示意图,描述了各机器人基座标系之间的相互变换关系,图中1,2,3分别表示机器人Ri,RjRk,表示机器人Rk的基座标系相对于机器人Ri的基座标系之间的相对变换矩阵,表示机器人Rj的基座标系相对于机器人Rk的基座标系之间的变换矩阵,表示机器人Rj的基座标系相对于机器人Ri的基座标系之间的变换矩阵。
具体实施方式
下面结合附图及具体实施例对本发明作进一步详细说明。
本发明的基本原理主要在于:在两协同作业机器人基座标系原点连线的异侧以及相互重叠的公共工作空间内任意确定两个不重复的标定点,通过构造机器人握手的动作,使得两协同机器人的末端点以任意空间位姿分别同时到达标定点,对协同作业机器人***以及确定的标定点进行X-Y,Y-Z平面的投影,建立平面的投影几何约束关系图,从而获取协同作业机器人基座标系相对位姿的旋转及平移偏量,最终求得两基座标系的位姿变换矩阵,完成基座标系的标定工作。
本发明的实施例:
附图1中的框图为本发明提出的新型标定方法的具体流程示意图,如附图所示。本发明以3台新松负载6kg的六轴机器人为试验平台,如附图7所示,针对协同作业的多机器人***基座标系标定,结合实施案例进行说明,其中涉及的角度均以弧度制表示,本发明的具体标定流程主要包括以下步骤:
第一步:将3台机器人按照具有协同关系以每两台一个小组进行划分,至少共划分为2个小组;
第二步:以具有协同关系的两台机器人(Ri,Rj)(Ri,Rk)为最小标定单位***,任意选定协同机器人工作空间中处于基座标系原点连线两侧的两个标定点P1,P2,通过让两台机器人以握手的方式到达预先确定的标定点,分别获得各机器人的关节转角信息,先对第一小组两台机器人(Ri,Rj)进行标定:
在第一个标定点P1处,获得机器人Ri,Rj的各关节转角信息:
iR1(iθ1,iθ2,iθ3,iθ4,iθ5,iθ6)=[-0.0429,-1.4477,0,0,1.1200,0]
jR1(jθ1,jθ2,jθ3,jθ4,jθ5,jθ6)=[0.0429,-1.4488,0,0,1.1209,0]
在第二个标定点P2处,获得机器人Ri,Rj的各关节转角信息:
iR2(iθ1,iθ2,iθ3,iθ4,iθ5,iθ6)=[-1.2868,-1.5746,0,0,1.5746,0]
jR2(jθ1,jθ2,jθ3,jθ4,jθ5,jθ6)=[1.2823,-1.5691,0,0,1.5691,0]
第三步:分别建立两台机器人的D-H坐标系,利用握手动作测定的关节转角信息计算出各机器人的末端姿态矩阵:
a、机器人Ri的末端点在第一个标定点P1处:
机器人Ri的末端点姿态矩阵:
机器人Ri的末端点RPY转角γ角度值为:ri-1=0.0453;机器人Ri的末端点在基坐标系Fi中的坐标值Pi-1(pi x-1,pi y-1,pi z-1)为:Pi-1(0.9565,-0.0411,0.8526);
b、机器人Rj的末端点在第一个标定点P1处:
机器人Rj的末端点姿态矩阵:
机器人Rj的末端点RPY转角γ角度值为:rj-1=-0.0454;机器人Rj的末端点在基坐标系Fj中的坐标值Pj-1(pj x-1,pj y-1,pj z-1)为:Pj-1(0.9558,0.0410,0.8535);
c、机器人Ri的末端点在第二个标定点P2处:
机器人Ri的末端点姿态矩阵:
机器人Ri的末端点RPY转角γ角度值为:ri-2=1.2868;机器人Ri的末端点在基坐标系Fi中的坐标值Pi-2(pi x-2,pi y-2,pi z-2)为:Pi-2(0.2248,-0.7702,0.9280);
d、机器人Rj的末端点在第二个标定点P2处:
机器人Rj的末端点姿态矩阵:
机器人Rj的末端点RPY转角γ角度值为:rj-2=-1.2823;机器人Rj的末端点在基坐标系Fj中的坐标值Pj-2(pj x-2,pj y-2,pj z-2)为:Pj-2(0.2294,0.7729,0.9244);
第四步:将协同作业机器人***以及两标定点进行x-y平面投影,如附图4所示,P1′,P2′为空间中不重合的两标定点P1,P2在x-y平面上的投影,pi1,pi2,pj1,pj2分别表示机器人Ri,Rj的末端点在P1,P2处在x-y平面上的投影,Oi′,Oj′为两协同机器人的基座标系原点在x-y平面的投影点,ri-1,ri-2表示机器人Ri末端点在P1′,P2′处的RPY角γi-1,γi-2在x-y平面的投影,rj-1,rj-2表示机器人Rj末端点在P1′,P2′处位姿的RPY角γj-1,γj-2在x-y平面的投影。
如附图4所示,在x-y平面确定两协同关系的机器人基座标系的相对位姿,需要求解出两基座标系之间在x-y平面上投影的旋转角θrotz和平移偏量(px,py),具体描述方程如下:
代入数据求解得:
|o′ipi1|=|o′ip′1|=0.9573
|o′ipi2|=|o′ip′2|=0.8023
代入数据求解得:
|o′jpj1|=|o′jp′1|=0.9567
|o′jpj2|=|o′jp′2|=0.8062
在三角形Vo′ip′1p′2中,角度ri=|ri-1-ri-2|=1.2415,角度rj=|rj-1-rj-2|=1.2370,利用余弦定理,可计算出:角度∠1=1.0726,p′1p′2|=1.0303;
同理在Vo′jp′1p′2中,可计算出:角度∠2=1.0717,在Vo′iAp′2,Vo′jBp′2中可依次计算出:
角度∠3=π-(∠1+|ri-2|)=0.7821
角度∠4=π-(∠2+|rj-2|)=0.7876
角度∠5=∠1+∠2=2.1444
在三角形Vo′ip′2o′j中,利用余弦定理可计算出:|o′io′j|=1.4126,角度∠6=0.4999,角度∠7=|ri-2|-∠6=0.7868,因此:
根据上述参数可以求得协同机器人两基坐标系Fi,Fj之间相对水平旋转矩阵:
相对水平平移矩阵:
如附图5所示,在Y-Z平面确定两协同关系的机器人基座标系的相对位姿,需要求解出两基座标系之间在Y-Z平面上投影的平移偏量pz,具体描述方程如下:
代入数据计算可得:
pz=0.0014
根据pz可求得协同机器人两基坐标系Fi,Fj之间相对垂直平移矩阵:
根据上述步骤已经求解得到了基于空间两点投影的协同机器人基座标系标定方法所需要的全部参数和信息,从而根据坐标变换,对协同作业的机器人基座标系进行相对位姿的标定,标定方程如下:
上述是针对该两台机器人Ri和Rj均水平安装在地面的情况,如附图2的双机器人协同安装方式,完成了机器人Ri,Rj基座标系之间的标定工作。
针对前面所述的该两台机器人Ri和Rj相对安装方式的另外一种情况,即其中机器人Ri安装在水平地面,另外一台机器人Rj安装在顶面的情况,即该机器人Ri的基座标系Fi中的z轴垂直于水平地面向上,机器人Rj的基座标系Fj中的z轴垂直于水平地面向下,如附图3所示的协同安装方式:
相对水平平移矩阵:
如附图6所示,在Y-Z平面确定两协同关系的机器人基座标系的相对位姿,需要求解出两基座标系之间在Y-Z平面上投影的平移偏量pz,具体描述方程如下:
代入数据计算可得:
pz=1.7793
根据pz可以求得协同机器人两基坐标系Fi,Fj之间相对垂直平移矩阵:
根据上述步骤已经求解得到了基于空间两点投影的协同机器人Ri,Rj的基座标系标定所需要的全部参数和信息,从而根据坐标变换,对协同作业的机器人基座标系进行相对位姿的标定,标定方程如下:
第五步:对第二小组两台机器人(Ri,Rk)进行标定,标定过程与第一小组机器人(Ri,Rj)完全相同,Rj和Rk的投影关系与附图4,附图5及附图6相同。
在第一个标定点P1′处,获得机器人Ri,Rk的各关节转角信息:
iR1(iθ1,iθ2,iθ3,iθ4,iθ5,iθ6)=[-1.5708,-1.5708,0,0,0.5027,0]
kR1(kθ1,kθ2,kθ3,kθ4,kθ5,kθ6)=[0.79,-1.568,0,0,0.5027,0]
在第二个标定点P2′处,获得机器人Ri,Rk的各关节转角信息:
iR2(iθ1,iθ2,iθ3,iθ4,iθ5,iθ6)=[-2.7080,-1.946,0.1257,0,0.5030,0]
kR2(jθ1,jθ2,jθ3,jθ4,jθ5,jθ6)=[1.924,-1.945,0.1257,0,0.5060,0]
第三步:分别建立两台机器人Ri,Rk的D-H坐标系,利用握手动作测定的关节转角信息计算出各机器人Ri,Rk的所有标定信息参数:
根据上述参数可以求得协同机器人两基坐标系Fi,Fk之间相对水平旋转矩阵:
相对水平平移矩阵:
如附图5所示,在Y-Z平面确定两协同关系的机器人基座标系的相对位姿,需要求解出两基座标系之间在Y-Z平面上投影的平移偏量pz,代入数据计算可得:
pz=0.0018
根据pz可求得协同机器人两基坐标系Fi,Fj之间相对垂直平移矩阵:
根据上述步骤已经求解得到了基于空间两点投影的协同机器人基座标系标定方法所需要的全部参数和信息,从而根据坐标变换,对协同作业的机器人基座标系进行相对位姿的标定,标定方程如下:
完成了针对该两台机器人Ri和Rk均水平安装在地面的情况下基座标系之间的标定工作。
针对前面所述的该两台机器人Ri和Rk相对安装方式的另外一种情况,如附图3中的协同安装方式,即其中机器人Ri安装在水平地面,另外一台机器人Rk安装在顶面的情况,即该机器人Ri的基座标系Fi中的z轴垂直于水平地面向上,机器人Rk的基座标系Fk中的z轴垂直于水平地面向下:
相对水平平移矩阵:
如附图6所示,在Y-Z平面确定两协同关系的机器人基座标系的相对位姿,需要求解出两基座标系之间在Y-Z平面上投影的平移偏量pz,代入数据计算可得:
pz=2.2445
根据pz可以求得协同机器人两基坐标系Fi,Fj之间相对垂直平移矩阵:
根据上述步骤已经求解得到了基于空间两点投影的协同机器人基座标系标定方法所需要的全部参数和信息,从而根据坐标变换,对协同作业的机器人基座标系进行相对位姿的标定,标定方程如下:
在本实施案例中,3台新松6kg机器人均是安装在同一水平地面上,如附图7所示,根据坐标系变换关系可知:
其中表示机器人Rj基座标系Fj相对于机器人Ri基座标系Fi的变换矩阵,表示机器人Rk基座标系Fk相对于机器人Ri基座标系Fi的变换矩阵;
其中表示的逆矩阵,表示的逆矩阵,根据上述计算可以知道机器人Rk的基座标系Fk相对于机器人Rj基座标系Fj的变换矩阵为:
代入数据得到:
第六步:根据第一步所述,3台机器人按照协同关系至少划分成了2个小组,重复上述步骤2次,完成2组两两协作的机器人基座标系标定,利用彼此不同机器人之间的相对位姿关系,可以计算出任意两台机器人之间的相对位姿关系,进而完成了3台机器人Ri,Rj,Rk基座标系之间的标定工作。
由此可见,本发明在标定过程中没有使用任何的附加外部传感器以及测量仪器,完全依靠机器人***自身的内部测量传感器,通过让协同作业的机器人末端点以任意姿态到达标定点,从而获得标定需要的全部信息。本发明在保证标定的高精度的同时充分利用了机器人***自身的硬件条件和设施,有效的降低了标定成本,显著缩短了标定的时间,能有效提高标定效率40%左右,适应范围广,具有突出显著的技术效果。
Claims (5)
1.一种基于空间两点投影的协同机器人基座标系标定方法,其特征在于包括以下步骤:
第一步:将所有n台机器人以相互之间具有协同关系的任意两台机器人为一个小组作为最小标定单位进行划分;
第二步:在最小标定单位的两台机器人Ri,Rj中,建立两台机器人各自的基座标系Fi,Fj,在两台机器人各自基座标系原点Oi,Oj连线的两侧各任意确定一个标定点,作为公共工作空间中的两个标定点P1和P2,
第三步:将该两台机器人的末端点分别在标定点P1和标定点P2处以握手方式接触,获得各自机器人的关节转角信息;
第四步:分别建立该两台机器人的D-H坐标系,利用关节转角信息计算出各自的末端姿态矩阵和k=1,2,k=1分别表示机器人在标定点P1处,k=2分别表示机器人在标定点P2处,n表示机器人的旋转关节数量,再计算出各末端对应的RPY转角;
第五步:将该两台机器人以及两个标定点P1和P2进行投影,利用其平面几何约束关系,计算得到相对水平平移矩阵相对水平旋转矩阵和相对垂直平移矩阵
第六步:将相对水平平移矩阵相对垂直平移矩阵与相对水平旋转矩阵相组合得到两机器人基座标系之间最终的相对位姿变换矩阵
第七步:对于由具有协同关系的两台机器人组成的每个最小标定单位均重复以上步骤二~六,完成协同机器人基座标系的标定。
2.根据权利要求1所述的一种基于空间两点投影的协同机器人基座标系标定方法,其特征在于:所述的第五步具体为:将该两台机器人以及两个标定点P1和P2向水平面投影,利用其平面几何约束关系,计算出水平面上该两台机器人基座标Fi,Fj之间的相对水平平移矩阵和相对水平旋转矩阵将两台协同作业的机器人以及两个标定点向垂直面投影,利用其平面几何约束关系,计算出垂直面上两台协作机器人基座标Fi,Fj之间的相对垂直平移矩阵
3.根据权利要求1所述的一种基于空间两点投影的协同机器人基座标系标定方法,其特征在于:所述第一步中所有n台机器人划分后至少共划分有n-1个小组。
4.根据权利要求2所述的一种基于空间两点投影的协同机器人基座标系标定方法,其特征在于:所述相对水平平移矩阵和相对水平旋转矩阵具体采用以下方式得到:
建立XYZ三维坐标系,z轴方向竖直向上,将该两台机器人以及标定点P1和标定点P2向水平的X-Y平面投影,利用X-Y平面投影的几何约束关系以及机器人末端点RPY角中的绕z轴旋转角γ,计算出其中一机器人Rj相对于另一机器人Ri的基座标系在X-Y平面上的x方向偏移量px和y方向偏移量py以及相对于绕z轴的旋转量θrotz,由x方向偏移量px和y方向偏移量py组合得到相对水平平移矩阵由旋转量θrotz得到相对水平旋转矩阵。
5.根据权利要求2所述的一种基于空间两点投影的协同机器人基座标系标定方法,其特征在于:所述相对垂直平移矩阵具体采用以下方式得到:
建立XYZ坐标系,z轴方向竖直向上,将该两台机器人以及标定点P1和标定点P2向垂直的Y-Z平面投影,利用Y-Z平面投影的几何约束关系以及标定点P1和标定点P2在各自基座标系下的z轴坐标值,计算出其中一机器人Rj相对于另一机器人Ri的基座标系在z轴竖直方向上的z方向偏移量pz,由z方向偏移量pz得到相对垂直平移矩阵
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510289603.2A CN105180962B (zh) | 2015-05-29 | 2015-05-29 | 一种基于空间两点投影的协同机器人基坐标系标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510289603.2A CN105180962B (zh) | 2015-05-29 | 2015-05-29 | 一种基于空间两点投影的协同机器人基坐标系标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105180962A true CN105180962A (zh) | 2015-12-23 |
CN105180962B CN105180962B (zh) | 2017-12-29 |
Family
ID=54903211
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510289603.2A Active CN105180962B (zh) | 2015-05-29 | 2015-05-29 | 一种基于空间两点投影的协同机器人基坐标系标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105180962B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105698678A (zh) * | 2016-02-24 | 2016-06-22 | 浙江大学 | 一种飞机壁板卧式自动钻铆机的基坐标系标定方法 |
CN107138944A (zh) * | 2017-05-18 | 2017-09-08 | 哈尔滨工业大学 | 基于空间点误差修正的两工件自动对准方法 |
CN108548510A (zh) * | 2018-05-10 | 2018-09-18 | 珞石(山东)智能科技有限公司 | 基于力传感器的斜装机器人基座标系标定方法 |
CN109048905A (zh) * | 2018-08-23 | 2018-12-21 | 珠海格力智能装备有限公司 | 机器人末端执行器坐标系的确定方法及装置 |
CN110370319A (zh) * | 2019-08-07 | 2019-10-25 | 江苏汇博机器人技术股份有限公司 | 一种用于实训的双机器人标定***及方法 |
CN112396660A (zh) * | 2019-08-12 | 2021-02-23 | 华为技术有限公司 | 一种摄像机光心的确定方法及*** |
CN116294987A (zh) * | 2022-11-25 | 2023-06-23 | 无锡中车时代智能装备研究院有限公司 | 一种双机器人自动测量打磨***中的坐标转换方法及*** |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2003021365B1 (en) * | 2001-08-31 | 2003-06-26 | Univ Community College Sys Nev | Coordinated joint motion control system |
CN102226677A (zh) * | 2011-01-26 | 2011-10-26 | 东南大学 | 具有协作关系的多机器人***的基坐标系标定方法 |
CN102294695A (zh) * | 2010-06-25 | 2011-12-28 | 鸿富锦精密工业(深圳)有限公司 | 机器人标定方法及标定*** |
-
2015
- 2015-05-29 CN CN201510289603.2A patent/CN105180962B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2003021365B1 (en) * | 2001-08-31 | 2003-06-26 | Univ Community College Sys Nev | Coordinated joint motion control system |
CN102294695A (zh) * | 2010-06-25 | 2011-12-28 | 鸿富锦精密工业(深圳)有限公司 | 机器人标定方法及标定*** |
CN102226677A (zh) * | 2011-01-26 | 2011-10-26 | 东南大学 | 具有协作关系的多机器人***的基坐标系标定方法 |
Non-Patent Citations (2)
Title |
---|
王梅等: "多机器人协作运动规划及相关问题研究", 《制造业自动化》 * |
董东辉等: "典型安装方式的协作机器人基坐标系标定方法", 《工业控制计算机》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105698678A (zh) * | 2016-02-24 | 2016-06-22 | 浙江大学 | 一种飞机壁板卧式自动钻铆机的基坐标系标定方法 |
CN107138944A (zh) * | 2017-05-18 | 2017-09-08 | 哈尔滨工业大学 | 基于空间点误差修正的两工件自动对准方法 |
CN108548510A (zh) * | 2018-05-10 | 2018-09-18 | 珞石(山东)智能科技有限公司 | 基于力传感器的斜装机器人基座标系标定方法 |
CN108548510B (zh) * | 2018-05-10 | 2020-05-01 | 珞石(山东)智能科技有限公司 | 基于力传感器的斜装机器人基座标系标定方法 |
CN109048905A (zh) * | 2018-08-23 | 2018-12-21 | 珠海格力智能装备有限公司 | 机器人末端执行器坐标系的确定方法及装置 |
CN109048905B (zh) * | 2018-08-23 | 2022-02-18 | 珠海格力智能装备有限公司 | 机器人末端执行器坐标系的确定方法及装置 |
CN110370319A (zh) * | 2019-08-07 | 2019-10-25 | 江苏汇博机器人技术股份有限公司 | 一种用于实训的双机器人标定***及方法 |
CN112396660A (zh) * | 2019-08-12 | 2021-02-23 | 华为技术有限公司 | 一种摄像机光心的确定方法及*** |
CN112396660B (zh) * | 2019-08-12 | 2024-01-09 | 华为云计算技术有限公司 | 一种摄像机光心的确定方法及*** |
CN116294987A (zh) * | 2022-11-25 | 2023-06-23 | 无锡中车时代智能装备研究院有限公司 | 一种双机器人自动测量打磨***中的坐标转换方法及*** |
CN116294987B (zh) * | 2022-11-25 | 2023-12-08 | 无锡中车时代智能装备研究院有限公司 | 一种双机器人自动测量打磨***中的坐标转换方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN105180962B (zh) | 2017-12-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105180962A (zh) | 一种基于空间两点投影的协同机器人基座标系标定方法 | |
CN107175660B (zh) | 一种基于单目视觉的六自由度机器人运动学标定方法 | |
CN104729407B (zh) | 机器人基坐标系与世界坐标系之间关系的自动确定方法 | |
CN102126162B (zh) | 一种数控机床加工在线测量方法 | |
CN106092009B (zh) | 一种基于拉线编码器的站点可动式测量机构的初始位置校准方法 | |
CN106595474A (zh) | 一种基于激光跟踪仪的双机器人基坐标系标定方法 | |
CN102744648B (zh) | 一种数控机床回转工作台误差测量与分离的方法 | |
CN102393169B (zh) | 一种用于合拢管测量的三拉绳测量方法 | |
CN107042527A (zh) | 一种基于三维力传感器的工业机器人标定装置及标定方法 | |
CN110148187A (zh) | 一种SCARA机械手Eye-in-Hand的高精度手眼标定方法和*** | |
CN103673976A (zh) | 复合式精度测量坐标系的转换与统一方法及*** | |
CN106097395A (zh) | 一种基于直线位移传感器的工业机器人运动学参数的标定算法 | |
CN104006778A (zh) | 一种工业机器人末端夹具安装位置的标定方法 | |
CN106584509B (zh) | 并联机器人的原点标定方法 | |
CN112828878B (zh) | 一种大型设备对接过程三维测量与跟踪方法 | |
CN103471572A (zh) | 全站仪组网测量大型结构件的方法 | |
CN104165586A (zh) | 单台机器人工件坐标系的非接触式高精度标定方法及应用 | |
CN109857073A (zh) | 生产线的虚拟验证方法、装置及电子设备 | |
CN105643620A (zh) | 一种基于十字型杆件的工业机器人简易标定方法 | |
JP2017009462A (ja) | 校正治具及び校正用マーカ配置方法 | |
CN103862474B (zh) | 机器人关节初始参数的辨识方法 | |
CN112797978B (zh) | 一种掘进机的导向方法、***和存储介质 | |
JPH07237158A (ja) | 位置・姿勢検出方法及びその装置並びにフレキシブル生産システム | |
CN112507283B (zh) | 一种基于321法则的转换矩阵解算方法 | |
CN107643031A (zh) | 机器人重复定位精度检测装置及方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |