CN108680926B - 平面内双平台相对位姿测量系统 - Google Patents
平面内双平台相对位姿测量系统 Download PDFInfo
- Publication number
- CN108680926B CN108680926B CN201810320893.6A CN201810320893A CN108680926B CN 108680926 B CN108680926 B CN 108680926B CN 201810320893 A CN201810320893 A CN 201810320893A CN 108680926 B CN108680926 B CN 108680926B
- Authority
- CN
- China
- Prior art keywords
- laser range
- platform
- range finder
- plane
- relative pose
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/42—Simultaneous measurement of distance and other co-ordinates
Landscapes
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明涉及一种平面内双平台相对位姿测量系统及方法,涉及激光测距技术领域。本发明的结构包括多个激光测距仪、特制的反射面,在测量时,3台激光测距仪同时工作,按照所测量的旋转角ω、横向距离、纵向距离的顺序依次调整第二平台的位置与姿态,能够实现在非接触的情况下第一平台与第二平台相对位姿的固定不变。本发明实现了平面内两个平台间相对位姿的高精度非接触式测量;具有环境适应能力好、抗干扰能力强、鲁棒性好、测量精度高等优势;原理、结构简单,改造成本低,适用于不同类型移动、非移动平台的相对位姿测量,且便于日常维护。
Description
技术领域
本发明涉及激光测距技术领域,具体涉及一种平面内双平台相对位姿测量方法。
背景技术
目前的相对位姿检测通常基于双目视觉、单目视觉、激光雷达成像等技术实现,有针对合作目标也有针对非合作目标的,普遍被应用于空间飞行器之间的相对位置检测。造价相对较高,原理较为复杂,对使用环境有一定要求。
发明内容
(一)要解决的技术问题
本发明要解决的技术问题是:如何提出一种平面内双平台相对位姿测量方法,用于同一平面内非接触式测量两平台之间相对位姿,解决两平台系统非接触式联动或是相对移动时的问题。
(二)技术方案
为了解决上述技术问题,本发明提供了一种平面内双平台相对位姿测量系统,包括:第一激光测距仪1、第二激光测距仪2、第三激光测距仪3和反射面4,测量对象为第一平台A和第二平台B;
其中,第一激光测距仪1、第二激光测距仪2、第三激光测距仪3位于第一平台A上,等间距放置,第三激光测距仪3位于第一激光测距仪1、第二激光测距仪2之间;反射面4位于第二平台B上;
测量时,第一激光测距仪1、第二激光测距仪2、第三激光测距仪3三者同时工作,且第一激光测距仪1、第二激光测距仪2、第三激光测距仪3的测量射线处于同一平面内,此平面即为第一平台A与第二平台B需要测量相对位姿的平面;
所述反射面4的颜色为白色,且具有一横截面为直角三角形的凹槽,测量时,第一激光测距仪1与第二激光测距仪2分别照射在反射面4的凹槽的两侧,第三激光测距仪3照射在凹槽内部。
优选地,所述第一平台A为长方体。
优选地,所述第二平台B为长方体。
优选地,所述第一平台A与第二平台B为尺寸相同的长方体。
优选地,所述第三激光测距仪3照射在凹槽的斜面。
优选地,所述第一平台A与第二平台B二者的相对距离不超过第一激光测距仪1、第二激光测距仪2、第三激光测距仪3所处位置的量程。
本发明还提供了一种利用所述的系统实现的平面内双平台相对位姿测量方法,包括以下步骤:
测量时,首先,根据第一激光测距仪1与第二激光测距仪2的测量数据比例得到第二平台B相对于第一平台A的旋转角ω,计算公式如下:
其中,a为相邻两激光测距仪的间距;
其次,再根据第三激光测距仪3的测量数据大小与旋转角ω的相对关系得出,第二平台B相对于第一平台A的纵向与横向上的相对位置关系x与y。
优选地,所述第二平台B相对于第一平台A的纵向与横向上的相对位置关系x与y具体为:
凹槽的直角三角形截面的斜边的中点5相对于第一平台A的横向偏移距离x由如下公式得出:
其中:
其中,L4为凹槽的直角三角形截面的短直角边,即平行于第二平台B宽度方向的直角边的长度,而凹槽的直角三角形截面的斜边的中点5相对于第一平台A的纵向偏移距离y,由如下公式得出:
y=x tan(α+ω)。
(三)有益效果
本发明的结构包括多个激光测距仪、特制的反射面,在测量时,3台激光测距仪同时工作,按照所测量的旋转角ω、横向距离、纵向距离的顺序依次调整第二平台B的位置与姿态,能够实现在非接触的情况下第一平台A与第二平台B相对位姿的固定不变。本发明实现了平面内两个平台间相对位姿的高精度非接触式测量;具有环境适应能力好、抗干扰能力强、鲁棒性好、测量精度高等优势;原理、结构简单,改造成本低,适用于不同类型移动、非移动平台的相对位姿测量,且便于日常维护。
附图说明
图1是本发明的相对位姿测量原理图;
图2是本发明的特制反射面示意图。
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。
本发明基于平面内双平台相对位姿测量系统实现,如图1所示,该系统由四部分组成,分别为:第一激光测距仪1、第二激光测距仪2、第三激光测距仪3、反射面4(可以是一个特制反射体的一个面,该面正对三个激光测距仪)。其中第一平台A、第二平台B为测量对象。
其中,第一激光测距仪1、第二激光测距仪2、第三激光测距仪3位于第一平台A上,等间距放置,第三激光测距仪3位于第一激光测距仪1、第二激光测距仪2之间;反射面4位于第二平台B上。
在使用时,需要确保第一激光测距仪1、第二激光测距仪2、第三激光测距仪3的测量射线处于同一平面内,此平面即为第一平台A与第二平台B需要测量相对位姿的平面。
第一平台A与第二平台B为大小相同的矩形,二者的相对距离不超过第一激光测距仪1、第二激光测距仪2、第三激光测距仪3所处位置的量程;反射面4的颜色为白色,且具有一横截面为直角三角形的凹槽。
在第一平台A与第二平台B需要测量相对位姿时,如图1所示。第一激光测距仪1、第二激光测距仪2、第三激光测距仪3同时工作,确保第一激光测距仪1与第二激光测距仪2分别照射在反射面4的凹槽的两侧,第三激光测距仪3照射在凹槽内部(斜面)。
测量时,首先,根据第一激光测距仪1与第二激光测距仪2的测量数据比例得到第二平台B相对于第一平台A的旋转角ω。计算公式如下:
其中,a为相邻两激光测距仪的间距。
其次,再根据第三激光测距仪3的测量数据大小与旋转角ω的相对关系得出,第二平台B相对于第一平台A的纵向与横向上的相对位置关系x与y。
如图1所示,凹槽的直角三角形截面的斜边的中点5相对于第一平台A的横向偏移距离x由如下公式得出:
其中:
如图2所示,α为凹槽的直角三角形截面的斜边与长直角边的夹角,且该长直角边平行于第二平台B的长度方向,L0为凹槽的直角三角形截面的斜边长度,在制作反射面4的尺寸时可以确定,为已知量,因此:
其中,L4为凹槽的直角三角形截面的短直角边,即平行于第二平台B宽度方向的直角边的长度(即作为三角形凹槽的深度),而凹槽的直角三角形截面的斜边的中点5相对于第一平台A的纵向偏移距离y,由如下公式得出:
y=x tan(α+ω)
按照旋转角ω、横向距离、纵向距离的顺序依次调整第二平台B的位置与姿态,能够实现在非接触的情况下第一平台A与第二平台B相对位姿的固定不变。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。
Claims (6)
1.一种平面内双平台相对位姿测量系统,其特征在于,包括:第一激光测距仪(1)、第二激光测距仪(2)、第三激光测距仪(3)和反射面(4),测量对象为第一平台(A)和第二平台(B);
其中,第一激光测距仪(1)、第二激光测距仪(2)、第三激光测距仪(3)位于第一平台(A)上,等间距放置,第三激光测距仪(3)位于第一激光测距仪(1)、第二激光测距仪(2)之间;反射面(4)位于第二平台(B)上;
测量时,第一激光测距仪(1)、第二激光测距仪(2)、第三激光测距仪(3)三者同时工作,且第一激光测距仪(1)、第二激光测距仪(2)、第三激光测距仪(3)的测量射线处于同一平面内,此平面即为第一平台(A)与第二平台(B)需要测量相对位姿的平面;
所述反射面(4)的颜色为白色,且具有一横截面为直角三角形的凹槽,测量时,第一激光测距仪(1)与第二激光测距仪(2)分别照射在反射面(4)的凹槽的两侧,第三激光测距仪(3)照射在凹槽内部。
2.如权利要求1所述的系统,其特征在于,所述第一平台(A)为长方体。
3.如权利要求2所述的系统,其特征在于,所述第二平台(B)为长方体。
4.如权利要求3所述的系统,其特征在于,所述第一平台(A)与第二平台(B)为尺寸相同的长方体。
5.如权利要求1所述的系统,其特征在于,所述第三激光测距仪(3)照射在凹槽的斜面。
6.如权利要求1至5中任一项所述的系统,其特征在于,所述第一平台(A)与第二平台(B)二者的相对距离不超过第一激光测距仪(1)、第二激光测距仪(2)、第三激光测距仪(3)所处位置的量程。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810320893.6A CN108680926B (zh) | 2018-04-11 | 2018-04-11 | 平面内双平台相对位姿测量系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810320893.6A CN108680926B (zh) | 2018-04-11 | 2018-04-11 | 平面内双平台相对位姿测量系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108680926A CN108680926A (zh) | 2018-10-19 |
CN108680926B true CN108680926B (zh) | 2022-03-25 |
Family
ID=63801004
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810320893.6A Active CN108680926B (zh) | 2018-04-11 | 2018-04-11 | 平面内双平台相对位姿测量系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108680926B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108120447B (zh) * | 2016-11-28 | 2021-08-31 | 沈阳新松机器人自动化股份有限公司 | 多激光设备数据融合方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TW200604490A (en) * | 2005-10-17 | 2006-02-01 | Yu-Kuang Tseng | Position sensing apparatus and method |
CN101419070A (zh) * | 2008-12-03 | 2009-04-29 | 南京航空航天大学 | 基于激光测距成像仪的相对位姿确定方法 |
CN101762273A (zh) * | 2010-02-01 | 2010-06-30 | 北京理工大学 | 一种深空探测器软着陆自主光学导航方法 |
CN102322857A (zh) * | 2011-05-24 | 2012-01-18 | 武汉理工大学 | 机动设备位姿测量系统及测量方法 |
CN104180756A (zh) * | 2014-08-27 | 2014-12-03 | 国家电网公司 | 激光位移传感器测对接件相对位移的方法 |
EP2933656A1 (en) * | 2014-04-14 | 2015-10-21 | The Boeing Company | Aerial positioning systems and methods |
CN105091744A (zh) * | 2015-05-07 | 2015-11-25 | 中国科学院自动化研究所 | 一种基于视觉传感器和激光测距仪的位姿检测装置与方法 |
CN105841674A (zh) * | 2015-02-04 | 2016-08-10 | 普乐福尼克·迪特·布什股份公司 | 用于确定两个物体的理想位置偏差的装置和方法 |
CN106441311A (zh) * | 2016-07-15 | 2017-02-22 | 上海宇航系统工程研究所 | 一种基于激光成像雷达的非合作航天器相对位姿测量方法 |
CN106643382A (zh) * | 2016-11-28 | 2017-05-10 | 山东科技大学 | 一种相对全位姿检测装置及其应用 |
CN107449402A (zh) * | 2017-07-31 | 2017-12-08 | 清华大学深圳研究生院 | 一种非合作目标的相对位姿的测量方法 |
-
2018
- 2018-04-11 CN CN201810320893.6A patent/CN108680926B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TW200604490A (en) * | 2005-10-17 | 2006-02-01 | Yu-Kuang Tseng | Position sensing apparatus and method |
CN101419070A (zh) * | 2008-12-03 | 2009-04-29 | 南京航空航天大学 | 基于激光测距成像仪的相对位姿确定方法 |
CN101762273A (zh) * | 2010-02-01 | 2010-06-30 | 北京理工大学 | 一种深空探测器软着陆自主光学导航方法 |
CN102322857A (zh) * | 2011-05-24 | 2012-01-18 | 武汉理工大学 | 机动设备位姿测量系统及测量方法 |
EP2933656A1 (en) * | 2014-04-14 | 2015-10-21 | The Boeing Company | Aerial positioning systems and methods |
CN104180756A (zh) * | 2014-08-27 | 2014-12-03 | 国家电网公司 | 激光位移传感器测对接件相对位移的方法 |
CN105841674A (zh) * | 2015-02-04 | 2016-08-10 | 普乐福尼克·迪特·布什股份公司 | 用于确定两个物体的理想位置偏差的装置和方法 |
CN105091744A (zh) * | 2015-05-07 | 2015-11-25 | 中国科学院自动化研究所 | 一种基于视觉传感器和激光测距仪的位姿检测装置与方法 |
CN106441311A (zh) * | 2016-07-15 | 2017-02-22 | 上海宇航系统工程研究所 | 一种基于激光成像雷达的非合作航天器相对位姿测量方法 |
CN106643382A (zh) * | 2016-11-28 | 2017-05-10 | 山东科技大学 | 一种相对全位姿检测装置及其应用 |
CN107449402A (zh) * | 2017-07-31 | 2017-12-08 | 清华大学深圳研究生院 | 一种非合作目标的相对位姿的测量方法 |
Non-Patent Citations (2)
Title |
---|
基于激光测距的舱段法兰相对位姿检测方法研究;郝宇宙;《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》;20170215(第02期);正文全文 * |
激光测距在面与面平行调节中的应用;赵喜清 等;《电子工艺技术》;20101130;第111-114页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108680926A (zh) | 2018-10-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Beraldin et al. | Active 3D sensing | |
Luo et al. | A simple calibration procedure for structured light system | |
CN101871769B (zh) | 三维变形场同时载频调制的电子散斑检测方法 | |
CN104613900A (zh) | 一种全光路光漂补偿的高精度滚转角测量方法与装置 | |
CN102853786A (zh) | 平整度检测装置和方法 | |
CN103149560A (zh) | Ccd成像侧向激光雷达的标定方法 | |
Xia et al. | Global calibration of multi-cameras with non-overlapping fields of view based on photogrammetry and reconfigurable target | |
CN103759656A (zh) | 一种二自由度外差光栅干涉仪位移测量系统 | |
CN106153074A (zh) | 一种惯性测量组合动态导航性能的光学标定系统和方法 | |
US20190285404A1 (en) | Noncontact three-dimensional measurement system | |
CN101782419B (zh) | 基于等腰直角三角棱镜的液位测量方法及测量装置 | |
US11692815B2 (en) | Imaging system with calibration target object | |
CN106482670A (zh) | 一种三维角度测量系统 | |
Básaca et al. | 3D laser scanning vision system for autonomous robot navigation | |
CN108680926B (zh) | 平面内双平台相对位姿测量系统 | |
CN103791889A (zh) | 一种利用十字结构光辅助的单目视觉位姿测量方法 | |
CN104180756A (zh) | 激光位移传感器测对接件相对位移的方法 | |
CN108180829B (zh) | 一种对具有平行线特征的目标空间指向测量方法 | |
CN103697825A (zh) | 一种超分辨3d激光测量系统及方法 | |
CN105953820B (zh) | 一种惯性测量组合动态导航性能的光学标定装置 | |
CN205808428U (zh) | 惯性测量组合动态导航性能的光学标定系统 | |
CN204373600U (zh) | 三线激光器标定板 | |
CN203011354U (zh) | 游标狭缝式光电自准直仪 | |
RU98596U1 (ru) | Двухканальный цифровой автоколлиматор | |
CN203687882U (zh) | 一种超分辨3d激光测量系统 |
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 |