CN104596418A - 一种多机械臂系统坐标系标定及精度补偿方法 - Google Patents
一种多机械臂系统坐标系标定及精度补偿方法 Download PDFInfo
- Publication number
- CN104596418A CN104596418A CN201510017394.6A CN201510017394A CN104596418A CN 104596418 A CN104596418 A CN 104596418A CN 201510017394 A CN201510017394 A CN 201510017394A CN 104596418 A CN104596418 A CN 104596418A
- Authority
- CN
- China
- Prior art keywords
- cos
- coordinate system
- mobile platform
- axis
- mechanical 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
- 238000000034 method Methods 0.000 title claims abstract description 51
- 238000005259 measurement Methods 0.000 claims abstract description 35
- 238000004364 calculation method Methods 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 44
- 101100323189 Caenorhabditis elegans amx-1 gene Proteins 0.000 claims description 18
- 102000007370 Ataxin2 Human genes 0.000 claims description 12
- 108010032951 Ataxin2 Proteins 0.000 claims description 12
- 230000033001 locomotion Effects 0.000 claims description 12
- 238000007665 sagging Methods 0.000 claims description 12
- 238000013519 translation Methods 0.000 claims description 8
- 230000000631 nonopiate Effects 0.000 claims description 7
- 230000011218 segmentation Effects 0.000 claims description 2
- 101150038410 atx-3 gene Proteins 0.000 description 7
- 101150013495 ARX1 gene Proteins 0.000 description 6
- 101150070147 arx-2 gene Proteins 0.000 description 6
- 238000011160 research Methods 0.000 description 4
- 101100163862 Schizosaccharomyces pombe (strain 972 / ATCC 24843) arz1 gene Proteins 0.000 description 3
- 230000008901 benefit Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 101100083446 Danio rerio plekhh1 gene Proteins 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 239000003292 glue Substances 0.000 description 2
- 238000005507 spraying Methods 0.000 description 2
- 101100001642 Caenorhabditis elegans amt-1 gene Proteins 0.000 description 1
- 101100055523 Caenorhabditis elegans amt-2 gene Proteins 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 239000007921 spray Substances 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
一种多机械臂系统坐标系标定及精度补偿方法,该方法包括如下步骤:1)定义相关坐标系原点及方向;2)测量所有移动平台的轴方向;3)测算所有机械臂的基坐标系原点及轴方向;4)获得大跨度横梁其余分段的轴方向;5)测算插值补偿公式;6)求得移动平台补偿公式;7)求得全局补偿公式。本发明能够满足两套及两套以上具有协作关系的带有大跨度大行程移动平台的多机械臂系统坐标系标定及精度补偿要求,整套系统在满足精度要求的情况下进行标定及补偿的步骤少,坐标系标定和误差补偿同时进行,所需时间短,提高测量效率;可根据精度要求,对计算公式和测量方案进行局部更改,增加了灵活性。
Description
技术领域
本发明涉及复杂多机械臂系统坐标系标定及误差补偿领域,尤其涉及利用激光跟踪仪对配备有大跨度大行程移动平台的多机械臂协作系统进行坐标系标定和精度补偿的方法。
背景技术
随着机器人工业的发展以及现代制造工艺的需要,越来越多的大型设备制造厂商开始将工业机器人技术应用于零部件或装配体外表面喷涂。由于很多喷涂部件外表面形体巨大,形状复杂,现有的工业机器人根本无法达到表面全覆盖以及灵活性的需求,所以现有的机器人喷涂系统往往采用多自由度运动平台加上6自由度喷涂机器人的模式。现有标定方法大多只针对于数控移动平台或机械臂本体,如《多轴数控移动平台几何误差辨识》,《数控移动平台几何误差测量及误差补偿技术的研究》,《数控移动平台三维空间误差建模及补偿》,《机器人手眼关系_基坐标系和世界坐标系关系的同时标定》,《基于激光跟踪仪的机器人误差测量系统标定》,大多数给出的是移动平台自身误差辨识,需要分别测定俯仰、偏摆、扭转方向的误差,并分别进行补偿,实施起来步骤复杂,工作量大,亦或机器人自身的手眼标定、坐标系标定,鲜有复合系统坐标系标定和误差补偿的研究;较少给出协作机器人坐标系标定的研究需要作出若干个“握手”动作或借助较多的外部零件或设备,也不适用于大空间多机器人的标定,且没有能够一次完成坐标系标定和误差补偿,如《典型安装方式的协作机器人基坐标系标定方法》,《双机器人系统的基坐标系标定》,《具有协作关系的多机器人系统的基坐标系标定方法》。同时,亦少有应用于大跨度结构部件的坐标系标定方法与研究。
发明内容
本发明的目的是针对配有多自由度运动平台工业机器人在进行坐标系标定和精度补偿方面缺乏有效方法的问题,提出一种利用激光跟踪仪对多机械臂系统坐标系标定及精度补偿方法,从而为提高设备精度,缩短研制周期,创造经济效益提供了有力的技术支持。
本发明的技术方案如下:
一种多机械臂系统坐标系标定及精度补偿方法,每个机械臂系统包括三自由度移动平台和固定在移动平台上的机械臂,移动平台由数控系统控制,其特征在于,所述方法包括如下步骤:
1)架设激光跟踪仪,在全局范围内为整套系统选取原始测量点并粘贴靶球,原始测量点随移动平台移动且能够在移动平台全行程内使靶球接受激光跟踪仪光线并反射,利用激光跟踪仪对原始测量点进行测量,采用三点定义法定义全局坐标系的原点和全局坐标系的X、Y、Z轴方向,全局坐标系为正交坐标系,全局坐标系的原点定义在粘贴有原始测量点的移动平台;
2)在每台移动平台上另行粘贴靶球,利用激光跟踪仪依次测量所有移动平台的三个坐标轴的方向,即为局部坐标系坐标轴x、y、z的方向,局部坐标系原点定义在移动平台处于零位时靶球处在全局坐标系下的位置,并且计算x、y、z轴与X、Y、Z轴之间的旋转矩阵RAm,局部坐标系为非正交坐标系,即实现多机械臂系统移动平台的坐标系标定;
3)将每台移动平台固定,由数控系统读出移动平台的当前位置PA0,利用激光跟踪仪测量计算获得机械臂基坐标系原点O在全局坐标系中的位置PAr0及机械臂基坐标系坐标轴拟合轴线XR、YR、ZR的方向,求得XR、YR、ZR轴相对于X、Y、Z轴之间的旋转矩阵RAr,机械臂基坐标系为非正交坐标系,即实现多机械臂系统机械臂的坐标系标定;
4)将大跨度横梁依据弯曲程度分成若干段,利用激光跟踪仪获得大跨度横梁的各段轴线x',y',z'的方向以及与X、Y、Z轴之间的旋转矩阵R'Am,用于补偿横梁跨度过大引起的下垂;
5)利用激光跟踪仪对每台移动平台的容易产生定位误差的轴线进行分段测量获得的数据,采用线性插值补偿公式求得在补偿对应轴线定位误差时需输入的数控指令:
其中,PAtx为对应轴线目标位置,PAmx为需输入的数控指令,PAtx1和PAtx2为分段测量过程中测得的能够包含住PAtx的对应轴线上相邻两点实际位置,PAmx1、PAmx2为分段测量过程中对应于PAtx1、PAtx2两点的数控指令值;
6)利用补偿公式PArT=PAr0+RAm(PAmT-PA0),获得不考虑移动平台轴线定位误差时要使机械臂基坐标系原点到达实际位置PArT需要下达给移动平台数控系统的理论指令值PAmT,利用线性插值补偿公式用PAmT中的定位误差较大轴线坐标PAmTx替换PAtx,获得该轴线实际需输入移动平台数控系统的坐标PAmRx,用PAmRx替换PAmT中的PAmTx,获得需要下达给移动平台数控系统的实际指令值PAmR,即实现多机械臂系统移动平台定位精度补偿;
7)利用补偿公式PA=RArPAr+PAr0+RAm(PAmT-PA0)+PC,求出要使机械臂工具坐标系原点到达PA需下达给机械臂控制器的指令值PAr,即实现多机械臂系统机械臂精度补偿,其中,PA是全局坐标系下机械臂工具坐标系原点的坐标,为已知量,RAr是机械臂基坐标系相对于全局坐标系的旋转矩阵,为已知量,PAr是要求的下达给机械臂控制器的指令值,为未知量,PAr0是移动平台停在PA0时机械臂基坐标系原点在全局坐标系中的位置,为已知量,RAm是移动平台轴线相对于全局坐标系的旋转矩阵,为已知量,PAmT是不考虑移动平台轴线定位误差时要使机械臂基坐标系原点到达理论位置需输入的指令值,为已知量,PA0是对机械臂进行测量时移动平台数控系统指令值,为已知量,PC是考虑大跨度横梁下垂问题引入的补偿向量,为已知量。
本发明的上述技术方案中,所述步骤2)中计算x、y、z轴与X、Y、Z轴之间的旋转矩阵RAm的方法是:
1)在每台移动平台上粘贴靶球,靶球粘贴处应具有三个自由度,且能在各自移动平台运动范围内使靶球能够接收激光跟踪仪光线并反射,对每台移动平台各轴进行线性测量,得到局部坐标系的x、y、z轴线方向并获得与全局坐标系X、Y、Z轴线之间的旋转矩阵: 其中cosαAmx、cosβAmx、cosγAmx、cosαAmy、cosβAmy、cosγAmy、cosαAmz、cosβAmz、cosγAmz为测算得到的x、y、z轴线分别与全局坐标系X、Y、Z轴所成角度的余弦值;对于大跨度横梁,选取一段线性度较好的区域进行数据拟合,此旋转矩阵为非正交阵,其意义是RAm与局部坐标系下的任意一点相乘,并经过平移,得到全局坐标系下的位置向量。
上述技术方案中,所述步骤3)中计算XR、YR、ZR轴相对于X、Y、Z轴之间的旋转矩阵RAr和机械臂基坐标系原点O在全局坐标系中的位置PAr0的方法是:
1)令移动平台停在一个确定的位置,由数控系统读出当前位置PA0,对于具有大跨度横梁的移动平台停在一段线性度较好的区域内,记机械臂基坐标系原点为O,此时其在全局坐标系下的坐标为PAr0,在所有机械臂末端粘贴靶球,同时为每台机械臂标定一个新的工具坐标系,获得所粘靶球的球心相对于机械臂基坐标系的位置变换关系;
2)编写机械臂运动代码,使机械臂携带靶球沿其自身轴线运动,同时保证机械臂末端姿态不变,记录下达给机械臂控制器的指令值PAr,测得全局坐标系下机械臂工具坐标系原点的坐标PA;
3)记录沿机械臂三轴运动的拟合轴线XR、YR、ZR分别与全局坐标系X、Y、Z轴所成的旋转矩阵 其中,cosαArx、cosβArx、cosγArx、cosαAry、cosβAry、cosγAry、cosαArz、cosβArz、cosγArz为测算得到的XR、YR、ZR轴线与全局坐标系X、Y、Z轴所成角度的余弦值,此旋转矩阵为非正交阵,它的含义是RAr与机械臂基坐标系下的任意一点相乘并进行平移则获得该点在全局坐标系下的位置向量;
4)通过PA-RArPAr,并做平均化处理后求得此时机械臂基坐标系原点在全局坐标系下的坐标PAr0。
本发明技术方案中,其特征在于,所述步骤4)中所述的将大跨度横梁依据弯曲程度分段,利用激光跟踪仪获得大跨度横梁的各段的轴线x'、y'、z'轴的方向以及与X、Y、Z轴之间的旋转矩阵R'Am,用于补偿横梁跨度过大引起的下垂的方法是:
a.将整个横梁依据弯曲程度分为三段,将移动平台移至大跨度横梁的其它一部分区域;
b.按照步骤2)所述方法对移动平台各轴进行测量,得到移动平台x'、y'、z'轴线与全局坐标系X、Y、Z轴所成的旋转矩阵R'Am;
c.重复步骤a和b,得到另一区域中移动平台x″、y″、z″轴线与全局坐标系X、Y、Z轴所成的旋转矩阵R″Am。
本发明的技术方案中,其特征在于,步骤5)中所述的移动平台容易产生定位误差的轴线为移动平台的较长轴,采用线性插值补偿公式求得在补偿对应轴线定位误差时需输入的数控指令PAmx的方法是:
1)由移动平台较长轴X轴进行逐点测量,为数控指令值和实测数据列出一一对应的表格,(PAmx1、PAtx1),(PAmx2、PAtx2),…,(PAmxn、PAtxn),n为正整数;
2)根据如上对应关系,利用线性插补公式求出在某一区间内要达到移动平台X轴线上某一真实位置PAtx,需输入的数控指令PAmx。
本发明的技术方案中,其特征在于,步骤7)中所述补偿公式
PA=RArPAr+PAr0+RAm(PAmT-PA0)+PC中求得PC的方法是:
1)过当前机械臂基坐标系原点作平行于当前区域横梁方向的直线l',由点O向l'引垂线,垂足记为s',记PC为由点O指向点s'的向量。
本发明具有以下优点及突出性的技术效果:的优点在于:①能够满足对大行程移动平台的检测要求;②坐标系标定和误差补偿同时进行,提高测量效率;③可根据精度要求,对计算公式和测量方案进行局部更改,增加了灵活性。
附图说明
图1为依据本发明实施方式的设备布局轴测图。
图2为大跨度横梁下垂示意图。
图3、图4、图5为依据本发明解决横梁下垂补偿问题的测量方案示意图。
图中:图中:1-第一台移动平台;2-第一台机械臂;3-第二台移动平台;4-第二台机械臂;5-第三台移动平台;6-第三台机械臂;7-激光跟踪仪;8-立柱;9-横梁;10-Z轴滑板。
具体实施方式
该利用激光跟踪仪进行复杂多系统坐标系标定和误差补偿的方法旨在通过简单的操作步骤和分析运算,测出多套系统之间的坐标系关系,同时对系统精度误差进行补偿,为系统正确、高效运行提供必要的测量数据和技术支持。
下面结合附图和实施例对本发明做进一步的说明。
步骤1)架设激光跟踪仪,在全局范围内为整套系统选取原始测量点并粘贴靶球,原始测量点随移动平台移动且能够在移动平台全行程内使靶球接受激光跟踪仪光线并反射,利用激光跟踪仪对原始测量点进行测量,采用三点定义法定义全局坐标系的原点和全局坐标系的X、Y、Z轴方向,全局坐标系为正交坐标系,全局坐标系的原点定义在粘贴有原始测量点的移动平台。
如图1,将激光跟踪仪7放置在厂房的最远端,使得激光跟踪仪7能够覆盖到全部被测量物体;选取合适的原始测量点并粘贴靶球,原始测量点的位置应具有三个方向自由度,能够在移动平台全程内使靶球接受激光跟踪仪光线并反射,且在测量全过程中不可变动,因此应放在不易被碰触的位置,本例中将原始测量点选在第一台移动平台1的Z轴滑板10高点。全局坐标系的方向定义采用三点定义法,全局坐标系的原点定义在粘贴有原始测量点的移动平台,本例为第一台移动平台1处于零位时原始测量点所在位置,即当第一台移动平台1数控系统中读数为xn1=0,yn1=0,zn1=0时激光跟踪仪7采集的原始测量点位置,并采集第一台移动平台1数控系统读数xn1=xmax1,yn1=0,zn1=0时原始测量点位置,和第一台移动平台1xn1=0,yn1=ymax1,zn1=0时采集的原始测量点位置,在测量软件中做正交处理后获得正交的X,Y和Z方向作为全局坐标系的方向。
步骤2)在每台移动平台上另行粘贴靶球,靶球粘贴处应具有三个自由度,且能在各自移动平台运动范围内使靶球能够接收激光跟踪仪光线并反射,对每台移动平台各轴进行线性测量,利用激光跟踪仪依次测量所有移动平台的三个坐标轴的方向,即为局部坐标系坐标轴x、y、z的方向,局部坐标系原点定义在移动平台处于零位时靶球处在全局坐标系下的位置,并且计算x、y、z轴与X、Y、Z轴之间的旋转矩阵 其中cosαAmx、cosβAmx、cosγAmx、cosαAmy、cosβAmy、cosγAmy、cosαAmz、cosβAmz、cosγAmz为测算得到的x、y、z轴线分别与全局坐标系X、Y、Z轴所成角度的余弦值;对于大跨度横梁,选取一段线性度较好的区域进行数据拟合,此旋转矩阵为非正交阵,其意义是RAm与局部坐标系下的任意一点相乘,并经过平移,得到全局坐标系下的位置向量。
如图1,在第一台移动平台1、第二台移动平台3和第三台移动平台5具有三自由度的运动部件上粘贴靶球,同样需能够在移动平台运动范围内使对应靶球接受激光跟踪仪光线并反射,第一台移动平台1的局部坐标系原点定义在当第一台移动平台1数控系统中读数为xn1=0,yn1=0,zn1=0时第一台移动平台1上所粘靶球处在全局坐标系下的位置,局部坐标系方向定义为第一台移动平台1沿三个轴运动时分别获得的拟合方向,三轴分别为x1,y1,z1,此坐标系为非正交坐标系。第二台移动平台3的局部坐标系原点定义在第二台移动平台3处于零位时,第二台移动平台3所粘靶球处在全局坐标系下的位置,局部坐标系方向定义为第二台移动平台3沿三个轴运动时分别获得的拟合方向,三轴分别为x2,y2,z2,此坐标系为非正交坐标系;第三台移动平台5的局部坐标系原点定义在第三台移动平台5处于零位时,第三台移动平台5所粘靶球处在全局坐标系下的位置,局部坐标系方向定义为第三台移动平台5沿三个轴运动时分别获得的拟合方向,三轴分别为x3,y3,z3,此坐标系为非正交坐标系。
由激光跟踪仪的数据采集软件,如得到轴线测量报告,可以由测算得到的各移动平台轴线x1,y1,z1,x2,y2,z2,x3,y3,z3与全局坐标系X,Y,Z轴所成角度αAmx1、βAmx1、γAmx1、αAmy1、βAmy1、γAmy1、αAmz1、βAmz1、γAmz1,αAmx2、βAmx2、γAmx2、αAmy2、βAmy2、γAmy2、αAmz2、βAmz2、γAmz2,αAmx3、βAmx3、γAmx3、αAmy3、βAmy3、γAmy3、αAmz3、βAmz3、γAmz3计算相应的旋转矩阵 此旋转矩阵并非正交,它的含义是RAm1,RAm2,RAm3与对应局部坐标系下的任意一点相乘并进行平移则获得该点在全局坐标系下的位置向量。对于大跨度横梁,选取一段线性度较好的区域进行数据拟合,本例中,如图3,选取正半轴部分区域进行轴线拟合。
步骤3)将每台移动平台固定,由数控系统读出移动平台的当前位置PA0,利用激光跟踪仪测量计算获得机械臂基坐标系原点O在全局坐标系中的位置PAr0及机械臂基坐标系坐标轴拟合轴线XR、YR、ZR的方向,求得XR、YR、ZR轴相对于X、Y、Z轴之间的旋转矩阵RAr,机械臂基坐标系为非正交坐标系,即实现多机械臂系统机械臂的坐标系标定,令移动平台停在一个确定的位置,由数控系统读出当前位置PA0,对于具有大跨度横梁的移动平台停在一段线性度较好的区域内,记机械臂基坐标系原点为O,此时其在全局坐标系下的坐标为PAr0,在所有机械臂末端粘贴靶球,同时为每台机械臂标定一个新的工具坐标系,获得所粘靶球的球心相对于机械臂基坐标系的位置变换关系,编写机械臂运动代码,使机械臂携带靶球沿其自身轴线运动,同时保证机械臂末端姿态不变,记录下达给机械臂控制器的指令值PAr,测得全局坐标系下机械臂工具坐标系原点的坐标PA,记录沿机械臂三轴运动的拟合轴线XR、YR、ZR分别与全局坐标系X、Y、Z轴所成的旋转矩阵 其中,cosαArx、cosβArx、cosγArx、cosαAry、cosβAry、cosγAry、cosαArz、cosβArz、cosγArz为测算得到的XR、YR、ZR轴线与全局坐标系X、Y、Z轴所成角度的余弦值,此旋转矩阵为非正交阵,它的含义是RAr与机械臂基坐标系下的任意一点相乘并进行平移则获得该点在全局坐标系下的位置向量,通过PA-RArPAr,并做平均化处理后求得此时机械臂基坐标系原点在全局坐标系下的坐标PAr0。
令所述三台移动平台停在一个固定的位置,如图3所示,对于具有大跨度横梁的第一台移动平台1令其停y1正半轴内,分别记下此时第一台移动平台1、第二台移动平台3和第三台移动平台5数控系统中的坐标PA10,PA20,PA30,记此时第一台机械臂2,第二台机械臂4,第三台机械臂6基坐标系原点分别为O10,O20,O30。在所有机械臂末端粘贴靶球,同时为每台机械臂标定一个新的工具坐标系,即所粘靶球的球心相对于机械臂基坐标系位置变换关系,这一过程一般均可通过机械臂控制器完成。编写运动代码,使三台机械臂携带靶球沿其自身XR1、YR1、ZR1,XR2、YR2、ZR2,XR3、YR3、ZR3轴运动,同时保证靶球姿态不变。用激光跟踪仪7记录下三个靶球运动的实际位置,即在激光跟踪仪中读出的在全局坐标系下位置PA1,PA2,PA3,以及运动指令位置PAr1,PAr2,PAr3,即靶球中心相对于机械臂基坐标系的位置。记录下激光跟踪仪数据采集软件,如得到的三台机械臂2,4,6分别沿各自轴线运动时的轴线测量报告,获得第一台机械臂2,第二台机械臂4,第三台机械臂6的实际轴线XR1、YR1、ZR1,XR2、YR2、ZR2,XR3、YR3、ZR3分别与全局坐标系X,Y,Z轴所成角度αArx1、βArx1、γArx1、αAry1、βAry1、γAry1、αArz1、βArz1、γArz1,αArx2、βArx2、γArx2、αAry2、βAry2、γAry2、αArz2、βArz2、γArz2,αArx3、βArx3、γArx3、αAry3、βAry3、γAry3、αArz3、βArz3、γArz3,计算相应的旋转矩阵,有 此旋转矩阵并非正交阵,它的含义是RAr1,RAr2,RAr3与对应机械臂基坐标系下的任意一点相乘并进行平移则获得该点在全局坐标系下的位置向量。通过以上数据利用PA1-RAr1PAr1,PA2-RAr2PAr2,PA3-RAr3PAr3并做平均化处理可以求得三台机械臂2,4,6此时基坐标系原点O10,O20,O30在全局坐标系下的坐标PAr10,PAr20,PAr30。
步骤4)将大跨度横梁依据弯曲程度分成若干段,利用激光跟踪仪获得大跨度横梁的各段轴线x',y',z'的方向以及与X、Y、Z轴之间的旋转矩阵R'Am,用于补偿横梁跨度过大引起的下垂。
如图2,对于拥有大跨度横梁的第一台移动平台1,其y1轴,即横梁9往往会由于重力作用发生下垂,这就造成y1轴的轴线方向存在变化。为解决这个问题,将整个横梁依据弯曲程度分成若干区域,本例中,分为三段,再将第一台移动平台1移至大跨度横梁9的其他区域,本例中,移至其余两部分区域,如图4,图5所示;按照前述方法,对第一台移动平台1各轴进行测量;由激光跟踪仪的数据采集软件,如得到两部分区域的轴线测量报告,可以按照前面讲述的办法,由测算得到的第一台移动平台1在两部分区域的轴线x1',y1',z1',x1″,y1″,z1″与全局坐标系X,Y,Z轴所成角度,计算其余各段的旋转矩阵,本例中,分别为R'Am、R″Am。
步骤5)利用激光跟踪仪对每台移动平台的容易产生定位误差的轴线进行分段测量获得的数据,列出一一对应的表格,(PAmx1、PAtx1),(PAmx2、PAtx2),…(PAmxn、PAtxn),采用线性插值补偿公式求得在补偿对应轴线定位误差时需输入的数控指令PAmx,其中,PAtx为对应轴线目标位置,PAmx为需输入的数控指令,PAtx1和PAtx2为分段测量过程中测得的能够包含住PAtx的对应轴线上相邻两点实际位置,PAmx1、PAmx2为分段测量过程中对应于PAtx1、PAtx2两点的数控指令值。
对所述三台移动平台的较长的X轴进行逐点测量,为数控指令值PAmx和实测数据PAtx建立一一对应的表格,(PAmx11、PAtx11),(PAmx12、PAtx12),…,(PAmx1n、PAtx1n);(PAmx21、PAtx21),(PAmx22、PAtx22),…,(PAmx2n、PAtx2n);(PAmx31、PAtx31),(PAmx32、PAtx32),…(PAmx3n、PAtx3n),n为正整数。根据如上对应关系,利用线性插补公式可以分别求出在某一区间内,要达到所述三台移动平台的x1、x2、x3轴线上某一真实位置PAtx1,PAtx2,PAtx3,应该下达的数控指令, 其中,PAtx1,PAtx2,PAtx3为三台移动平台1,3,5的轴线目标位置,PAmx1,PAmx2,PAmx3为需输入三台移动平台数控系统的指令值,PAtx1i、PAtx1(i+1),PAtx2i、PAtx2(i+1),PAtx3i、PAtx3(i+1)为分段测量过程中测得的能够包含PAtx1,PAtx2,PAtx3的三台移动平台1,3,5的x1、x2、x3轴线上相邻两点的实际位置,PAmx1i、PAmx1(i+1),PAmx2i、PAmx2(i+1),PAmx3i、PAmx3(i+1)为分段测量过程中对应于PAtx1i、PAtx1(i+1),PAtx2i、PAtx2(i+1),PAtx3i、PAtx3(i+1)的所述三台移动平台数控指令值。
步骤6)利用补偿公式PArT=PAr0+RAm(PAmT-PA0),获得不考虑移动平台轴线定位误差时要使机械臂基坐标系原点到达实际位置PArT需要下达给移动平台数控系统的理论指令值PAmT,利用线性插值补偿公式用PAmT中的定位误差较大轴线坐标PAmTx替换PAtx,获得该轴线实际需输入移动平台数控系统的坐标PAmRx,用PAmRx替换PAmT中的PAmTx,获得需要下达给移动平台数控系统的实际指令值PAmR,即实现多机械臂系统移动平台定位精度补偿。
利用补偿公式PA1=RAr1PAr1+PAr10+RAm1(PAmT1-PA10),PA2=RAr2PAr2+PAr20+RAm2(PAmT2-PA20),PA3=RAr3PAr3+PAr30+RAm3(PAmT3-PA30),求第一台机械臂2、第二台机械臂4和第三台机械臂6的末端点,即机械臂工具坐标系原点到达PA1,PA2,PA3,需下达给机械臂控制器的指令值PAr1,PAr2,PAr3,其中,PA1,PA2,PA3是全局坐标系下所述三台机械臂末端,即机械臂工具坐标系原点的坐标,为已知量,RAr1,RAr2,RAr3是机械臂基坐标系相对于全局坐标系的旋转矩阵,为已知量,PAr1,PAr2,PAr3是要求的下达给机械臂控制器的指令值,为未知量,PAr10,PAr20,PAr30是移动平台停在PA10,PA20,PA30是机械臂基坐标系原点在全局坐标系中的位置,为已知量,RAm1,RAm2,RAm3是所述三台移动平台的轴线相对于全局坐标系的旋转矩阵,为已知量,PAmT1,PAmT2,PAmT3是不考虑移动平台轴线定位误差时要使机械臂基坐标系原点到达理论位置需输入数控系统的指令值,为已知量,PA10,PA20,PA30是对三台机械臂2,4,6进行测量时三台移动平台数控系统指令值,为已知量。
步骤7)利用补偿公式PA=RArPAr+PAr0+RAm(PAmT-PA0)+PC,求出考虑横梁下垂变形时,要使机械臂工具坐标系原点到达PA需下达给机械臂控制器的指令值PAr,即实现多机械臂系统机械臂精度补偿,其中,PA是全局坐标系下机械臂工具坐标系原点的坐标,为已知量,RAr是机械臂基坐标系相对于全局坐标系的旋转矩阵,为已知量,PAr是要求的下达给机械臂控制器的指令值,为未知量,PAr0是移动平台停在PA0时机械臂基坐标系原点在全局坐标系中的位置,为已知量,RAm是移动平台轴线相对于全局坐标系的旋转矩阵,为已知量,PAmT是不考虑移动平台轴线定位误差时要使机械臂基坐标系原点到达理论位置需输入的指令值,为已知量,PA0是对机械臂进行测量时移动平台数控系统指令值,为已知量,PC是考虑大跨度横梁下垂问题引入的补偿向量,为已知量。求得PC的方法是过当前机械臂基坐标系原点作平行于当前区域横梁方向的直线l',由点O向l'引垂线,垂足记为s',记PC为由点O指向点s'的向量。
当第一台移动平台1移至如图4,图5所示两段区域时,需过O1',O1″作平行于当前第一台机械臂2所处区域y1',y″1方向的直线l',l″,由点O10向l',l″引垂线,垂足分别记为s',s″,记PC',PC″为O10指向s',s″的向量。则补偿公式为PA1=RAr1PAr1+PAr10+R'Am1(PAmT1-PA10)+P′C,PA1=RAr1PAr1+PAr10+R″Am1(PAmT1-PA10)+P″C,其中R'Am1,R″Am1是第一台移动平台1处于其余两部分区域时相对于全局坐标系的旋转矩阵,为已知量;至此,即实现多机械臂系统定位精度补偿。
Claims (6)
1.一种多机械臂系统坐标系标定及精度补偿方法,每个机械臂系统包括三自由度移动平台和固定在移动平台上的机械臂,移动平台由数控系统控制,其特征在于,所述方法包括如下步骤:
1)架设激光跟踪仪,在全局范围内为整套系统选取原始测量点并粘贴靶球,原始测量点随移动平台移动且能够在移动平台全行程内使靶球接受激光跟踪仪光线并反射,利用激光跟踪仪对原始测量点进行测量,采用三点定义法定义全局坐标系的原点和全局坐标系的X、Y、Z轴方向,全局坐标系为正交坐标系,全局坐标系的原点定义在粘贴有原始测量点的移动平台;
2)在每台移动平台的具有三自由度的运动部件上另行粘贴靶球,利用激光跟踪仪依次测量所有移动平台的三个坐标轴的方向,即为局部坐标系坐标轴x、y、z的方向,局部坐标系原点定义在移动平台处于零位时靶球处在全局坐标系下的位置,并且计算x、y、z轴与X、Y、Z轴之间的旋转矩阵RAm,局部坐标系为非正交坐标系,即实现多机械臂系统移动平台的坐标系标定;
3)将每台移动平台固定,由数控系统读出移动平台的当前位置PA0,利用激光跟踪仪测量计算获得机械臂基坐标系原点O在全局坐标系中的位置PAr0及机械臂基坐标系坐标轴拟合轴线XR、YR、ZR的方向,求得XR、YR、ZR轴相对于X、Y、Z轴之间的旋转矩阵RAr,机械臂基坐标系为非正交坐标系,即实现多机械臂系统机械臂的坐标系标定;
4)将大跨度横梁依据弯曲程度分成若干段,利用激光跟踪仪获得大跨度横梁的各段轴线x',y',z'的方向以及与X、Y、Z轴之间的旋转矩阵R'Am,用于补偿横梁跨度过大引起的下垂;
5)利用激光跟踪仪对每台移动平台的容易产生定位误差的轴线进行分段测量获得的数据,采用线性插值补偿公式求得在补偿对应轴线定位误差时需输入的数控指令:
其中,PAtx为对应轴线目标位置,PAmx为需输入的数控指令,PAtx1和PAtx2为分段测量过程中测得的能够包含住PAtx的对应轴线上相邻两点实际位置,PAmx1、PAmx2为分段测量过程中对应于PAtx1、PAtx2两点的数控指令值;
6)利用补偿公式PArT=PAr0+RAm(PAmT-PA0),获得不考虑移动平台轴线定位误差时要使机械臂基坐标系原点到达实际位置PArT需要下达给移动平台数控系统的理论指令值PAmT,利用线性插值补偿公式用PAmT中的定位误差较大轴线坐标PAmTx替换PAtx,获得该轴线实际需输入移动平台数控系统的坐标PAmRx,用PAmRx替换PAmT中的PAmTx,获得需要下达给移动平台数控系统的实际指令值PAmR,即实现多机械臂系统移动平台定位精度补偿;
7)利用补偿公式PA=RArPAr+PAr0+RAm(PAmT-PA0)+PC,求出要使机械臂工具坐标系原点到达PA需下达给机械臂控制器的指令值PAr,即实现多机械臂系统机械臂精度补偿,其中,PA是全局坐标系下机械臂工具坐标系原点的坐标,为已知量,RAr是机械臂基坐标系相对于全局坐标系的旋转矩阵,为已知量,PAr是要求的下达给机械臂控制器的指令值,为未知量,PAr0是移动平台停在PA0时机械臂基坐标系原点在全局坐标系中的位置,为已知量,RAm是移动平台轴线相对于全局坐标系的旋转矩阵,为已知量,PAmT是不考虑移动平台轴线定位误差时要使机械臂基坐标系原点到达理论位置需输入的指令值,为已知量,PA0是对机械臂进行测量时移动平台数控系统指令值,为已知量,PC是考虑大跨度横梁下垂问题引入的补偿向量,为已知量。
2.根据权利要求1所述的一种多机械臂系统坐标系标定及精度补偿方法,其特征在于,步骤2)中计算x、y、z轴与X、Y、Z轴之间的旋转矩阵RAm的方法是:
1)在每台移动平台上粘贴靶球,靶球粘贴处应具有三个自由度,且能在各自移动平台运动范围内使靶球能够接收激光跟踪仪光线并反射,对每台移动平台各轴进行线性测量,得到局部坐标系的x、y、z轴线方向并获得与全局坐标系X、Y、Z轴线之间的旋转矩阵: 其中cosαAmx、cosβAmx、cosγAmx、cosαAmy、cosβAmy、cosγAmy、cosαAmz、cosβAmz、cosγAmz为测算得到的x、y、z轴线分别与全局坐标系X、Y、Z轴所成角度的余弦值;对于大跨度横梁,选取一段线性度较好的区域进行数据拟合,此旋转矩阵为非正交阵,其意义是RAm与局部坐标系下的任意一点相乘,并经过平移,得到全局坐标系下的位置向量。
3.根据权利要求1所述的一种多机械臂系统坐标系标定及精度补偿方法,其特征在于,步骤3)中计算XR、YR、ZR轴相对于X、Y、Z轴之间的旋转矩阵RAr和机械臂基坐标系原点O在全局坐标系中的位置PAr0的方法是:
1)令移动平台停在一个确定的位置,由数控系统读出当前位置PA0,对于具有大跨度横梁的移动平台停在一段线性度较好的区域内,记机械臂基坐标系原点为O,此时其在全局坐标系下的坐标为PAr0,在所有机械臂末端粘贴靶球,同时为每台机械臂标定一个新的工具坐标系,获得所粘靶球的球心相对于机械臂基坐标系的位置变换关系;
2)编写机械臂运动代码,使机械臂携带靶球沿其自身轴线运动,同时保证机械臂末端姿态不变,记录下达给机械臂控制器的指令值PAr,测得全局坐标系下机械臂工具坐标系原点的坐标PA;
3)记录沿机械臂三轴运动的拟合轴线XR、YR、ZR分别与全局坐标系X、Y、Z轴所成的旋转矩阵 其中,cosαArx、cosβArx、cosγArx、cosαAry、cosβAry、cosγAry、cosαArz、cosβArz、cosγArz为测算得到的XR、YR、ZR轴线与全局坐标系X、Y、Z轴所成角度的余弦值,此旋转矩阵为非正交阵,它的含义是RAr与机械臂基坐标系下的任意一点相乘并进行平移则获得该点在全局坐标系下的位置向量;
4)通过PA-RArPAr,并做平均化处理后求得此时机械臂基坐标系原点在全局坐标系下的坐标PAr0。
4.根据权利要求1所述的一种多机械臂系统坐标系标定及精度补偿方法,其特征在于,步骤4)中所述的将大跨度横梁依据弯曲程度分段,利用激光跟踪仪获得大跨度横梁的各段的轴线x'、y'、z'轴的方向以及与X、Y、Z轴之间的旋转矩阵R'Am,用于补偿横梁跨度过大引起的下垂的方法是:
a.将整个横梁依据弯曲程度分为三段,将移动平台移至大跨度横梁的其它一部分区域;
b.按照步骤2)所述方法对移动平台各轴进行测量,得到移动平台x'、y'、z'轴线与全局坐标系X、Y、Z轴所成的旋转矩阵R'Am;
c.重复步骤a和b,得到另一区域中移动平台x″、y″、z″轴线与全局坐标系X、Y、Z轴所成的旋转矩阵R'A'm。
5.根据权利要求1所述的一种多机械臂系统坐标系标定及精度补偿方法,其特征在于,步骤5)中所述的移动平台容易产生定位误差的轴线为移动平台的较长轴,采用线性插值补偿公式求得在补偿对应轴线定位误差时需输入的数控指令PAmx的方法是:
1)由移动平台较长轴X轴进行逐点测量,为数控指令值和实测数据列出一一对应的表格,(PAmx1、PAtx1),(PAmx2、PAtx2),…,(PAmxn、PAtxn),n为正整数;
2)根据如上对应关系,利用线性插补公式求出在某一区间内要达到移动平台X轴线上某一真实位置PAtx,需输入的数控指令PAmx。
6.根据权利要求1所述的一种多机械臂系统坐标系标定及精度补偿方法,其特征在于,步骤7)中所述补偿公式PA=RArPAr+PAr0+RAm(PAmT-PA0)+PC中求得PC的方法是:
1)过当前机械臂基坐标系原点作平行于当前区域横梁方向的直线l',由点O向l'引垂线,垂足记为s',记PC为由点O指向点s'的向量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510017394.6A CN104596418B (zh) | 2014-08-12 | 2015-01-13 | 一种多机械臂系统坐标系标定及精度补偿方法 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2014103949969 | 2014-08-12 | ||
CN201410394996 | 2014-08-12 | ||
CN201510017394.6A CN104596418B (zh) | 2014-08-12 | 2015-01-13 | 一种多机械臂系统坐标系标定及精度补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104596418A true CN104596418A (zh) | 2015-05-06 |
CN104596418B CN104596418B (zh) | 2017-06-13 |
Family
ID=53122362
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510017394.6A Active CN104596418B (zh) | 2014-08-12 | 2015-01-13 | 一种多机械臂系统坐标系标定及精度补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104596418B (zh) |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105444672A (zh) * | 2015-12-17 | 2016-03-30 | 华科精准(北京)医疗科技有限公司 | 激光测距仪和机械臂末端关系的正交平面标定方法及系统 |
CN105919669A (zh) * | 2016-07-01 | 2016-09-07 | 华南理工大学 | 一种利用标定装置实现光学手术导航手术器械标定的方法 |
CN106017326A (zh) * | 2016-08-02 | 2016-10-12 | 清华大学 | 龙门制孔机床点位精度评价方法 |
CN106502204A (zh) * | 2016-12-12 | 2017-03-15 | 常州机电职业技术学院 | 数控车削细长轴挠度误差动态补偿方法 |
CN107138944A (zh) * | 2017-05-18 | 2017-09-08 | 哈尔滨工业大学 | 基于空间点误差修正的两工件自动对准方法 |
CN108319299A (zh) * | 2017-11-30 | 2018-07-24 | 北京工业大学 | 一种多测头安装角度的调节装置、测量和补偿方法 |
CN108759672A (zh) * | 2018-06-16 | 2018-11-06 | 复旦大学 | 工业机器人末端位置测量及位移误差补偿方法 |
CN109059768A (zh) * | 2018-08-31 | 2018-12-21 | 扬州大学 | 一种容器内置零件检测系统的位姿标定方法 |
CN109108982A (zh) * | 2018-10-10 | 2019-01-01 | 烟台大学 | 基于标准量具的多关节机器人几何尺寸精度校准装置及校准方法 |
CN109269530A (zh) * | 2018-09-06 | 2019-01-25 | 三英精控(天津)科技有限公司 | 一种纳米定位台高频增益补偿的方法 |
CN109813218A (zh) * | 2019-01-23 | 2019-05-28 | 南京工程学院 | 一种用于激光跟踪仪的三自由度靶标的精度补偿方法 |
CN111948210A (zh) * | 2019-05-17 | 2020-11-17 | 上海贝特威自动化科技有限公司 | 一种机械视觉缺陷检测方法及其系统 |
CN112577420A (zh) * | 2019-09-30 | 2021-03-30 | 中国科学院沈阳自动化研究所 | 一种多工位关节臂式测量平台的全局标定方法 |
CN113134837A (zh) * | 2021-04-16 | 2021-07-20 | 浙江大学 | 一种基于六自由度串联机械臂提高绝对定位精度的方法 |
CN113400318A (zh) * | 2021-07-16 | 2021-09-17 | 四川成焊宝玛焊接装备工程有限公司 | 机器人用户坐标系补偿方法、汽车在线滚边系统及方法 |
WO2021213409A1 (zh) * | 2020-04-20 | 2021-10-28 | 台北科技大学 | 多轴移动平台及其控制方法 |
CN114740801A (zh) * | 2022-03-21 | 2022-07-12 | 成都飞机工业(集团)有限责任公司 | 一种用于数控设备群协同生产线安装的基坐标系创建方法 |
CN116400647A (zh) * | 2023-06-08 | 2023-07-07 | 成都飞机工业(集团)有限责任公司 | 多轴插补运动控制方法、装置、存储介质及电子设备 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60205311A (ja) * | 1984-03-30 | 1985-10-16 | Mitsubishi Electric Corp | 三次元座標測定法 |
CN101149256A (zh) * | 2007-11-05 | 2008-03-26 | 中山大学 | 一种基于距离约束的随动式测量机械臂标定方法 |
CN101231749A (zh) * | 2007-12-20 | 2008-07-30 | 昆山华恒工程技术中心有限公司 | 一种工业机器人的标定方法 |
JP2008185543A (ja) * | 2007-01-31 | 2008-08-14 | Toyota Motor Corp | 非接触3次元座標測定装置の測定ヘッド保持機構 |
CN102062576A (zh) * | 2010-11-12 | 2011-05-18 | 浙江大学 | 基于激光跟踪测量的附加外轴机器人自动标定装置及方法 |
CN102087096A (zh) * | 2010-11-12 | 2011-06-08 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
-
2015
- 2015-01-13 CN CN201510017394.6A patent/CN104596418B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60205311A (ja) * | 1984-03-30 | 1985-10-16 | Mitsubishi Electric Corp | 三次元座標測定法 |
JP2008185543A (ja) * | 2007-01-31 | 2008-08-14 | Toyota Motor Corp | 非接触3次元座標測定装置の測定ヘッド保持機構 |
CN101149256A (zh) * | 2007-11-05 | 2008-03-26 | 中山大学 | 一种基于距离约束的随动式测量机械臂标定方法 |
CN101231749A (zh) * | 2007-12-20 | 2008-07-30 | 昆山华恒工程技术中心有限公司 | 一种工业机器人的标定方法 |
CN102062576A (zh) * | 2010-11-12 | 2011-05-18 | 浙江大学 | 基于激光跟踪测量的附加外轴机器人自动标定装置及方法 |
CN102087096A (zh) * | 2010-11-12 | 2011-06-08 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105444672B (zh) * | 2015-12-17 | 2017-10-17 | 华科精准(北京)医疗科技有限公司 | 激光测距仪和机械臂末端关系的正交平面标定方法及系统 |
CN105444672A (zh) * | 2015-12-17 | 2016-03-30 | 华科精准(北京)医疗科技有限公司 | 激光测距仪和机械臂末端关系的正交平面标定方法及系统 |
CN105919669A (zh) * | 2016-07-01 | 2016-09-07 | 华南理工大学 | 一种利用标定装置实现光学手术导航手术器械标定的方法 |
CN105919669B (zh) * | 2016-07-01 | 2018-07-20 | 华南理工大学 | 一种利用标定装置实现光学手术导航手术器械标定的方法 |
CN106017326A (zh) * | 2016-08-02 | 2016-10-12 | 清华大学 | 龙门制孔机床点位精度评价方法 |
CN106502204A (zh) * | 2016-12-12 | 2017-03-15 | 常州机电职业技术学院 | 数控车削细长轴挠度误差动态补偿方法 |
CN107138944A (zh) * | 2017-05-18 | 2017-09-08 | 哈尔滨工业大学 | 基于空间点误差修正的两工件自动对准方法 |
CN108319299A (zh) * | 2017-11-30 | 2018-07-24 | 北京工业大学 | 一种多测头安装角度的调节装置、测量和补偿方法 |
CN108759672A (zh) * | 2018-06-16 | 2018-11-06 | 复旦大学 | 工业机器人末端位置测量及位移误差补偿方法 |
CN108759672B (zh) * | 2018-06-16 | 2020-04-24 | 复旦大学 | 工业机器人末端位置测量及位移误差补偿方法 |
CN109059768A (zh) * | 2018-08-31 | 2018-12-21 | 扬州大学 | 一种容器内置零件检测系统的位姿标定方法 |
CN109269530A (zh) * | 2018-09-06 | 2019-01-25 | 三英精控(天津)科技有限公司 | 一种纳米定位台高频增益补偿的方法 |
CN109108982A (zh) * | 2018-10-10 | 2019-01-01 | 烟台大学 | 基于标准量具的多关节机器人几何尺寸精度校准装置及校准方法 |
CN109108982B (zh) * | 2018-10-10 | 2024-01-09 | 烟台大学 | 基于标准量具的多关节机器人几何尺寸精度校准装置及校准方法 |
CN109813218A (zh) * | 2019-01-23 | 2019-05-28 | 南京工程学院 | 一种用于激光跟踪仪的三自由度靶标的精度补偿方法 |
CN111948210A (zh) * | 2019-05-17 | 2020-11-17 | 上海贝特威自动化科技有限公司 | 一种机械视觉缺陷检测方法及其系统 |
CN112577420A (zh) * | 2019-09-30 | 2021-03-30 | 中国科学院沈阳自动化研究所 | 一种多工位关节臂式测量平台的全局标定方法 |
WO2021213409A1 (zh) * | 2020-04-20 | 2021-10-28 | 台北科技大学 | 多轴移动平台及其控制方法 |
CN113134837A (zh) * | 2021-04-16 | 2021-07-20 | 浙江大学 | 一种基于六自由度串联机械臂提高绝对定位精度的方法 |
CN113134837B (zh) * | 2021-04-16 | 2022-05-06 | 浙江大学 | 一种基于六自由度串联机械臂提高绝对定位精度的方法 |
CN113400318A (zh) * | 2021-07-16 | 2021-09-17 | 四川成焊宝玛焊接装备工程有限公司 | 机器人用户坐标系补偿方法、汽车在线滚边系统及方法 |
CN114740801A (zh) * | 2022-03-21 | 2022-07-12 | 成都飞机工业(集团)有限责任公司 | 一种用于数控设备群协同生产线安装的基坐标系创建方法 |
CN114740801B (zh) * | 2022-03-21 | 2023-09-29 | 成都飞机工业(集团)有限责任公司 | 一种用于数控设备群协同生产线安装的基坐标系创建方法 |
CN116400647A (zh) * | 2023-06-08 | 2023-07-07 | 成都飞机工业(集团)有限责任公司 | 多轴插补运动控制方法、装置、存储介质及电子设备 |
CN116400647B (zh) * | 2023-06-08 | 2023-09-29 | 成都飞机工业(集团)有限责任公司 | 多轴插补运动控制方法、装置、存储介质及电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN104596418B (zh) | 2017-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104596418A (zh) | 一种多机械臂系统坐标系标定及精度补偿方法 | |
CN108748159B (zh) | 一种机械臂工具坐标系自标定方法 | |
CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
CN108297101B (zh) | 多关节臂串联机器人末端位姿误差检测和动态补偿方法 | |
CN106043736B (zh) | 一种用于飞机部件调姿的串并联机械结构及调姿方法 | |
CN107042528B (zh) | 一种工业机器人的运动学标定系统及方法 | |
CN110948522B (zh) | 一种基于拉线旋转传感器的工业机器人空间位姿测量机构及测量方法 | |
US9797700B2 (en) | Variable modelling of a measuring device | |
Ren et al. | A new calibration method for parallel kinematics machine tools using orientation constraint | |
CN109822574A (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
CN108705531A (zh) | 工业机器人的运动学参数标定方法、标定系统、电子设备 | |
CN104354166B (zh) | 一种三自由度并联机器人的零点标定方法 | |
CN101539397B (zh) | 物体三维姿态的精密光学测量方法 | |
CN101660904A (zh) | 一种用于测量机器人的运动学标定的方法 | |
Wang et al. | Identification of strut and assembly errors of a 3-PRS serial–parallel machine tool | |
CN110370271B (zh) | 工业串联机器人的关节传动比误差校准方法 | |
CN108132029B (zh) | 一种卫星天线展开系统装配的精测方法及装置 | |
CN205734940U (zh) | 一种应用于工业机器人的tcp在线快速标定装置 | |
CN107471257B (zh) | 基于单拉线编码器的机器人几何标定方法 | |
CN109062139B (zh) | 一种基于数据驱动的机器人直线轴定位误差补偿方法 | |
CN114406991B (zh) | 基于拉线式编码器的工业机器人标定与空间位置测量方法 | |
CN108507572B (zh) | 一种基于mems惯性测量单元的姿态定位误差修正方法 | |
CN106671081B (zh) | 一种基于单目视觉的少自由度机器人运动学标定方法 | |
CN114505865A (zh) | 一种基于位姿跟踪的机械臂路径生成方法及系统 | |
CN102279584A (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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20180209 Address after: 300300 Tianjin Huaming street Dongli Huaming Road No. 36 Building No. 2 Patentee after: Qingyan co creation robot (Tianjin) Co., Ltd. Address before: 100084 Beijing, Haidian District, 100084 box office box office, Tsinghua University, Patentee before: Tsinghua University |
|
TR01 | Transfer of patent right |