CN106643745B - 深空探测行星着陆模拟器位姿测量装置及方法 - Google Patents
深空探测行星着陆模拟器位姿测量装置及方法 Download PDFInfo
- Publication number
- CN106643745B CN106643745B CN201710030697.0A CN201710030697A CN106643745B CN 106643745 B CN106643745 B CN 106643745B CN 201710030697 A CN201710030697 A CN 201710030697A CN 106643745 B CN106643745 B CN 106643745B
- Authority
- CN
- China
- Prior art keywords
- camera
- shaped cross
- platform
- guide rail
- cross beam
- 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
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明提供了一种深空探测行星着陆模拟器位姿测量装置及方法,属于着陆模拟器位姿测量装置及方法技术领域。本发明包括电机、导轨、丝杠、Y横梁、X横梁、Z横梁、支架、摄像机、气浮平台、气浮轴承、大理石平台、基座和标志点,大理石平台的上端设有气浮轴承,气浮轴承的上端设有气浮平台,标志点固定在气浮平台的上端。三个坐标作为反馈信息传给横梁上对应的电机,使电机带动丝杠产生相应的位移,从而使得摄像机能够始终跟随气浮平台的平动,并且保证摄像机可以调整与标志点的高度差,提高了测量的精度。通过由摄像机坐标系到世界坐标系的坐标变换可以得到三个标志点在世界坐标系中的坐标变化情况,并由此可以解算出气浮平台的转动角度。
Description
技术领域
本发明涉及一种深空探测行星着陆模拟器位姿测量装置及方法,属于着陆模拟器位姿测量装置及方法技术领域。
背景技术
现代航天深空探测任务要求进行行星着陆探测,航天器从环绕轨道进入火星大气直至降落在火星上是一个复杂的运动过程,在这个过程中着陆器需要面对复杂多变的火星环境和突发条件,并且需要进行轨道姿态的调控,着陆是否成功直接关系到探测任务的成败。因此,设计火星捕获制动与器器分离全物理仿真试验***,对火星探测捕获制动阶段和器器分离阶段的减速制动、安全分离等控制而开展的仿真验证便显得尤为重要。
行星着陆模拟器采用两个运动模拟器分别来模拟环绕器与着陆器。运动模拟器在轨道稳定支撑***上运动,在水平面内实现三自由度运动,包括X,Y方向平动和绕Z轴转动。为实现对模拟器的闭环控制,需要通过测量***得到模拟器的轨道和姿态。测量***的精度决定了整个控制***的精度,因此,设计高精度且稳定可靠的测量***是非常重要的。
论文“基于单目视觉的位姿测量方法及仿真***研究”(哈尔滨工业大学硕士学位论文,马国松,20050301)中提出了一种利用单目摄像机对目标进行位置及姿态测量的方法。虽然结构简单,并且能够实现物***置和姿态的测量,但是其测量精度较低,其最终位置误差为2%,姿态误差为±2°左右,应用范围有限,难以应用在航空探测等高精度场合。
论文“三维姿态角高精度测量装置”(光学精密工程:doi:10.3788/OPE.20162405.0963)提出了一种基于激光准直仪的三维测角装置。该装置具有高精度、高稳定性,结构简单可靠。但是该方法仅适用于转动,无法测量物体的平动信息。
发明内容
本发明的目的是为了解决上述现有技术存在的问题,进而提供一种深空探测行星着陆模拟器位姿测量装置及方法。
本发明的目的是通过以下技术方案实现的:
一种深空探测行星着陆模拟器位姿测量装置,包括:电机、导轨、丝杠、两个Y横梁、X横梁、四个Z横梁、支架、摄像机、气浮平台、气浮轴承、大理石平台、四个基座和标志点,所述四个Z横梁竖直设置,每个Z横梁的上端设有一个电机,每个Z横梁的下端与一个基座固定连接,每个Z横梁上设有一个导轨和一个丝杠,丝杠的一端与电机的输出端相连接,丝杠与导轨相啮合,导轨与Z横梁固定连接;两个Y横梁相互平行设置在两两相对的Z横梁上的导轨上且与导轨滑动连接;
每个Y横梁上设有一个电机、一个导轨和一个丝杠,丝杠的一端与电机的输出端相连接,丝杠与导轨相啮合,导轨与Y横梁固定连接;X横梁的一端与一侧的Y横梁的导轨滑动连接,X横梁的另一端与另一侧的Y横梁的导轨滑动连接;
X横梁上设有一个电机、一个导轨和一个丝杠,丝杠的一端与电机的输出端相连接,丝杠与导轨相啮合,导轨与X横梁固定连接;
支架与X横梁上的导轨滑动连接,摄像机固定在支架的下端,大理石平台设置在四个基座围成的空间内的下部,大理石平台的上端设有气浮轴承,气浮轴承的上端设有气浮平台,标志点固定在气浮平台的上端,摄像机与标志点上下对应。
一种深空探测行星着陆模拟器位姿测量方法如下:
当气浮平台产生一定的平动或转动时,摄像机通过将当前标志点的图像进行去畸变,二值化,求质心处理,得到三个标志点的几何中心在摄像机成像面上的像素坐标,通过建立三维模型,由三个像素坐标得到三个标志点几何中心在世界坐标系中的空间三维坐标;
Oc为摄像机光心,测量光标记为A、B、C,OcA,OcB,OcC之间的夹角分别为α,β,γ;已知|BC|=a,|AC|=b,|AB|=c,由摄像机内参数计算得到α,β,γ的值,设A、B、C与光心Oc之间连线的长度分别记为x,y,z,则以下方程成立:
当A、B、C构成等腰三角形关系,且摄像机在某些特定区域时,方程组具有唯一解,形式如下:
满足上述解的形式时,摄像机相对于标志物的位置:AK垂直于AC,AJ垂直于AB,且AK,AJ都在平面ABC上,直线L过点A且垂直于平面ABC,直线L和射线AK构成平面α,直线L和射线AJ构成平面β,平面π1和平面π2所夹的空间区域称为V;当光心Oc出现在V区域时,对应解的形式为方程组一;同理,对应方程组二,光心Oc位于空间W处;
应用牛顿迭代法从上述方程组中解得A、B、C与光心Oc之间连线的长度x,y,z;利用相似三角形原理,可以得到A,B,C三点在摄像机坐标系下的坐标分别为:
其中,(A′x,A′y),(B′x,B′y),(C′x,C′y)分别三个像点的图像像素坐标,(uo,vo)是摄像机光轴OcO与成像面交点O,f是摄像机焦距,将这三个坐标作为反馈信息传给横梁上对应的电机,使电机带动丝杠产生相应的位移,从而使得摄像机能够始终跟随气浮平台的平动,并且保证摄像机调整与标志点的高度差,通过由摄像机坐标系到世界坐标系的坐标变换得到三个标志点在世界坐标系中的坐标变化情况,并由此解算出气浮平台的转动角度。
本发明提出一种基于图像处理的深空探测行星着陆模拟器位姿测量装置及方法。视觉测量***通过摄像机采集测量光标图像,利用二维信息逆向推导光标相对于摄像机的三维姿态信息,以实现运动模拟器轨道和姿态测量功能。摄像机安装在具有三个平动自由度的由Y横梁、X横梁和Z横梁构成的天车上,可以跟随物体做水平两自由度平动,解决了物体平动信息的测量问题。同时,由于摄像机具有竖直方向的平动自由度,因此可最大限度缩短摄像机与标志点的距离,提高了测量精度。
附图说明
图1为本发明深空探测行星着陆模拟器位姿测量装置的整体结构示意图。
图2为气浮平台和标志点的结构示意图。
图3为摄像机三维成像模型图。
图4为摄像机位置示意图。
图中的附图标记,1为电机,2为导轨,3为丝杠,4为Y横梁,5为X横梁,6为Z横梁,7为支架,8为摄像机,9为气浮平台,10为气浮轴承,11为大理石平台,12为基座,13为标志点。
具体实施方式
下面将结合附图对本发明做进一步的详细说明:本实施例在以本发明技术方案为前提下进行实施,给出了详细的实施方式,但本发明的保护范围不限于下述实施例。
如图1和图2所示,本实施例所涉及的一种深空探测行星着陆模拟器位姿测量装置,包括:电机1、导轨2、丝杠3、两个Y横梁4、X横梁5、四个Z横梁6、支架7、摄像机8、气浮平台9、气浮轴承10、大理石平台11、四个基座12和标志点13,所述四个Z横梁6竖直设置,每个Z横梁6的上端设有一个电机1,每个Z横梁6的下端与一个基座12固定连接,每个Z横梁6上设有一个导轨2和一个丝杠3,丝杠3的一端与电机1的输出端相连接,丝杠3与导轨2相啮合,导轨2与Z横梁6固定连接;两个Y横梁4相互平行设置在两两相对的Z横梁6上的导轨2上且与导轨2滑动连接;
每个Y横梁4上设有一个电机1、一个导轨2和一个丝杠3,丝杠3的一端与电机1的输出端相连接,丝杠3与导轨2相啮合,导轨2与Y横梁4固定连接;X横梁5的一端与一侧的Y横梁4的导轨2滑动连接,X横梁5的另一端与另一侧的Y横梁4的导轨2滑动连接;
X横梁5上设有一个电机1、一个导轨2和一个丝杠3,丝杠3的一端与电机1的输出端相连接,丝杠3与导轨2相啮合,导轨2与X横梁5固定连接;
支架7与X横梁5上的导轨2滑动连接,摄像机8固定在支架7的下端,大理石平台11设置在四个基座12围成的空间内的下部,大理石平台11的上端设有气浮轴承10,气浮轴承10的上端设有气浮平台9,标志点13固定在气浮平台9的上端,摄像机8与标志点13上下对应。
支架7经丝杠带动,可以沿X横梁左右滑动。X横梁垂直于两个Y横梁,其两端分别由Y横梁上的电机通过丝杠控制,实现沿Y横梁的运动。两个Y横梁的四个端点由丝杠与位于Z横梁的四个电机分别相连,实现沿Z横梁的运动。标志点位于气浮平台上。气浮平台经气浮轴承与大理石平台相连,在水平面内实现三自由度运动,包括X,Y方向平动和绕Z轴转动。
所述标志点13为三个,三个标志点13一字型排列固定在气浮平台9上端的中心位置。
如图3和图4所示,本实施例所涉及的一种深空探测行星着陆模拟器位姿测量方法,当气浮平台产生一定的平动或转动时,摄像机通过将当前标志点的图像进行去畸变,二值化,求质心等处理,得到三个标志点的几何中心在摄像机成像面上的像素坐标。通过建立三维模型,可以由三个像素坐标得到三个标志点几何中心在世界坐标系中的空间三维坐标。摄像机的三维成像模型如图3所示。
图中,Oc为摄像机光心,测量光标记为A、B、C,OcA,OcB,OcC之间的夹角分别为α,β,γ;已知|BC|=a,|AC|=b,|AB|=c,由摄像机内参数可计算得到α,β,γ的值,设A、B、C与光心Oc之间连线的长度分别记为x,y,z,则以下方程成立:
可以证明,当A、B、C构成等腰三角形关系,且摄像机在某些特定区域时,方程组具有唯一解,形式如下:
满足上述解的形式时,摄像机相对于标志物的位置如图4所示。AK垂直于AC,AJ垂直于AB,且AK,AJ都在平面ABC上,直线L过点A且垂直于平面ABC,直线L和射线AK构成平面α,直线L和射线AJ构成平面β,平面π1和平面π2所夹的空间区域称为V。当光心Oc出现在V区域时,对应解的形式为方程组一。同理,对应方程组二,光心Oc位于空间W处。
可以应用牛顿迭代法从上述方程组中解得A、B、C与光心Oc之间连线的长度x,y,z。利用相似三角形原理,可以得到A,B,C三点在摄像机坐标系下的坐标分别为:
其中,(A′x,A′y),(B′x,B′y),(C′x,C′y)分别三个像点的图像像素坐标,(uo,vo)是摄像机光轴OcO与成像面交点O,f是摄像机焦距。将这三个坐标作为反馈信息传给横梁上对应的电机,使电机带动丝杠产生相应的位移,从而使得摄像机能够始终跟随气浮平台的平动,并且保证摄像机可以调整与标志点的高度差,提高了测量的精度。通过由摄像机坐标系到世界坐标系的坐标变换可以得到三个标志点在世界坐标系中的坐标变化情况,并由此可以解算出气浮平台的转动角度。
以上所述,仅为本发明较佳的具体实施方式,这些具体实施方式都是基于本发明整体构思下的不同实现方式,而且本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求书的保护范围为准。
Claims (3)
1.一种深空探测行星着陆模拟器位姿测量装置,其特征在于,包括:电机(1)、导轨(2)、丝杠(3)、两个Y横梁(4)、X横梁(5)、四个Z横梁(6)、支架(7)、摄像机(8)、气浮平台(9)、气浮轴承(10)、大理石平台(11)、四个基座(12)和标志点(13),所述四个Z横梁(6)竖直设置,每个Z横梁(6)的上端设有一个电机(1),每个Z横梁(6)的下端与一个基座(12)固定连接,每个Z横梁(6)上设有一个导轨(2)和一个丝杠(3),丝杠(3)的一端与电机(1)的输出端相连接,丝杠(3)与导轨(2)相啮合,导轨(2)与Z横梁(6)固定连接;两个Y横梁(4)相互平行设置在两两相对的Z横梁(6)上的导轨(2)上且与导轨(2)滑动连接;
每个Y横梁(4)上设有一个电机(1)、一个导轨(2)和一个丝杠(3),丝杠(3)的一端与电机(1)的输出端相连接,丝杠(3)与导轨(2)相啮合,导轨(2)与Y横梁(4)固定连接;X横梁(5)的一端与一侧的Y横梁(4)的导轨(2)滑动连接,X横梁(5)的另一端与另一侧的Y横梁(4)的导轨(2)滑动连接;
X横梁(5)上设有一个电机(1)、一个导轨(2)和一个丝杠(3),丝杠(3)的一端与电机(1)的输出端相连接,丝杠(3)与导轨(2)相啮合,导轨(2)与X横梁(5)固定连接;
支架(7)与X横梁(5)上的导轨(2)滑动连接,摄像机(8)固定在支架(7)的下端,大理石平台(11)设置在四个基座(12)围成的空间内的下部,大理石平台(11)的上端设有气浮轴承(10),气浮轴承(10)的上端设有气浮平台(9),标志点(13)固定在气浮平台(9)的上端,摄像机(8)与标志点(13)上下对应。
2.根据权利要求1所述的深空探测行星着陆模拟器位姿测量装置,其特征在于,所述标志点(13)为三个,三个标志点(13)一字型排列固定在气浮平台(9)上端的中心位置。
3.一种使用根据权利要求1所述的深空探测行星着陆模拟器位姿测量装置的测量方法,其特征在于,当气浮平台产生一定的平动或转动时,摄像机通过将当前标志点的图像进行去畸变,二值化,求质心处理,得到三个标志点的几何中心在摄像机成像面上的像素坐标,通过建立三维模型,由三个像素坐标得到三个标志点几何中心在世界坐标系中的空间三维坐标;
Oc为摄像机光心,测量光标记为A、B、C,OcA,OcB,OcC之间的夹角分别为α,β,γ;已知|BC|=a,|AC|=b,|AB|=c,由摄像机内参数计算得到α,β,γ的值,设A、B、C与光心Oc之间连线的长度分别记为x,y,z,则以下方程成立:
当A、B、C构成等腰三角形关系,且摄像机在某些特定区域时,方程组具有唯一解,形式如下:
满足上述解的形式时,摄像机相对于标志物的位置:AK垂直于AC,AJ垂直于AB,且AK,AJ都在平面ABC上,直线L过点A且垂直于平面ABC,直线L和射线AK构成平面π1,直线L和射线AJ构成平面π2,平面π1和平面π2所夹的空间区域称为V;当光心Oc出现在V区域时,对应解的形式为方程组一;同理,对应方程组二,光心Oc位于空间W处;
应用牛顿迭代法从上述方程组中解得A、B、C与光心Oc之间连线的长度x,y,z;利用相似三角形原理,可以得到A,B,C三点在摄像机坐标系下的坐标分别为:
其中,(A′x,A′y),(B′x,B′y),(C′x,C′y)分别三个像点的图像像素坐标,(uo,vo)是摄像机光轴OcO与成像面交点O,f是摄像机焦距,将这三个坐标作为反馈信息传给横梁上对应的电机,使电机带动丝杠产生相应的位移,从而使得摄像机能够始终跟随气浮平台的平动,并且保证摄像机调整与标志点的高度差,通过由摄像机坐标系到世界坐标系的坐标变换得到三个标志点在世界坐标系中的坐标变化情况,并由此解算出气浮平台的转动角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710030697.0A CN106643745B (zh) | 2017-01-17 | 2017-01-17 | 深空探测行星着陆模拟器位姿测量装置及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710030697.0A CN106643745B (zh) | 2017-01-17 | 2017-01-17 | 深空探测行星着陆模拟器位姿测量装置及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106643745A CN106643745A (zh) | 2017-05-10 |
CN106643745B true CN106643745B (zh) | 2020-03-10 |
Family
ID=58841731
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710030697.0A Active CN106643745B (zh) | 2017-01-17 | 2017-01-17 | 深空探测行星着陆模拟器位姿测量装置及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106643745B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107990825B (zh) * | 2017-11-20 | 2020-03-10 | 哈尔滨工业大学 | 基于先验数据校正的高精度位置测量装置与方法 |
CN113525733B (zh) * | 2021-08-16 | 2022-03-08 | 哈尔滨工业大学 | 双层结构的六自由度微重力试验*** |
CN115327951B (zh) * | 2022-08-30 | 2024-06-21 | 多伦科技股份有限公司 | 一种车辆驾驶模拟器三自由度控制方法及电子设备 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101122780A (zh) * | 2007-09-04 | 2008-02-13 | 北京控制工程研究所 | 月球软着陆制导、导航与控制半物理仿真试验*** |
CN103308028A (zh) * | 2013-05-27 | 2013-09-18 | 哈尔滨工业大学 | 三轴气浮台姿态角双目立体视觉测量装置及其测量方法 |
CN104932509A (zh) * | 2015-05-15 | 2015-09-23 | 上海新跃仪表厂 | 挠性航天器主动振动抑制地面测试*** |
-
2017
- 2017-01-17 CN CN201710030697.0A patent/CN106643745B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101122780A (zh) * | 2007-09-04 | 2008-02-13 | 北京控制工程研究所 | 月球软着陆制导、导航与控制半物理仿真试验*** |
CN103308028A (zh) * | 2013-05-27 | 2013-09-18 | 哈尔滨工业大学 | 三轴气浮台姿态角双目立体视觉测量装置及其测量方法 |
CN104932509A (zh) * | 2015-05-15 | 2015-09-23 | 上海新跃仪表厂 | 挠性航天器主动振动抑制地面测试*** |
Non-Patent Citations (1)
Title |
---|
基于视觉信息的无人机自主着陆过程姿态和位置估计;陈龙胜 等;《电光与控制》;20090531;第16卷(第5期);第47-51页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106643745A (zh) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CA2939049C (en) | Advanced automated process for the wing-to-body join of an aircraft with predictive surface scanning | |
CN110500978A (zh) | 点激光传感器的光束方向矢量和零点位置在线标定方法 | |
CN106643745B (zh) | 深空探测行星着陆模拟器位姿测量装置及方法 | |
CN109794938A (zh) | 一种适用于曲面结构的机器人制孔误差补偿装置及其方法 | |
CN111238375B (zh) | 基于激光跟踪仪的移动检测机器人大型构件外形重构方法 | |
CN102426007B (zh) | 三轴气浮台高精度姿态角测量方法及其装置 | |
CN108827264B (zh) | 作业台车及其机械臂光学标靶定位装置和定位方法 | |
CN104990533B (zh) | 卫星地面物理仿真***超高精度姿态测量方法及装置 | |
CN103018066B (zh) | 深空探测小天体附着过程的自主gnc半物理仿真试验*** | |
CN109515769A (zh) | 多星悬吊式微重力模拟*** | |
CN101695814A (zh) | 一种飞机大部件精确入位的方法及其装置 | |
CN110001998B (zh) | 一种基于激光测距的飞机大部件框式结构对接引导装置与方法 | |
CN105459086B (zh) | 一种水平方向及偏航调整的三自由度并联调姿平台 | |
CN102937426A (zh) | 一种基于机器人视觉伺服的大型复杂零件测量方法 | |
CN102393213A (zh) | 天基探测与跟踪成像***测试装置及测试方法 | |
CN108519103A (zh) | 利用自准直仪的稳定平台多姿态精度同步评定装置及方法 | |
CN111811496B (zh) | 一种斜交非接触式三维线速度及双轴动态角度测量***、方法 | |
CN102406504A (zh) | 一种双柱式非接触三维人体尺寸自动测量仪 | |
CN107389266A (zh) | 一种飞行器重心柔性测量方法 | |
CN110849331A (zh) | 基于三维点云数据库模型的单目视觉测量与地面试验方法 | |
Peng et al. | Development of an integrated laser sensors based measurement system for large-scale components automated assembly application | |
CN103192399B (zh) | 一种基于目标运动的显微视觉手眼标定***及方法 | |
CN102589448B (zh) | 高精度六自由度位姿监测装置 | |
CN203203604U (zh) | 一种飞行器姿态测量的半实物仿真实验装置 | |
CN105526914A (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 |