[go: up one dir, main page]

CN108413988A - 机器人末端经纬仪坐标系快速标定方法 - Google Patents

机器人末端经纬仪坐标系快速标定方法 Download PDF

Info

Publication number
CN108413988A
CN108413988A CN201810203891.9A CN201810203891A CN108413988A CN 108413988 A CN108413988 A CN 108413988A CN 201810203891 A CN201810203891 A CN 201810203891A CN 108413988 A CN108413988 A CN 108413988A
Authority
CN
China
Prior art keywords
theodolite
coordinate system
target point
public target
public
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
Application number
CN201810203891.9A
Other languages
English (en)
Other versions
CN108413988B (zh
Inventor
隆昌宇
易旺民
张彬
胡瑞钦
阮国伟
王伟
陶力
孟少华
陈畅宇
任春珍
郭洁瑛
刘笑
段晨旭
金帮华
张禹杭
季宇
胡德垚
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Spacecraft Environment Engineering
Original Assignee
Beijing Institute of Spacecraft Environment Engineering
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Spacecraft Environment Engineering filed Critical Beijing Institute of Spacecraft Environment Engineering
Priority to CN201810203891.9A priority Critical patent/CN108413988B/zh
Publication of CN108413988A publication Critical patent/CN108413988A/zh
Application granted granted Critical
Publication of CN108413988B publication Critical patent/CN108413988B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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)
  • Length Measuring Devices By Optical Means (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本发明公开了一种航天器设备位姿自动测量系统机器人末端经纬仪快速标定方法，该方法通过现场布置4个以上公共靶标点，利用跟踪仪和一台经纬仪分别对公共靶标点Pi进行测量，获得公共靶标点在激光跟踪仪坐标系下的三维坐标以及在经纬仪坐标系下的方位角；再根据公共靶标点三维坐标、距离以及公共靶标点方位角，最终确定经纬仪坐标系与激光跟踪仪坐标系之间的相对方位关系。本发明摆脱传统利用两台经纬仪同时对多点进行测量的机器人末端经纬仪标定方法，大大提高机器人末端经纬仪现场标定过程的效率及便捷性，同时充分发挥经纬仪测角及跟踪仪测点位精度高的优势，有效提高机器人末端经纬仪标定精度，姿态标定精度优于5″，位置标定精度优于0.05mm。

Description

机器人末端经纬仪坐标系快速标定方法
技术领域
本发明属于航天器总装测试领域，具体涉及一种航天器设备位姿自动测量系统机器人末端经纬仪坐标系的快速标定方法，不仅可使自动测量系统的现场标定过程便捷、快速、易实施，而且可有效提高机器人经纬仪的标定精度。
背景技术
为了提高航天器总装过程中设备安装精度测量过程的自动化水平、灵活程度及柔性化水平，本发明人研究一种基于机器人与经纬仪相结合的航天器设备位姿信息自动准直及测量方法(受理号：201710085892.3)，以提高现场测量效率并减小人员占用率，有效满足航天器研制需求。在系统研制及使用过程中，为了实现系统中不同设备的有机统一，需要对不同设备之间的相对位姿关系进行精确标定，其中最重要的环节是机器人末端经纬仪坐标系与机器人工具坐标系及机器人末端激光跟踪靶标相对位姿关系的标定。
机器人末端经纬仪标定过程的核心环节是如何确定机器人末端经纬仪坐标系与激光跟踪仪坐标系之间的相对位姿关系。传统标定方法是将机器人末端经纬仪与另一台经纬仪组成经纬仪交会测量系统后，结合公共点的方法建立经纬仪测量系统与激光跟踪仪坐标系之间相对位姿关系，然后利用机器人末端经纬仪坐标系与经纬仪测量系统坐标系相对位姿关系间接确定机器人末端经纬仪坐标系与激光跟踪仪坐标系之间的相对位姿关系。
由于两台经纬仪组成的测量系统测点精度较低，直接影响上述标定结果精度及系统最终测量精度。另外，现场标定过程中需要架设两台经纬仪同时对公共点进行测量，使得标定过程复杂、效率低且不宜实施。
发明内容
为了解决上述问题，本发明提出一种机器人末端经纬仪快速标定方法，该方法充分利用经纬仪测角精度高与激光跟踪仪测点精度高的优势，仅利用机器人末端的一台经纬仪与激光跟踪仪配合即可实现其坐标系的快速标定，在提高标定精度同时大大提高现场标定过程的便捷性。
本发明是通过如下技术方案实现的：
为了便于现场标定实施，本发明的机器人末端经纬仪快速标定方法，快速建立机器人末端经纬仪坐标系与激光跟踪仪坐标系之间的相对位姿关系，然后利用事先标定完成的激光跟踪仪与机器人及末端激光跟踪靶标之间的关系，间接完成机器人末端经纬仪的快速标定。
机器人末端经纬仪快速标定方法，包括以下步骤：
1)在现场布置4个以上公共靶标点Pi，利用跟踪仪和一台经纬仪分别对公共靶标点Pi进行测量，获得公共靶标点Pi在激光跟踪仪坐标系OL-XLYLZL下的三维坐标(XL pi,YL pi,ZL pi),在经纬仪坐标系OT-XTYTZT下的方位角(αT pi,βT pi)；根据跟踪仪测出的公共靶标点三维坐标，计算任意两个公共靶标点之间的距离Dij，利用经纬仪获取的公共靶标点方位角，确定公共靶标点在经纬仪坐标系下的单位向量
2)设和ri分别表示经纬仪原点OL到公共靶标点Pi的向量和距离，根据上述数据建立如下几何关系：
通过联合解算上述方程得到：
其中cosθij通过确定公共靶标点Pi、Pj在经纬仪坐标系下的单位向量 确定:
cosθij＝cosαT picosαT pjsinβT pisinβT pj+sinαT pisinαT pjsinβT pisinβT pj
+cosβT picosβT pj
＝sinβT pisinβT pjcos(αT pi+αT pj)+cosβT picosβT pj (7)
3)设空间中共分布n个公共靶标点，结合上述公式(6)任意两点之间建立一个方程，联合所有两点建立的方程得规模为n(n-1)/2的方程组：
当n>3时满足上述方程组求解条件，通过迭代优化得到未知比例系数ri，进而能够确定公共靶标点Pi在经纬仪坐标系OT-XTYTZT下的三维坐标(XT pi,YT pi,ZT pi)；
4)确定公共靶标点Pi分别在经纬仪坐标系OT-XTYTZT和激光跟踪仪坐标系OL-XLYLZL的三维坐标后，利用公共点转站算法可以确定经纬仪坐标系与激光跟踪仪坐标系之间的相对方位关系(RL T,TL T)。
本发明提出的单经纬仪坐标系与激光跟踪仪坐标系之间的相对位姿关系快速高精度标定方法，摆脱传统利用两台经纬仪同时对多点进行测量的机器人末端经纬仪标定方法，大大提高航天器设备位姿自动测量系统机器人末端经纬仪现场标定过程的效率及便捷性，同时充分发挥经纬仪测角及跟踪仪测点位精度高的优势，有效提高标定精度，姿态标定精度优于5″，位置标定精度由于0.05mm。
附图说明
图1为本发明的单经纬仪坐标系与激光跟踪仪坐标系之间的相对位姿关系标定方法示意图。经纬仪对公共靶标点Pi测量可以获取其在经纬仪坐标系Ot-XtYtZt下的方位角(αt pi,βt pi)，激光跟踪仪对公共靶标点Pi测量可以获取其在激光跟踪仪坐标系OL-XLYLZL下的三维坐标(XL pi,YL pi,ZL pi)，实现经纬仪坐标系与激光跟踪仪坐标系相对方位关系标定，至少需要4个公共靶标点。
图2为本发明的机器人末端经纬仪快速标定方法应用于航天器设备位姿自动测量系统中的示意图。航天器设备位姿自动测量系统由机器人、激光跟踪仪、经纬仪、机器人末端工装、激光跟踪靶构成，其中对各系统坐标系标定关系进行了图示，虚线表示的转换关系通过现有标定技术或设备信息直接确定，实线表示的转换关系是本发明最终要实现的机器人末端经纬仪标定转换关系。
具体实施方式
以下结合附图对本发明作进一步详细说明，但这仅仅是示例性的，并不旨在对本发明的保护范围进行任何限制。
参见图2，图2显示了本发明的机器人末端经纬仪快速标定方法应用于航天器设备位姿自动测量系统中的示意图。
由图可见，对航天器设备位姿自动测量系统机器人末端经纬仪快速高精度标定的具体实施方式进行描述：
(1)利用一台激光跟踪仪标定机器人基坐标系Ob-XbYbZb与激光跟踪仪坐标系OL-XLYLZL间的相对位姿关系(Rb L，Tb L)，具体实现方法可参见论文《机器人坐标系与激光跟踪仪坐标系的快速转换方法》；
(2)将一台经纬仪固定在机器人末端工装上，并将经纬仪调水平，机器人保存静止；
(3)在空间布置4个以上公共靶标点，分别利用经纬仪和激光跟踪仪对其测量，获得公共靶标点Pi在激光跟踪仪坐标系OL-XLYLZL下的三维坐标(XL pi,YL pi,ZL pi),在经纬仪坐标系Ot-XtYtZt下的方位角(αt pi,βt pi)；
(4)利用上述测量数据，结合本发明提出的单经纬仪坐标系与激光跟踪仪坐标系之间的相对位姿关系标定方法，建立经纬仪坐标系Ot-XtYtZt与激光跟踪仪坐标系OL-XLYLZL之间相对位姿关系(Rt L，Tt L)；
(5)激光跟踪仪对机器人末端激光跟踪靶进行测量，建立激光跟踪靶坐标系Oc-XcYcZc与激光跟踪仪坐标系OL-XLYLZL的相对关系(Rc L，Tc L)；
(6)利用已知的机器人末端坐标系与基坐标系间相对方位关系(Rh b，Th b)，结合(4)、(5)步标定结果，可实现对机械臂末端经纬仪的标定，包括经纬仪自身坐标系Ot-XtYtZt与机器人末端坐标系Oh-XhYhZh相对方位关系(Rh t，Th t)、经纬仪自身坐标系Ot-XtYtZt与激光跟踪靶坐标系相对方位关系(Rc t，Tc t)的确定。
尽管上文对本发明专利的具体实施方式给予了详细描述和说明，但是应该指明的是，我们可以依据本发明专利的构想对上述实施方式进行各种等效改变和修改，其所产生的功能作用仍未超出说明书及附图所涵盖的精神时，均应在本发明专利的保护范围之内。

Claims (1)

1.机器人末端经纬仪快速标定方法，包括以下步骤：
1)在现场布置4个以上公共靶标点Pi，利用跟踪仪和一台经纬仪分别对公共靶标点Pi进行测量，获得公共靶标点Pi在激光跟踪仪坐标系OL-XLYLZL下的三维坐标(XL pi,YL pi,ZL pi),在经纬仪坐标系OT-XTYTZT下的方位角(αT pi,βT pi)；根据跟踪仪测出的公共靶标点三维坐标，计算任意两个公共靶标点之间的距离Dij，利用经纬仪获取的公共靶标点方位角，确定公共靶标点在经纬仪坐标系下的单位向量
2)设和ri分别表示经纬仪原点OL到公共靶标点Pi的向量和距离，根据上述数据建立如下几何关系：
通过联合解算上述方程得到：
其中cosθij通过确定公共靶标点Pi、Pj在经纬仪坐标系下的单位向量 确定:
cosθij＝cosαT picosαT pjsinβT pisinβT pj+sinαT pisinαT pjsinβT pisinβT pj
+cosβT picosβT pj
＝sinβT pisinβT pjcos(αT pi+αT pj)+cosβT picosβT pj (3)
3)设空间中共分布n个公共靶标点，结合上述公式(2)任意两点之间建立一个方程，联合所有两点建立的方程得规模为n(n-1)/2的方程组：
当n>3时满足上述方程组求解条件，通过迭代优化得到未知比例系数ri，进而能够确定公共靶标点Pi在经纬仪坐标系OT-XTYTZT下的三维坐标(XT pi,YT pi,ZT pi)；
4)确定公共靶标点Pi分别在经纬仪坐标系OT-XTYTZT和激光跟踪仪坐标系OL-XLYLZL的三维坐标后，利用公共点转站算法可以确定经纬仪坐标系与激光跟踪仪坐标系之间的相对方位关系(RLT,TLT)。
CN201810203891.9A 2018-03-13 2018-03-13 机器人末端经纬仪坐标系快速标定方法 Active CN108413988B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810203891.9A CN108413988B (zh) 2018-03-13 2018-03-13 机器人末端经纬仪坐标系快速标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810203891.9A CN108413988B (zh) 2018-03-13 2018-03-13 机器人末端经纬仪坐标系快速标定方法

Publications (2)

Publication Number Publication Date
CN108413988A true CN108413988A (zh) 2018-08-17
CN108413988B CN108413988B (zh) 2020-09-15

Family

ID=63131070

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810203891.9A Active CN108413988B (zh) 2018-03-13 2018-03-13 机器人末端经纬仪坐标系快速标定方法

Country Status (1)

Country Link
CN (1) CN108413988B (zh)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109115123A (zh) * 2018-08-22 2019-01-01 西安空间无线电技术研究所 一种镀膜表面型面精度测试方法
CN110053048A (zh) * 2019-04-22 2019-07-26 青岛科技大学 远程控制方法
CN111307155A (zh) * 2020-03-04 2020-06-19 南京工程学院 双协作机器人初始定位测量装置及初始定位方法
CN111678433A (zh) * 2020-05-22 2020-09-18 哈尔滨工业大学 一种基于双经纬仪的空间大尺寸坐标快速测量方法
CN111811396A (zh) * 2020-06-11 2020-10-23 天津大学 一种基于平面约束的多边法激光跟踪三维坐标测量方法
CN111958640A (zh) * 2020-08-24 2020-11-20 哈工大机器人集团股份有限公司 多基站激光跟踪仪协同转站的双臂机器人测试方法及装置
CN112362037A (zh) * 2020-11-10 2021-02-12 南京航空航天大学 一种基于组合测量的激光跟踪仪站位规划方法
CN112665523A (zh) * 2020-11-24 2021-04-16 北京星航机电装备有限公司 一种复杂型面的联合测量方法
CN113917477A (zh) * 2021-10-08 2022-01-11 安徽创谱仪器科技有限公司 光路的搭建方法
CN114963988A (zh) * 2022-06-10 2022-08-30 南京工程学院 一种用于高精度大范围测量的光笔测量系统及测量方法
CN115598653A (zh) * 2022-08-30 2023-01-13 北京空间飞行器总体设计部（Cn） 一种空间机械臂精度评估装置及评估方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1999057512A1 (en) * 1998-05-04 1999-11-11 Perceptron, Inc. Method and apparatus for calibrating a non-contact gauging sensor with respect to an external coordinate system
CN1605829A (zh) * 2004-11-11 2005-04-13 天津大学 视觉测量系统现场校准装置及校准方法
CN101750012A (zh) * 2008-12-19 2010-06-23 中国科学院沈阳自动化研究所 一种测量物体六维位姿的装置
CN102435140A (zh) * 2011-09-26 2012-05-02 上海大学 一种激光跟踪仪构建地理坐标系的方法
CN104613929A (zh) * 2015-01-07 2015-05-13 北京卫星环境工程研究所 基于机器视觉自动准直立方镜的方法
CN105627916A (zh) * 2014-11-02 2016-06-01 北京航天计量测试技术研究所 一种建立跟踪仪地理坐标系及六自由度测量的方法
CN105716525A (zh) * 2016-03-30 2016-06-29 西北工业大学 基于激光跟踪仪的机器人末端执行器坐标系标定方法
CN107543495A (zh) * 2017-02-17 2018-01-05 北京卫星环境工程研究所 航天器设备自动准直测量系统、准直方法与测量方法
CN107782293A (zh) * 2017-11-09 2018-03-09 北京卫星环境工程研究所 基于六自由度激光跟踪靶的航天器设备位姿信息测量方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1999057512A1 (en) * 1998-05-04 1999-11-11 Perceptron, Inc. Method and apparatus for calibrating a non-contact gauging sensor with respect to an external coordinate system
CN1605829A (zh) * 2004-11-11 2005-04-13 天津大学 视觉测量系统现场校准装置及校准方法
CN101750012A (zh) * 2008-12-19 2010-06-23 中国科学院沈阳自动化研究所 一种测量物体六维位姿的装置
CN102435140A (zh) * 2011-09-26 2012-05-02 上海大学 一种激光跟踪仪构建地理坐标系的方法
CN105627916A (zh) * 2014-11-02 2016-06-01 北京航天计量测试技术研究所 一种建立跟踪仪地理坐标系及六自由度测量的方法
CN104613929A (zh) * 2015-01-07 2015-05-13 北京卫星环境工程研究所 基于机器视觉自动准直立方镜的方法
CN105716525A (zh) * 2016-03-30 2016-06-29 西北工业大学 基于激光跟踪仪的机器人末端执行器坐标系标定方法
CN107543495A (zh) * 2017-02-17 2018-01-05 北京卫星环境工程研究所 航天器设备自动准直测量系统、准直方法与测量方法
CN107782293A (zh) * 2017-11-09 2018-03-09 北京卫星环境工程研究所 基于六自由度激光跟踪靶的航天器设备位姿信息测量方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
陈义等: "适用于大旋转角的三维基准转换的一种简便模型", 《武汉大学学报 》 *
陈海平等: "基于经纬仪和测距仪的空间坐标测量", 《激光技术》 *

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109115123A (zh) * 2018-08-22 2019-01-01 西安空间无线电技术研究所 一种镀膜表面型面精度测试方法
CN110053048A (zh) * 2019-04-22 2019-07-26 青岛科技大学 远程控制方法
CN111307155A (zh) * 2020-03-04 2020-06-19 南京工程学院 双协作机器人初始定位测量装置及初始定位方法
CN111678433A (zh) * 2020-05-22 2020-09-18 哈尔滨工业大学 一种基于双经纬仪的空间大尺寸坐标快速测量方法
CN111811396B (zh) * 2020-06-11 2021-05-25 天津大学 一种基于平面约束的多边法激光跟踪三维坐标测量方法
CN111811396A (zh) * 2020-06-11 2020-10-23 天津大学 一种基于平面约束的多边法激光跟踪三维坐标测量方法
CN111958640A (zh) * 2020-08-24 2020-11-20 哈工大机器人集团股份有限公司 多基站激光跟踪仪协同转站的双臂机器人测试方法及装置
CN112362037A (zh) * 2020-11-10 2021-02-12 南京航空航天大学 一种基于组合测量的激光跟踪仪站位规划方法
CN112665523A (zh) * 2020-11-24 2021-04-16 北京星航机电装备有限公司 一种复杂型面的联合测量方法
CN112665523B (zh) * 2020-11-24 2022-04-19 北京星航机电装备有限公司 一种复杂型面的联合测量方法
CN113917477A (zh) * 2021-10-08 2022-01-11 安徽创谱仪器科技有限公司 光路的搭建方法
CN114963988A (zh) * 2022-06-10 2022-08-30 南京工程学院 一种用于高精度大范围测量的光笔测量系统及测量方法
CN115598653A (zh) * 2022-08-30 2023-01-13 北京空间飞行器总体设计部（Cn） 一种空间机械臂精度评估装置及评估方法

Also Published As

Publication number Publication date
CN108413988B (zh) 2020-09-15

Similar Documents

Publication Publication Date Title
CN108413988B (zh) 机器人末端经纬仪坐标系快速标定方法
CN107042528B (zh) 一种工业机器人的运动学标定系统及方法
CN111238454B (zh) 一种空间三维坐标测量仪系统及其三维控制网测量方法
CN110793508B (zh) 三维控制网中控制点的观测数据处理方法与装置
CN105823417B (zh) 一种基于摄影测量提高激光跟踪仪转站精度的方法
CN106443578B (zh) 一种室内定位基站坐标标定方法
CN104880205B (zh) 非正交轴系激光经纬仪测量系统标定方法
WO2021098808A1 (zh) 激光跟踪仪站位确定方法、系统、电子设备及介质
CN102589430A (zh) 多仪器坐标统一化装置的校准方法
CN109917333A (zh) 融合aoa观测量与tdoa观测量的无源定位方法
CN114754672B (zh) 一种机器人与测量仪器的坐标转换关系确定方法
CN105136128B (zh) 基于两点定位的机体结构测量方法
CN113158387B (zh) 一种基于激光雷达栅格地图耦合的视觉靶点布置方法
CN105627916B (zh) 一种建立跟踪仪地理坐标系及六自由度测量的方法
CN108458710B (zh) 位姿测量方法
CN107621254A (zh) 一种身管轴线指向测试方法
CN107588929B (zh) 球幕投影/跟踪系统标定方法及标定器
CN104535042A (zh) 基于非正交轴系激光经纬仪的测量方法
CN108225371B (zh) 一种惯导/相机安装误差标定方法
CN107806853A (zh) 一种远距离双天线指向校准方法和系统
CN109884582B (zh) 利用一维测向快速确定目标三维坐标的方法
CN105241434B (zh) 基于wMPS系统的移动发射站快速定向方法
CN106323271A (zh) 基于特征奇异值的航天器相对姿态测量矢量选取方法
CN109489642B (zh) 一种空间任意姿态下两立方镜相对姿态的动态测量方法
CN104330077B (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