CN110749257A - 一种拉线式测量***的测量基准点不共面误差补偿方法 - Google Patents
一种拉线式测量***的测量基准点不共面误差补偿方法 Download PDFInfo
- Publication number
- CN110749257A CN110749257A CN201910715658.3A CN201910715658A CN110749257A CN 110749257 A CN110749257 A CN 110749257A CN 201910715658 A CN201910715658 A CN 201910715658A CN 110749257 A CN110749257 A CN 110749257A
- Authority
- CN
- China
- Prior art keywords
- points
- point
- line length
- measurement
- end effector
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/02—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness
- G01B21/04—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness by measuring coordinates of points
- G01B21/045—Correction of measurements
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B5/00—Measuring arrangements characterised by the use of mechanical techniques
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- A Measuring Device Byusing Mechanical Method (AREA)
Abstract
本发明公开了一种拉线式测量***的测量基准点不共面误差补偿方法,步骤如下:选择三个测量基准点建立基准平面与基准坐标系,采集两两测量基准点间线长以及测量基准点到末端执行器被测点的线长,预估末端执行器被测点空间坐标;依据几何关系计算出其余测量基准点在基准坐标系下空间位置的可能解;计算预估末端执行器被测点到其余测量基准点的虚拟线长,比较实测线长与虚拟线长,确定其余测量基准点的空间位置;将其余测量基准点修正至基准平面内得到替代测量基准点,并根据几何关系对原有线长补偿,基于基准平面内所有测量基准点位置与线长信息,优化末端执行器被测点空间置。本方法可省略人工调节所有测量基准点共面步骤,有效提高工作效率。
Description
技术领域
本发明涉及测量误差补偿领域,具体涉及一种拉线式测量***的测量基准点不共面误差补偿方法。
背景技术
随着现代机器人自动化生产的趋势日渐兴起,对机器人的定位精度的要求也越来越高。工业机器人的定位精度的测量机构一般分为机械式和光学式两类。相对于光学式测量机构,基于拉线编码器的机械式测量机构(简称拉线式测量***)结构简单,操作方便,环境要求低,更加适应工业机器人等的现场应用要求。
三边测量原理,最初用在GPS定位***中,用三个GPS卫星到被测点的距离可求得该点的精确位置。拉线式测量***通常基于三边测量原理工作,即利用三个测量基准点和其分别到测量适配器的线长,根据几何关系求得末端执行器上固定某点的空间位置。为了应用三边测量原理,当拉线式测量***的测量基准点大于三个时,通常要求所有测量基准点在同一个基准平面内,测量开始前一般需要人工调节基准点共面,这一步骤增加了测量***的使用难度,降低了效率。
发明内容
针对现有技术存在的缺陷,本发明的目的是提供一种拉线式测量***的测量基准点不共面误差补偿方法。
为了达到上述目的,本发明采用如下技术方案:
一种拉线式测量***的测量基准点不共面误差补偿方法,包括如下步骤:
S1:选择三个测量基准点建立基准平面与基准坐标系,采集两两测量基准点间线长以及测量基准点到末端执行器被测点的线长,预估末端执行器被测点的空间坐标;
S2:依据几何关系计算出其余测量基准点在基准坐标系下空间位置的可能解;
S3:计算预估末端执行器被测点到其余测量基准点的虚拟线长,比较实测线长与虚拟线长,确定其余测量基准点的空间位置;
S4:将其余测量基准点修正至基准平面内得到替代测量基准点,并根据几何关系对原有线长补偿,基于基准平面内所有测量基准点位置与线长信息,优化计算末端执行器被测点的空间位置。
与现有技术相比,本发明具有如下的优点:
本方法可省略人工调节所有测量基准点共面步骤,有效提高工作效率。
附图说明
图1为本发明方法的流程图。
图2为本发明一种拉线式测量***的示意图。
图3为本发明误差补偿模型图。
图4为本发明线长与直线距离几何关系图。
图5为本发明直线与线长距离几何关系图。
图6为本发明误差补偿的原理图。
具体实施方式
下面结合附图,对本发明的具体实施例做进一步的说明。
如图1所示,一种拉线式测量***的测量基准点不共面误差补偿方法,采用有四个测量基准点的拉线式测量***,如图2所示,该***包括工业机器人,测量适配器,拉线编码器,数据采集卡,工控机。其中测量适配器安装在工业机器人的末端,拉线编码器通过测试线缆连接测量适配器上;四条测试线缆的延长线在空间中交于一点;拉线编码器编码器通过导线连接数据采集卡,然后数据采集卡内置于工控机机箱;具体包括如下步骤:
S1:选择三个测量基准点建立基准平面与基准坐标系,采集两两测量基准点间线长以及测量基准点到末端执行器被测点的线长,预估末端执行器被测点的空间坐标。
如图3所示,在测量基准点中选择三个不共线的测量基准点,记为点A、B、C,建立基准平面与基准坐标系,测量记录基准点之间的线长lAB,lAC,lBC,根据几何关系,如图4所示,利用测量基准点间的线长求得测量基准点间的距离LAB,LAC,LBC,具体步骤为:
在ΔBRA中,
在ΔBGA中,
计算出基准点坐标A(xA,yA,0)B(xB,yB,0)C(xC,yC,0);测量记录A、B、C引到测量
适配器的线长lA,lB,lC,记末端执行器被测点的空间坐标为P(x,y,z),则解如下方程组预估末端执行器被测点的空间坐标:
式中,fA,fB,fC为拉线线长与末端执行器被测点的空间坐标满足的函数关系。
S2:依据几何关系计算出其余测量基准点在基准坐标系下空间位置的可能解。
依次记其余基准测量点为D、E、F…,以D点为例,通过分别测量D点到测量基准点A、B、C的线长lDA,lDB,lDC,再根据线长求得距离LDA,LDB,LDC,解如下方程组:
计算出D点在基准坐标系下空间位置的可能解(xD,yD,±zD);重复上述步骤,依次解出其余测量基准点的空间位置可能解。
S3:计算预估末端执行器被测点到其余测量基准点的虚拟线长,比较实测线长与虚拟线长,确定其余测量基准点的空间位置。
根据D点两个可能的位置坐标分别计算其到末端执行器被测点间的虚拟线长,记为 l'Di,i=1,2;
利用下式可求得
求得其虚拟线长重复上述步骤,求解虚拟线长l'D2;比较实测线长与虚拟线长,取使min(lD-l'Di)成立的D点位置坐标,即可以确定测量基准点D的空间位置;重复上述步骤,依次确定其余测量基准点E,F…的空间位置坐标。
S4:将其余测量基准点修正至基准平面内得到替代测量基准点,并根据几何关系对原有线长补偿,基于基准平面内所有测量基准点位置与线长信息,优化计算末端执行器被测点的空间位置。
如图6所示,将测量基准点D沿着与测试线缆平行方向平移至基准平面内得到替代测量基准点D'(xD',yD',0),测试线缆的延长线交基准平面记为N(xN,yN,0)。在空间坐标系中,C、 P、D三个点形成一个平面,因而D',N点在此平面内;
求出N(xN,yN,zN);
根据弧段与弧段所对应的圆心角相同及可以得到G'N的长度;根据上述得到LGG'=LPN-LPG-LG'N及LD'N=LG'N;根据及LD'N可以求出D'点的坐标;因此l'D的长度为直线段LPG'与弧长之和 l'D=LPG'+LG'D'=lD+LGG';记修正点为D',根据几何关系计算线长补偿值lD补,且满足如下关系:
l'D=lD+lD补
重复上述步骤,依次确定其余测量基准点的修正点位置E',F'…,以及补偿后的线长 lE补,lF补…;基于基准平面内所有测量基准点位置与线长信息,建立超定方程组:
优化求解末端执行器被测点P的空间坐标。
Claims (5)
1.一种拉线式测量***的测量基准点不共面误差补偿方法,其特征在于,包括如下步骤:
S1:选择三个测量基准点建立基准平面与基准坐标系,采集两两测量基准点间线长以及测量基准点到末端执行器被测点的线长,预估末端执行器被测点的空间坐标;
S2:依据几何关系计算出其余测量基准点在基准坐标系下空间位置的可能解;
S3:计算预估末端执行器被测点到其余测量基准点的虚拟线长,比较实测线长与虚拟线长,确定其余测量基准点的空间位置;
S4:将其余测量基准点修正至基准平面内得到替代测量基准点,并根据几何关系对原有线长补偿,基于基准平面内所有测量基准点位置与线长信息,优化计算末端执行器被测点的空间位置。
2.根据权利要求1所述的拉线式测量***的测量基准点不共面误差补偿方法,其特征在于,所述步骤S1的具体步骤为:在测量基准点中选择三个不共线的测量基准点,记为点A、B、C,建立基准平面与基准坐标系,测量记录基准点之间的线长lAB,lAC,lBC,根据几何关系,利用测量基准点间的线长求得测量基准点间的距离LAB,LAC,LBC,计算出基准点坐标A(xA,yA,0)、B(xB,yB,0)、C(xC,yC,0);测量记录A、B、C引到测量适配器的线长lA,lB,lC,记末端执行器被测点的空间坐标为P(x,y,z),则解如下方程组预估末端执行器被测点的空间坐标:
式中,fA,fB,fC为拉线线长与末端执行器被测点的空间坐标满足的函数关系。
4.根据权利要求1所述的拉线式测量***的测量基准点不共面误差补偿方法,其特征在于,所述步骤S3的具体步骤为:根据D点两个可能的位置坐标分别计算其到末端执行器被测点间的虚拟线长,记为l'Di,i=1,2;比较实测线长与虚拟线长,取使min(|lD-l'Di|)成立的D点空间位置坐标;重复上述步骤,依次确定其余测量基准点的空间位置坐标。
5.根据权利要求1所述的拉线式测量***的测量基准点不共面误差补偿方法,其特征在于,所述步骤S4的具体步骤为:将其余测量基准点修正至基准平面内得到替代测量基准点,并根据几何关系对原有线长补偿,以D点为例,记修正点为D',根据几何关系计算线长补偿值lD补,且满足如下关系:
l'D=lD+lD补
重复上述步骤,依次确定其余测量基准点的修正点位置E',F'…,以及补偿后的线长lE补,lF补…;基于基准平面内所有测量基准点位置与线长信息,建立超定方程组:
优化求解末端执行器被测点P的空间坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910715658.3A CN110749257B (zh) | 2019-08-05 | 2019-08-05 | 一种拉线式测量***的测量基准点不共面误差补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910715658.3A CN110749257B (zh) | 2019-08-05 | 2019-08-05 | 一种拉线式测量***的测量基准点不共面误差补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110749257A true CN110749257A (zh) | 2020-02-04 |
CN110749257B CN110749257B (zh) | 2021-08-10 |
Family
ID=69275876
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910715658.3A Active CN110749257B (zh) | 2019-08-05 | 2019-08-05 | 一种拉线式测量***的测量基准点不共面误差补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110749257B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111965678A (zh) * | 2020-08-28 | 2020-11-20 | 北京大成国测科技有限公司 | 一种基于北斗或gps的铁路路基沉降监测***及方法 |
CN113187955A (zh) * | 2021-05-29 | 2021-07-30 | 廖浩宏 | 一种共板法兰风管高精度定位安装装置 |
CN113465642A (zh) * | 2021-07-02 | 2021-10-01 | 济南轲盛自动化科技有限公司 | 基于姿态模拟的拉线位移编码器数据修正方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6408252B1 (en) * | 1997-08-01 | 2002-06-18 | Dynalog, Inc. | Calibration system and displacement measurement device |
CN104890013A (zh) * | 2015-06-02 | 2015-09-09 | 南京航空航天大学 | 一种基于拉线编码器的工业机器人标定算法 |
CN106092009A (zh) * | 2016-06-29 | 2016-11-09 | 南京航空航天大学 | 一种基于拉线编码器的站点可动式测量机构的初始位置校准方法 |
CN107553493A (zh) * | 2017-09-22 | 2018-01-09 | 东南大学 | 一种基于拉绳位移传感器的机器人运动学参数标定方法 |
CN208043029U (zh) * | 2018-02-14 | 2018-11-02 | 山东建筑大学 | 一种数控装置末端位置实时测量*** |
-
2019
- 2019-08-05 CN CN201910715658.3A patent/CN110749257B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6408252B1 (en) * | 1997-08-01 | 2002-06-18 | Dynalog, Inc. | Calibration system and displacement measurement device |
CN104890013A (zh) * | 2015-06-02 | 2015-09-09 | 南京航空航天大学 | 一种基于拉线编码器的工业机器人标定算法 |
CN106092009A (zh) * | 2016-06-29 | 2016-11-09 | 南京航空航天大学 | 一种基于拉线编码器的站点可动式测量机构的初始位置校准方法 |
CN107553493A (zh) * | 2017-09-22 | 2018-01-09 | 东南大学 | 一种基于拉绳位移传感器的机器人运动学参数标定方法 |
CN208043029U (zh) * | 2018-02-14 | 2018-11-02 | 山东建筑大学 | 一种数控装置末端位置实时测量*** |
Non-Patent Citations (1)
Title |
---|
洪银芳 等: "拉线式机器人末端定位精度测量***", 《工业控制计算机》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111965678A (zh) * | 2020-08-28 | 2020-11-20 | 北京大成国测科技有限公司 | 一种基于北斗或gps的铁路路基沉降监测***及方法 |
CN111965678B (zh) * | 2020-08-28 | 2022-01-28 | 北京大成国测科技有限公司 | 一种基于北斗或gps的铁路路基沉降监测***及方法 |
CN113187955A (zh) * | 2021-05-29 | 2021-07-30 | 廖浩宏 | 一种共板法兰风管高精度定位安装装置 |
CN113187955B (zh) * | 2021-05-29 | 2021-12-03 | 广东骏太建筑安装有限公司 | 一种共板法兰风管高精度定位安装装置 |
CN113465642A (zh) * | 2021-07-02 | 2021-10-01 | 济南轲盛自动化科技有限公司 | 基于姿态模拟的拉线位移编码器数据修正方法及*** |
CN113465642B (zh) * | 2021-07-02 | 2022-05-17 | 济南轲盛自动化科技有限公司 | 基于姿态模拟的拉线位移编码器数据修正方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN110749257B (zh) | 2021-08-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110749257B (zh) | 一种拉线式测量***的测量基准点不共面误差补偿方法 | |
CN111531547B (zh) | 一种基于视觉测量的机器人标定及检测方法 | |
CN110108208B (zh) | 五轴非接触式测量机的误差补偿方法 | |
CN105066884A (zh) | 一种机器人末端定位偏差校正方法及*** | |
CN109115191B (zh) | 全站仪多方位坐标测量方法 | |
CN109870111B (zh) | 基于机器视觉的渐开线圆柱齿轮齿距累积误差测量方法 | |
CN113211445B (zh) | 一种机器人参数标定方法、装置、设备及存储介质 | |
CN110614635B (zh) | 一种scara机器人运动学参数的辨识方法 | |
CN110966934B (zh) | 一种调姿器球窝中心点的标定方法 | |
CN110220454A (zh) | 一种三坐标定位机构的位姿标定方法 | |
CN115979118B (zh) | 圆柱形零件垂直度误差和误差方位角的测量装置及方法 | |
CN102126162A (zh) | 一种数控机床加工在线测量方法 | |
CN110962127B (zh) | 一种用于机械臂末端位姿辅助标定装置及其标定方法 | |
CN113607053B (zh) | 基于筒体内表面特征点的位姿调整装置、方法及*** | |
CN115311371A (zh) | 一种双机器人自动测量划线***标定方法 | |
CN114406991A (zh) | 基于拉线式编码器的工业机器人标定与空间位置测量方法 | |
CN115179323A (zh) | 基于远心视觉约束的机器末位姿测量装置及精度提升方法 | |
CN111409109B (zh) | 工业机器人稳定性的测量和评估方法 | |
CN110458894B (zh) | 一种测量机的相机与接触式测头的标定方法 | |
CN111975756A (zh) | 一种3d视觉测量***的手眼标定***及方法 | |
CN114136357B (zh) | 一种适用于面结构光传感器的测试方法及测试*** | |
CN115162409A (zh) | 一种沉管隧道最终接头对接测量方法 | |
CN114952942A (zh) | 一种基于六拉线编码器的机器人位姿测量装置及方法 | |
CN108592838B (zh) | 工具坐标系的标定方法、装置以及计算机存储介质 | |
CN111551142A (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 |