CN109631762B - 一种激光自标定实现零点标定的方法 - Google Patents
一种激光自标定实现零点标定的方法 Download PDFInfo
- Publication number
- CN109631762B CN109631762B CN201910085768.6A CN201910085768A CN109631762B CN 109631762 B CN109631762 B CN 109631762B CN 201910085768 A CN201910085768 A CN 201910085768A CN 109631762 B CN109631762 B CN 109631762B
- Authority
- CN
- China
- Prior art keywords
- rod
- center
- sphere
- laser
- target
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开了一种激光自标定实现零点标定的方法,所述激光跟踪测长仪为一个单频激光干涉仪安装在有两个互相垂直的旋转自由度的机构中心上的仪器,所述跟踪仪的反射靶为一个内部安装了角锥反射镜的球,角锥的顶点与球心重合,激光跟踪仪可以跟踪在空间运动的靶并测量靶的圆心在跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到靶的中心的距离和两点连线的两个方向角。本发明使得激光目标点的实际位置恰好位于预期位置上,从而实现激光自标定的零点标定。
Description
技术领域
本发明涉及零点标定技术领域,具体为一种激光自标定实现零点标定的方法。
背景技术
通常激光的重复定位精度很高(可达0.01mm),但绝对定位精度很差(仅几个毫米)。如果要使用机器壁的离线编程方法或者是进行高精度测量,激光的目标点位置精度将会是一个非常令人关心的问题。机器人末端执行器的位置一般在其工作空间内描述,但是这些位置通过驱动关节电动机获得,整个过程在角度空间里进行。因某些原因(例如:机械加工的精度、装配误差、磨损、传动误差、负载变化和环境影响等)使得机器人控制器所使用的运动学模型与真实的运动学模型不一致,从而导致用机器人内部运动学模型来驱动关节电动机获得末端执行器位置时,得到的激光目标点的实际位置将会偏离预期的位置。
发明内容
本发明的目的在于提供一种激光自标定实现零点标定的方法,以解决上述背景技术中提出的机器人内部运动学模型来驱动关节电动机获得末端执行器位置时,得到的激光目标点的实际位置将会偏离预期的位置问题。
为实现上述目的,本发明提供如下技术方案:一种激光自标定实现零点标定的方法,所述激光跟踪测长仪为一个单频激光干涉仪安装在有两个互相垂直的旋转自由度的机构中心上的仪器,所述跟踪仪的反射靶为一个内部安装了角锥反射镜的球,角锥的顶点与球心重合,激光跟踪仪可以跟踪在空间运动的靶并测量靶的圆心在跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到靶的中心的距离和两点连线的两个方向角。
优选的,一种激光自标定实现零点标定的方法,包括以下步骤:
a.测量动平台上铰链点的位置。固定并联机床的一根杆,使它既不伸缩,也不绕任何轴转动,即固定该杆在动平台上的铰链点在空间的位置。将测量平台放到动平台前,激光跟踪仪安装到其中一个定位孔上。测量动平台上安放好三个靶镜,并设其中一个为靶镜A。使动平台运动到某一位置静止不动,用激光跟踪仪在三个定位孔上分别检测到三个靶镜的距离,由得到的数据可以计算出动平台上三个靶镜中点在测量坐标系中的坐标。重复上述过程多次,选择靶镜A的4个不在同一平面内的坐标。由空间解析几何知,已知4个不共面的点P(x,y,z),i=1,2,3,4,过这4点的球面方程是
X2+Y2+Z2 X Y Z 1=0
X2 1+Y2 1+Z2 1 X1 Y1 Z1 1=0
X2 2+Y2 2+Z2 2 X2 Y2 Z2 1=0
X2 3+Y2 3+Z2 3 X3 Y3 Z3 1=0
X2 4+Y2 4+Z2 4 X4 Y4 Z4 1=0
b.由此方程可以得到球心坐标。所以将上述四点代入球面方程中,就可计算出固定的杆在动平台上的铰链点在测量坐标系中的坐标。
c.测量静平台上铰链点的位置。现在已知某根杆在动平台上的铰链点的坐标,每一次使该杆杆长不变的测量其实是测出了以该杆在静平台上的铰链为圆心,以固定杆长为半径的一个球上的点的坐标,所以圆心和半径都可以求出。固定某一根杆的杆长,将该杆的角度变化四次,每次都用测得的数据计算出该杆在动平台上铰链点的空间坐标,代入球面方程中可以计算出杆在静平台上的铰链点在测量坐标系中的坐标。
与现有技术相比,本发明的
有益效果是:
1、通过测量动平台上铰链点的位置,然后由球面方程可以得到球心坐标,从而测量静平台上铰链点的位置,由此可以保证机器人内部运动学模型来驱动关节电动机获得末端执行器位置时,使得激光目标点的实际位置恰好位于预期位置上,从而实现激光自标定的零点标定。
2、通过用测得的数据计算出动平台在测量坐标系中的位置,而该铰链点在测量坐标系中的坐标可知,所以在动平台上的位置也就可以计算出来了。依次对每一根杆使用以上的方法,就可以测量出动平台上各铰链点的实际位置。
具体实施方式
本申请实施例通过提供通过测量动平台上铰链点的位置,然后由球面方程可以得到球心坐标,从而测量静平台上铰链点的位置,由此可以保证机器人内部运动学模型来驱动关节电动机获得末端执行器位置时,使得激光目标点的实际位置恰好位于预期位置上,从而实现激光自标定的零点标定。
本申请实施例中的技术方案为解决上述串扰的问题,总体思路如下:
通过激光跟踪测长仪是将一个单频激光干涉仪安装在有两个互相垂直的旋转自由度的机构中心上的仪器,其旋转中心的位置在测量时保持不变。跟踪仪的反射靶是一个内部安装了角锥反射镜的球,角锥的顶点与球心重合。用激光跟踪仪可以跟踪在空间运动的靶并测量靶的圆心在以跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到靶的中心的距离和两点连线的两个方向角。
使得激光目标点的实际位置恰好位于预期位置上,从而实现激光自标定的零点标定,通过用测得的数据计算出动平台在测量坐标系中的位置,而该铰链点在测量坐标系中的坐标可知,所以在动平台上的位置也就可以计算出来了。依次对每一根杆使用以上的方法,就可以测量出动平台上各铰链点的实际位置。
下面将结合本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例一:
一种激光自标定实现零点标定的方法,激光跟踪测长仪为一个单频激光干涉仪安装在有两个互相垂直的旋转自由度的机构中心上的仪器,跟踪仪的反射靶为一个内部安装了角锥反射镜的球,角锥的顶点与球心重合,激光跟踪仪可以跟踪在空间运动的靶并测量靶的圆心在跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到靶的中心的距离和两点连线的两个方向角。
实施例二
一种激光自标定实现零点标定的方法,包括以下步骤:
a.测量动平台上铰链点的位置。固定并联机床的一根杆,使它既不伸缩,也不绕任何轴转动,即固定该杆在动平台上的铰链点在空间的位置。将测量平台放到动平台前,激光跟踪仪安装到其中一个定位孔上。测量动平台上安放好三个靶镜,并设其中一个为靶镜A。使动平台运动到某一位置静止不动,用激光跟踪仪在三个定位孔上分别检测到三个靶镜的距离,由得到的数据可以计算出动平台上三个靶镜中点在测量坐标系中的坐标。重复上述过程多次,选择靶镜A的4个不在同一平面内的坐标。由空间解析几何知,已知4个不共面的点P(x,y,z),i=1,2,3,4,过这4点的球面方程是
X2 1+Y2 1+Z2 1 X1 Y1 Z1 1=0
X2 2+Y2 2+Z2 2 X2 Y2 Z2 1=0
X2 3+Y2 3+Z2 3 X3 Y3 Z3 1=0
X2 4+Y2 4+Z2 4 X4 Y4 Z4 1=0
b.由此方程可以得到球心坐标。所以将上述四点代入球面方程中,就可计算出固定的杆在动平台上的铰链点在测量坐标系中的坐标。由于可以用测得的数据计算出动平台在测量坐标系中的位置,而该铰链点在测量坐标系中的坐标可知,所以在动平台上的位置也就可以计算出来了。依次对每一根杆使用以上的方法,就可以测量出动平台上各铰链点的实际位置。
c.测量静平台上铰链点的位置。现在已知某根杆在动平台上的铰链点的坐标,每一次使该杆杆长不变的测量其实是测出了以该杆在动平台上的铰链为圆心,以固定杆长为半径的一个球上的点的坐标,所以圆心和半径都可以求出。固定某一根杆的杆长,将该杆的角度变化四次,每次都用测得的数据计算出该杆在动平台上铰链点的空间坐标,代入球面方程中可以计算出杆在静平台上的铰链点在测量坐标系中的坐标。
本实施例中,激光跟踪测长仪是将一个单频激光干涉仪安装在有两个互相垂直的旋转自由度的机构中心上的仪器,其旋转中心的位置在测量时保持不变。跟踪仪的反射靶是一个内部安装了角锥反射镜的球,角锥的顶点与球心重合。用激光跟踪仪可以跟踪在空间运动的靶并测量靶的圆心在以跟踪仪旋转中心为原点的极坐标系中的极坐标,即原点到靶的中心的距离和两点连线的两个方向角。因为角度测量的误差比较大,而且测量点距离原点越远,由极坐标计算的直角坐标误差就越大,所以本文的方法中只使用激光跟踪仪的测长结果,然后经测量动平台上铰链点的位置,然后由球面方程可以得到球心坐标,从而测量静平台上铰链点的位置,由此可以保证机器人内部运动学模型来驱动关节电动机获得末端执行器位置时,使得激光目标点的实际位置恰好位于预期位置上,从而实现激光自标定的零点标定。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (1)
1.一种激光自标定实现零点标定的方法,其特征在于:激光跟踪仪为一个单频激光干涉仪安装在有两个互相垂直的旋转自由度的机构中心上的仪器,所述激光跟踪仪的反射靶为一个壳内部安装角锥反射镜的球,角锥反射镜的顶点与球心重合,激光跟踪仪可以跟踪在空间运动的反射靶并测量反射靶的球心在激光跟踪仪旋转中心的极坐标系中的极坐标,即极坐标系原点到反射靶的球心距离和极坐标系原点与反射靶球心两点连线的两个方向角;
激光自标定实现零点标定的方法具体为:
a.测量动平台上铰链点的位置;
固定并联机床的一根杆,使它既不伸缩也不绕任何轴转动,即固定该杆在动平台上的铰链点在空间的位置;
将测量平台放到动平台前,激光跟踪仪安装到其中一个定位孔上;
测量动平台上安放好三个反射靶,并设其中一个为反射靶A;
使动平台运动到某一位置静止不动,用激光跟踪仪在三个定位孔上分别检测到三个反射靶的距离和两个方向角,由得到的数据可以计算出动平台上三个反射靶的球心在测量坐标系中的坐标;
重复上一步骤多次,选择反射靶A的4个不在同一平面内的坐标,由空间解析几何知,已知4个不共面的点P(xi,yi,zi),i=1,2,3,4,过这4点的球面方程是
z2+y2+z2+ax+by+cz+d=0
其中参数a、b、c、d由下求得:
x1 2+y1 2+z1 2+ax1+by1+cz1+d=0
x2 2+y2 2+z2 2+ax2+by2+cz2+d=0
x3 2+y3 2+z3 2+ax3+by3+cz3+d=0
x4 2+y4 2+z4 2+ax4+by4+cz4+d=0
b.由球面方程得到球面的球心坐标;
由球面方程计算球面的球心坐标,然后计算出固定并联机床的杆在动平台上的铰链点在测量坐标系中的坐标;
c.测量静平台上铰链点的位置;
现在已知固定并联机床的杆在动平台上的铰链点的坐标,每一次使该固定并联机床的杆杆长不变的测量其实是测出了以该固定并联机床的杆在静平台上的铰链点为球心,以该固定并联机床的杆的杆长为半径的一个球面上的点的坐标,所以球心和半径都可以求出;
固定另一根杆的杆长,将该另一根杆的角度变化四次,每次都用测得的数据计算出该另一根杆在动平台上铰链点的空间坐标,代入上一步骤中以固定并联机床的杆在静平台上的铰链点为球心,以固定并联机床的杆的杆长为半径的球面方程中可以计算出另一根杆在静平台上的铰链点在测量坐标系中的坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910085768.6A CN109631762B (zh) | 2019-01-29 | 2019-01-29 | 一种激光自标定实现零点标定的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910085768.6A CN109631762B (zh) | 2019-01-29 | 2019-01-29 | 一种激光自标定实现零点标定的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109631762A CN109631762A (zh) | 2019-04-16 |
CN109631762B true CN109631762B (zh) | 2021-01-19 |
Family
ID=66062488
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910085768.6A Active CN109631762B (zh) | 2019-01-29 | 2019-01-29 | 一种激光自标定实现零点标定的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109631762B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110174052A (zh) * | 2019-05-30 | 2019-08-27 | 中国科学院长春光学精密机械与物理研究所 | 一种虎克铰精度测试方法 |
CN112935785B (zh) * | 2021-03-09 | 2022-06-03 | 杭州盈铭深冷真空工程有限公司 | 一种机械加工激光精密定位方法 |
CN114894086B (zh) * | 2022-04-24 | 2023-08-04 | 成都飞机工业(集团)有限责任公司 | 一种基于激光跟踪仪的并联机构标定方法 |
CN116381715A (zh) * | 2022-12-12 | 2023-07-04 | 深圳市中图仪器股份有限公司 | 获取目标的位置和取向的方法 |
CN116222385B (zh) * | 2023-05-08 | 2023-07-14 | 东莞市兆丰精密仪器有限公司 | 激光中心位置标定方法及测量系统 |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008547026A (ja) * | 2005-06-23 | 2008-12-25 | ファロ テクノロジーズ インコーポレーテッド | 有関節座標計測機再配置装置及び方法 |
CN100547614C (zh) * | 2007-12-20 | 2009-10-07 | 昆山华恒工程技术中心有限公司 | 一种工业机器人的标定方法 |
CN101532821B (zh) * | 2009-04-24 | 2010-09-22 | 北京航空航天大学 | 一种激光跟踪视觉导引测量系统的全局校准方法 |
US8630314B2 (en) * | 2010-01-11 | 2014-01-14 | Faro Technologies, Inc. | Method and apparatus for synchronizing measurements taken by multiple metrology devices |
CN102062576B (zh) * | 2010-11-12 | 2012-11-21 | 浙江大学 | 基于激光跟踪测量的附加外轴机器人自动标定方法 |
CN102589430B (zh) * | 2012-02-01 | 2014-07-09 | 哈尔滨工业大学 | 多仪器坐标统一化装置的校准方法 |
CN104858870A (zh) * | 2015-05-15 | 2015-08-26 | 江南大学 | 基于末端编号靶球的工业机器人测量方法 |
CN105058387A (zh) * | 2015-07-17 | 2015-11-18 | 北京航空航天大学 | 基于激光跟踪仪的一种工业机器人基坐标系标定方法 |
CN106052555B (zh) * | 2016-06-08 | 2018-10-30 | 中国科学院重庆绿色智能技术研究院 | 一种工业机器人基座坐标测量方法 |
US20180088202A1 (en) * | 2016-09-23 | 2018-03-29 | Faro Technologies, Inc. | Apparatus and method for relocating an articulating-arm coordinate measuring machine |
CN106705956B (zh) * | 2017-02-28 | 2023-03-21 | 南京工程学院 | 工业机器人末端位姿快速测量装置及其测量方法 |
CN107588929B (zh) * | 2017-08-14 | 2020-06-05 | 天津大学 | 球幕投影/跟踪系统标定方法及标定器 |
CN107738254B (zh) * | 2017-08-25 | 2019-12-24 | 中国科学院光电研究院 | 一种机械臂坐标系的转换标定方法与系统 |
CN108177145A (zh) * | 2017-12-28 | 2018-06-19 | 北京航空航天大学 | 一种无偏最优的工业机械臂绝对定位精度标定方法 |
CN108225258A (zh) * | 2018-01-09 | 2018-06-29 | 天津大学 | 基于惯性单元和激光跟踪仪动态位姿测量装置和方法 |
CN109048876B (zh) * | 2018-07-03 | 2021-10-01 | 上海新时达电气股份有限公司 | 一种基于激光跟踪仪的机器人标定方法 |
-
2019
- 2019-01-29 CN CN201910085768.6A patent/CN109631762B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109631762A (zh) | 2019-04-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109631762B (zh) | 一种激光自标定实现零点标定的方法 | |
US9310482B2 (en) | Methods for locating and sensing the position, orientation, and contour of a work object in a robotic system | |
CN101680743B (zh) | 确定位置 | |
JP5199452B2 (ja) | ロボット精度向上のための外部システム | |
US8457786B2 (en) | Method and an apparatus for calibration of an industrial robot system | |
CN106873122B (zh) | 一种用于大口径非球面反射镜定心装调的装置及方法 | |
JP2000511827A (ja) | 機械の精度を高めるための方法 | |
JPH01156616A (ja) | 座標測定装置のプローブヘッドに用いられる回転・旋回装置 | |
CN109884659B (zh) | 基于激光追踪仪多站位测量系统的大型精密转台标定方法 | |
CN110883774A (zh) | 机器人关节角零位标定系统、方法及存储介质 | |
KR20170056372A (ko) | 이동형 3차원 좌표 측정기(cmm)의 에러 측정 및 보상 방법 | |
Conte et al. | Identification and kinematic calculation of Laser Tracker errors | |
Wan et al. | Accurate kinematics calibration method for a large-scale machine tool | |
Lou et al. | A 3D passive laser tracker for accuracy calibration of robots | |
Conte et al. | Performance evaluation of laser tracker kinematic models and parameter identification | |
Nieves et al. | A reflected laser line approach for industrial robot calibration | |
Conte et al. | Modelling, kinematic parameter identification and sensitivity analysis of a Laser Tracker having the beam source in the rotating head | |
Schmitt et al. | Concept of a virtual metrology frame based on absolute interferometry for multi robotic assembly | |
Nejat et al. | High-precision task-space sensing and guidance for autonomous robot localization | |
Nieves et al. | Laser beam multi-position alignment approach for an automated industrial robot calibration | |
CN113601269A (zh) | 一种多轴数控机床旋转轴几何误差快速分离新方法 | |
CN109968347B (zh) | 一种七轴机器人的零位标定方法 | |
CN115950388A (zh) | 反射式激光跟踪仪两轴与反射镜平移误差测量装置及方法 | |
TWI785914B (zh) | 雙旋轉軸的幾何誤差的獲取方法與獲取設備 | |
TWI694238B (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 |