[发明专利]一种多工位关节臂式测量平台的全局标定方法有效
| 申请号: | 201910940852.1 | 申请日: | 2019-09-30 |
| 公开(公告)号: | CN112577420B | 公开(公告)日: | 2021-11-30 |
| 发明(设计)人: | 赵亮;夏仁波;赵吉宾;陈月玲;于彦凤;付生鹏 | 申请(专利权)人: | 中国科学院沈阳自动化研究所 |
| 主分类号: | G01B11/00 | 分类号: | G01B11/00 |
| 代理公司: | 沈阳科苑专利商标代理有限公司 21002 | 代理人: | 王倩 |
| 地址: | 110016 辽*** | 国省代码: | 辽宁;21 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 多工位 关节 测量 平台 全局 标定 方法 | ||
1.一种多工位关节臂式测量平台的全局标定方法,其特征在于,包括以下步骤:
步骤1:设置两侧轨道的起始位置,安装激光跟踪仪、关节臂测量仪以及靶标,两个关节臂测量仪分别安装在两个轨道的滑块上;
步骤2:在一侧轨道滑块上放置激光跟踪仪的靶球,滑块运动,激光跟踪仪采集每次滑块停止后靶球坐标并拟合轨道直线的方向向量;
步骤3:在起始位置处,关节臂测量仪与激光跟踪仪分别测量靶标上的激光跟踪仪靶球坐标,计算在起始位置处关节臂测量仪坐标系与激光跟踪仪坐标系的变换关系;
步骤4:在另一侧轨道重复步骤2、步骤3;
步骤5:以激光跟踪仪坐标系作为全局坐标系,实现两侧轨道任意位置的关节臂测量仪坐标系到全局坐标系的统一;
所述实现两侧轨道任意位置的关节臂测量仪坐标系到全局坐标系的统一方法如下:通过计算分别得到的两侧轨道起始位置处关节臂测量仪坐标系到激光跟踪仪坐标系变换矩阵T1、T2,两侧轨道在激光跟踪仪坐标系下的运动直线的方向向量(m1,n1,p1)、(m2,n2,p2),就能够实现两侧轨道任意位置的关节臂测量仪坐标系到全局坐标系的统一;
一侧轨道上与起始位置距离为d的工位到全局坐标系的变换矩阵T1i可以直接计算得到,表示如下:
0T=[0 0 0]
其中T1是一侧轨道的起始位置的关节臂测量仪坐标系到激光跟踪仪坐标系的变换矩阵,矩阵R1是T1的旋转分量组成的3*3旋转矩阵,x0表示矩阵T1的在关节臂测量仪坐标系X方向的平移分量,y0表示矩阵T1的在关节臂测量仪坐标系Y方向的平移分量,z0表示矩阵T1的在关节臂测量仪坐标系Z方向的平移分量,T1i是一侧轨道的任意工位的关节臂测量仪坐标系到激光跟踪仪坐标系的变换矩阵,i是工位索引,i∈[1,…,n],n是自然数,矩阵t1i是T1i的平移分量组成的3*1平移矩阵,一侧轨道直线方向向量(m1,n1,p1),d是一侧轨道的任意工位与一侧轨道起始位置的距离。
2.根据权利要求1所述的一种多工位关节臂式测量平台的全局标定方法,其特征在于,所述靶标为带有靶座的支架放置于两侧轨道起始位置之间,其上可放置不少于3个且不在同一直线上的激光跟踪仪的磁性靶座,靶座用于放置靶球。
3.根据权利要求1所述的一种多工位关节臂式测量平台的全局标定方法,其特征在于,所述轨道直线的方向向量是由激光跟踪仪采集放置在关节臂测量仪滑块上的靶球坐标,并根据滑块运动过程中采集的所有靶球坐标拟合轨道直线的方向向量。
4.根据权利要求1所述的一种多工位关节臂式测量平台的全局标定方法,其特征在于,在步骤3中,关节臂测量仪测量靶标的每个靶球的表面点坐标,分别拟合球心,获得靶标的靶球球心在关节臂坐标系下的坐标集合P;所述激光跟踪仪测量靶标的每个靶球的球心坐标,获得靶标的球心在激光跟踪仪坐标系下的坐标集合Q。
5.根据权利要求4所述的一种多工位关节臂式测量平台的全局标定方法,其特征在于,计算坐标集合P与坐标集合Q的变换关系公式如下:
Q=Tj*P
其中Tj是某一侧轨道的起始位置的关节臂测量仪坐标系到激光跟踪仪坐标系的变换矩阵,j=1、2。
6.根据权利要求1所述的一种多工位关节臂式测量平台的全局标定方法,其特征在于,另一侧轨道上与起始位置距离为d的工位到全局坐标系的变换矩阵T2i可以直接计算得到,表示如下:
0T=[0 0 0]
其中T2是另一侧轨道的起始位置的关节臂测量仪坐标系到激光跟踪仪坐标系的变换矩阵,矩阵R2是T2的旋转分量组成的3*3旋转矩阵,x1表示矩阵T2的在关节臂测量仪坐标系X方向的平移分量,y1表示矩阵T2的在关节臂测量仪坐标系Y方向的平移分量,z1表示矩阵T2的在关节臂测量仪坐标系Z方向的平移分量,T2i是另一侧轨道的任意工位的关节臂测量仪坐标系到激光跟踪仪坐标系的变换矩阵,i是工位索引,i∈[1,…,n],n是自然数,矩阵t2i是T2i的平移分量组成的3*1平移矩阵,另一侧轨道直线方向向量(m2,n2,p2),d是另一侧轨道的任意工位与另一侧轨道起始位置的距离。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国科学院沈阳自动化研究所,未经中国科学院沈阳自动化研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910940852.1/1.html,转载请声明来源钻瓜专利网。





