CN111924142A - 一种基于序列图像的软着陆高精度避障方法 - Google Patents
一种基于序列图像的软着陆高精度避障方法 Download PDFInfo
- Publication number
- CN111924142A CN111924142A CN202010681358.0A CN202010681358A CN111924142A CN 111924142 A CN111924142 A CN 111924142A CN 202010681358 A CN202010681358 A CN 202010681358A CN 111924142 A CN111924142 A CN 111924142A
- Authority
- CN
- China
- Prior art keywords
- lander
- image
- safe landing
- landing point
- descending
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/62—Systems for re-entry into the earth's atmosphere; Retarding or landing devices
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种基于序列图像的软着陆高精度避障方法,该方法的步骤包括:在下降图像中找到安全着陆点位置;根据安全着陆点在下降图像中的位置计算安全着陆点在成像时刻着陆器本体系下的方向矢量;在下一幅下降图像还未获取期间,安全着陆点在当前时刻着陆器本体系下的位置和速度通过惯导外推着陆器位置和速度变化获取;否则根据上一幅下降图像和当前获取的下降图像中安全着陆点方向矢量结合测速敏感器和IMU测量计算安全着陆点在当前成像时刻着陆器本体系下的位置和速度;根据安全着陆点在当前时刻着陆器本体系下的位置和速度确定着陆器本体下控制指令,按照该控制指令进行控制完成避障。
Description
技术领域
本发明涉及一种基于序列图像的软着陆高精度避障方法,属于航天器制导、导航与控制技术领域。本发明是火星着陆过程制导与控制领域的关键技术,可以应用于各类地外天体的软着陆探测任务,具有广泛的应用价值和市场前景。
背景技术
高精度避障是保证火星安全着陆的关键技术。相比嫦娥系列月球软着陆动力下降过程,火星EDL过程角速度和加速度动态变化范围大,需要采用大量程的惯性敏感器,这就导致惯导外推误差飘散较快,此时采用嫦娥系列月球软着陆的避障方法难以满足避障精度要求,因此,需要在继承嫦娥系列月球软着陆避障方法的基础上,设计新的高精度避障方法。
发明内容
本发明解决的技术问题是:针对火星动力下降过程大导航误差情况下高精度避障的新需求,提出了一种基于序列图像的软着陆高精度避障方法。
本发明解决技术的方案是:一种基于序列图像的软着陆高精度避障方法,该方法的步骤包括:
在下降图像中找到安全着陆点位置;
根据安全着陆点在下降图像中的位置计算安全着陆点在成像时刻着陆器本体系下的方向矢量;
在下一幅下降图像还未获取期间,安全着陆点在当前时刻着陆器本体系下的位置和速度通过惯导外推着陆器位置和速度变化获取;否则根据上一幅下降图像和当前获取的下降图像中安全着陆点方向矢量结合测速敏感器和IMU测量计算安全着陆点在当前成像时刻着陆器本体系下的位置和速度;
根据安全着陆点在当前成像时刻着陆器本体系下的位置和速度确定着陆器本体下控制指令,按照该控制指令进行控制完成避障。
优选的,在第一幅下降图像中利用障碍识别的方式找到安全着陆点,通过与前一幅下降图像进行匹配获取安全着陆点在后续下降图像中的像元像线位置。
优选的,通过下述方式在第一幅下降图像中找到安全着陆点:
(1)对下降图像进行处理获取图像的灰度值,通过直方图分析和K均值聚类算法识别出灰度图像中过亮、过暗和纹理障碍,获得下降图像的障碍二值图;
(2)将下降图像的障碍二值图按像素点划分为网格,从图像中心网格开始按逆时针螺旋搜索,计算每个网格到距其最近的障碍网格之间的距离作为该网格的安全半径,当找到安全半径符合安全着陆要求的网格时停止搜索,将该网格对应的像素点作为安全着陆点;
若下降图像中未能找到完全满足安全着陆要求的网格时,则选择安全半径最大的网格对应的像素点作为安全着陆点。
优选的,所述的匹配通过下述方式实现:
S1、利用SURF特征检测算法检测提取第i幅下降图像中安全着陆点附近特征点,从所提取特征点中选取4个与安全着陆点组成特征点集,且要求该特征点集中任意3个特征点均不共线;
S2、利用SURF算法检测提取第i+1幅图像中特征点,通过与第i幅图像匹配获取选定的4个特征点在第i+1幅图像中的位置;
S3、根据射影几何交比不变定理利用选定的4个特征点在第i和i+1幅图像中的位置以及安全着陆点在第i幅图像中的位置计算得到安全着陆点在第i+1幅图像中的位置。
优选的,下降图像的拍摄规则按下述方式进行:
根据着陆器器上计算能力以及IMU性能和避障精度要求共同确定下降图像的拍摄间隔;假设着陆器自主完成下降图像安全着陆点确定和匹配跟踪需要时间Δtimage1,避障精度要求为Δr,通过IMU测量进行导航外推位置累计误差达到Δr的时间为Δtimage2,则下降图像拍摄的时间间隔Δtimage应满足Δtimage1<Δtimage<Δtimage2。
优选的,通过下述方式计算安全着陆点在当前成像时刻着陆器本体系下的位置:
以第i次成像时着陆器姿态为基准姿态,即姿态四元数qBi=[0 0 0 1]T,利用IMU陀螺角速度测量输出,进行姿态外推,得到ti+1时刻成像时着陆器相对ti成像的姿态;
利用测速敏感器和IMU测量输出进行外推,得到ti+1时刻相对于ti时刻着陆器位置在ti时刻着陆器本体系下表示ΔRBi+1|i,进而计算ti+1时刻安全着陆点在着陆器本体系下的位置表示。
优选的,ti+1时刻成像时着陆器相对ti时刻成像的姿态:
其中,为四元数乘法,ΔθBi+1|i=||ΔθBi+1|i||,为从ti到ti+1时刻由陀螺测量得到的角度增量,ωBji为陀螺在ti+j·Δt时刻测量得到的角速度,Δt为IMU测量更新周期,表示两幅下降图像成像间隔期间陀螺测量次数。
优选的,ti+1时刻相对于ti时刻着陆器位置在ti时刻着陆器本体系下表示为:
其中,表示由ti+j·Δt时刻着陆器本体系到ti时刻着陆器本体系的转换阵,vBji为ti+j·Δt时刻着陆器本体系下着陆器相对行星表面速度,Δt为IMU测量更新周期,表示两幅下降图像成像间隔期间陀螺测量次数。
优选的,ti+1时刻安全着陆点在当前着陆器本体系下的表示为:
其中,
优选的,所述的控制指令在着陆器本体下的表示为:
ui+1=-KPRLBi+1-KdvBi+1
其中,RLBi+1为安全着陆点在着陆器本体系下的位置,vBi+1为着陆器相对于安全着陆点的速度,即为着陆器相对行星表面速度KP、Kd分别代表避障控制参数。
本发明与现有技术相比的有益效果是:
针对火星动力下降过程大导航误差情况下高精度避障的新需求,本专利提出了一种基于序列图像的软着陆高精度避障方法。该方法设计了连续跟踪动力下降过程图像序列中的安全着陆点实现动力下降过程安全着陆点相对着陆器位置不断更新的策略,通过将不断更新的安全着陆点相对位置信息引入避障制导实现了避障过程的闭环控制,显著降低了导航误差对避障精度的影响,提高了避障精度和着陆的安全性。
本发明设计了下降序列图像安全着陆点跟踪策略,实现了下降过程安全着陆点相对位置更新,为高精度避障闭环控制奠定了基础;
本发明设计了着陆器本体坐标系下高精度避障控制策略,通过在着陆器本体系下设计避障控制算法,直接利用安全着陆点的相对位置信息,对着陆器相对于安全着陆点的位置和速度进行闭环控制,简化了避障算法设计,降低了导航误差对避障精度的影响,提高了避障精度。
附图说明
图1为本发明方法流程图;
图2为本发明利用序列图像计算安全着陆点位置示意图。
具体实施方式
下面结合实施例及附图1、2对本发明作进一步阐述。
第一步,下降序列图像安全着陆点跟踪策略
利用障碍识别算法在第一幅下降避障图像中找到安全着陆点,后续下降图像通过与前一幅图像进行匹配获取安全着陆点在第i幅下降图像中的像元像线位置pi=[ui vi]T,实现下降序列图像中安全着陆点的连续跟踪。
本步骤中的障碍识别算法具体步骤如下:
对下降图像进行处理获取图像的灰度值,通过直方图分析和K均值聚类算法识别出灰度图像中过亮、过暗和纹理障碍,获得下降图像的障碍二值图;将下降图像的障碍二值图按像素点划分为网格,从图像中心网格开始按逆时针螺旋搜索,计算每个网格到距其最近的障碍网格之间的距离作为该网格的安全半径,当找到安全半径符合安全着陆要求的网格时停止搜索,将该网格对应的像素点作为安全着陆点;若下降图像中未能找到完全满足安全着陆要求的网格时,则选择安全半径最大的网格对应的像素点作为安全着陆点。
本步骤中的安全着陆点的匹配跟踪算法具体步骤如下:
利用SURF特征检测算法检测提取第i幅下降图像中安全着陆点附近特征点,从所提取特征点中选取4个与安全着陆点组成特征点集,且要求该特征点集中任意3个特征点均不共线,定义选定的4个特征点在第i幅图像中的位置为(uij,vij)j=1,2,3,4,安全着陆点在第i幅图像中的位置为(ui,vi)。
利用SURF算法检测提取第i+1幅图像中特征点,通过与第i幅图像匹配获取选定的4个特征点在第i+1幅图像中的位置为(ui+1j,vi+1j)j=1,2,3,4;根据射影几何交比不变定理可计算得到安全着陆点在第i+1幅图像中的位置(ui+1,vi+1)。
本步骤中下降图像拍摄规则如下:
根据着陆器器上计算能力以及IMU性能和避障精度要求共同确定下降图像的拍摄间隔。假设着陆器自主完成下降图像安全着陆点确定和匹配跟踪需要时间Δtimage1,避障精度要求为Δr,通过IMU测量进行导航外推位置累计误差达到Δr的时间为Δtimage2,则下降图像拍摄的时间间隔Δtimage应满足Δtimage1<Δtimage<Δtimage2
第二步,安全着陆点相对位置更新策略
定义CBC为从相机坐标系到着陆器本体坐标系的转换阵,rC为相机在着陆器本体坐标系下安装位置,(ui,vi)为安全着陆点在第i幅下降图像中像元像线位置,(ui0,vi0)为第i幅下降图像像平面中心点像元像线,f为相机焦距,k为相机焦距到像元像线的转换因子。
根据图像处理结果可计算得到安全着陆点在相机坐标系下的视线方向矢量
以第i次成像时着陆器姿态为基准姿态,即姿态四元数qBi=[0001]T,利用IMU陀螺角速度测量输出,进行姿态外推,得到ti+1时刻成像时相对ti成像的姿态为
其中为四元数乘法,ΔθBi+1|i=||ΔθBi+1|i||,为从ti到ti+1时刻由陀螺测量得到的角度增量,ωBj|i为陀螺在ti+j·Δt时刻测量得到的角速度,Δt为IMU测量更新周期,表示两幅下降图像成像间隔期间陀螺测量次数。
利用测速敏感器和IMU测量输出进行外推可得到ti+1时刻相对于ti时刻着陆器位置在ti时刻本体系下表示为
则可计算ti+1时刻安全着陆点在当前本体系下的表示为
其中
在下一幅图像未获取前,通过导航外推可获取安全着陆点在当前本体系下的位置。即假设ti+1<tk<ti+2,则tk时刻安全着陆点在当前本体系下位置为
由于着陆器相对于安全着陆点的速度等于着陆器相对于行星表面的速度,因此ti+1时刻着陆器相对于安全着陆点的速度vBi+1可直接由测速敏感器和惯导外推得到,当前时刻获得测速敏感器测量时vBi+1直接由测速敏感器测量确定,当前时刻未获得测速敏感器测量时则由惯导外推确定。
第三步,精避障闭环相对控制策略
一旦获取安全着陆点在着陆器本体系下的位置信息RLBi+1和着陆器相对于安全着陆点的速度信息vBi+1设计避障控制算法,得到着陆器本体下控制指令
ui+1=-KPRLBi+1-KdvBi+1 (6)
其中KP、Kd分别代表避障控制参数,根据避障对位置、速度精度要求和快速性要求等PID控制参数选取方式进行取值。
利用上述控制指令可实现对着陆器相对于安全着陆点的位置和速度进行三维控制,简化了避障算法设计,完成精确避障。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (10)
1.一种基于序列图像的软着陆高精度避障方法,其特征在于该方法的步骤包括:
在下降图像中找到安全着陆点位置;
根据安全着陆点在下降图像中的位置计算安全着陆点在成像时刻着陆器本体系下的方向矢量;
在下一幅下降图像还未获取期间,安全着陆点在当前时刻着陆器本体系下的位置和速度通过惯导外推着陆器位置和速度变化获取;否则根据上一幅下降图像和当前获取的下降图像中安全着陆点方向矢量结合测速敏感器和IMU测量计算安全着陆点在当前成像时刻着陆器本体系下的位置和速度;
根据安全着陆点在当前成像时刻着陆器本体系下的位置和速度确定着陆器本体下控制指令,按照该控制指令进行控制完成避障。
2.根据权利要求1所述的方法,其特征在于:在第一幅下降图像中利用障碍识别的方式找到安全着陆点,通过与前一幅下降图像进行匹配获取安全着陆点在后续下降图像中的像元像线位置。
3.根据权利要求2所述的方法,其特征在于:通过下述方式在第一幅下降图像中找到安全着陆点:
(1)对下降图像进行处理获取图像的灰度值,通过直方图分析和K均值聚类算法识别出灰度图像中过亮、过暗和纹理障碍,获得下降图像的障碍二值图;
(2)将下降图像的障碍二值图按像素点划分为网格,从图像中心网格开始按逆时针螺旋搜索,计算每个网格到距其最近的障碍网格之间的距离作为该网格的安全半径,当找到安全半径符合安全着陆要求的网格时停止搜索,将该网格对应的像素点作为安全着陆点;
若下降图像中未能找到完全满足安全着陆要求的网格时,则选择安全半径最大的网格对应的像素点作为安全着陆点。
4.根据权利要求2所述的方法,其特征在于:所述的匹配通过下述方式实现:
S1、利用SURF特征检测算法检测提取第i幅下降图像中安全着陆点附近特征点,从所提取特征点中选取4个与安全着陆点组成特征点集,且要求该特征点集中任意3个特征点均不共线;
S2、利用SURF算法检测提取第i+1幅图像中特征点,通过与第i幅图像匹配获取选定的4个特征点在第i+1幅图像中的位置;
S3、根据射影几何交比不变定理利用选定的4个特征点在第i和i+1幅图像中的位置以及安全着陆点在第i幅图像中的位置计算得到安全着陆点在第i+1幅图像中的位置。
5.根据权利要求1所述的方法,其特征在于:下降图像的拍摄规则按下述方式进行:
根据着陆器器上计算能力以及IMU性能和避障精度要求共同确定下降图像的拍摄间隔;假设着陆器自主完成下降图像安全着陆点确定和匹配跟踪需要时间Δtimage1,避障精度要求为Δr,通过IMU测量进行导航外推位置累计误差达到Δr的时间为Δtimage2,则下降图像拍摄的时间间隔Δtimage应满足Δtimage1<Δtimage<Δtimage2。
6.根据权利要求1所述的方法,其特征在于:通过下述方式计算安全着陆点在当前成像时刻着陆器本体系下的位置:
以第i次成像时着陆器姿态为基准姿态,即姿态四元数qBi=[0 0 0 1]T,利用IMU陀螺角速度测量输出,进行姿态外推,得到ti+1时刻成像时着陆器相对ti成像的姿态;
利用测速敏感器和IMU测量输出进行外推,得到ti+1时刻相对于ti时刻着陆器位置在ti时刻着陆器本体系下表示ΔRBi+1|i,进而计算ti+1时刻安全着陆点在着陆器本体系下的位置表示。
10.根据权利要求1所述的方法,其特征在于:所述的控制指令在着陆器本体下的表示为:
ui+1=-KPRLBi+1-KdvBi+1
其中,RLBi+1为安全着陆点在着陆器本体系下的位置,vBi+1为着陆器相对于安全着陆点的速度,即为着陆器相对行星表面速度KP、Kd分别代表避障控制参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010681358.0A CN111924142B (zh) | 2020-07-15 | 2020-07-15 | 一种基于序列图像的软着陆高精度避障方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010681358.0A CN111924142B (zh) | 2020-07-15 | 2020-07-15 | 一种基于序列图像的软着陆高精度避障方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111924142A true CN111924142A (zh) | 2020-11-13 |
CN111924142B CN111924142B (zh) | 2022-01-04 |
Family
ID=73312994
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010681358.0A Active CN111924142B (zh) | 2020-07-15 | 2020-07-15 | 一种基于序列图像的软着陆高精度避障方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111924142B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113885542A (zh) * | 2021-09-17 | 2022-01-04 | 北京控制工程研究所 | 一种用于火星着陆的多策略避障逻辑及控制方法 |
CN114019788A (zh) * | 2021-10-08 | 2022-02-08 | 北京控制工程研究所 | 一种着陆过程基于分区的快速平移避障方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000665A (zh) * | 2018-03-20 | 2018-12-14 | 北京控制工程研究所 | 一种深空着陆几何定轨定姿方法、系统及深空着陆器 |
CN109292114A (zh) * | 2018-09-14 | 2019-02-01 | 北京控制工程研究所 | 一种崎岖地形月面软着陆轨迹确定方法 |
-
2020
- 2020-07-15 CN CN202010681358.0A patent/CN111924142B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000665A (zh) * | 2018-03-20 | 2018-12-14 | 北京控制工程研究所 | 一种深空着陆几何定轨定姿方法、系统及深空着陆器 |
CN109292114A (zh) * | 2018-09-14 | 2019-02-01 | 北京控制工程研究所 | 一种崎岖地形月面软着陆轨迹确定方法 |
Non-Patent Citations (9)
Title |
---|
严瑾等: "嫦娥三号着陆器下降序列影像匹配方法研究", 《测绘与空间地理信息》 * |
崔平远等: "火星动力下降自主导航与制导技术研究进展", 《宇航学报》 * |
徐焕宇等: "基于序列图像的月球着陆定位计算方法研究", 《计算机科学》 * |
徐超等: "基于陆标图像的火星精确着陆自主导航方法研究", 《深空探测学报》 * |
徐辛超等: "一种改进下降序列影像匹配方法", 《遥感信息》 * |
李建军等: "一种图像辅助火星着陆段自主导航方法", 《宇航学报》 * |
李立春等: "月面探测中的单目相机成像测量方法", 《航天返回与遥感》 * |
王大轶等: "月球软着陆过程高精度自主导航避障方法", 《深空探测学报》 * |
王大轶等: "深空探测着陆过程序列图像自主导航综述", 《哈尔滨工业大学学报》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113885542A (zh) * | 2021-09-17 | 2022-01-04 | 北京控制工程研究所 | 一种用于火星着陆的多策略避障逻辑及控制方法 |
CN113885542B (zh) * | 2021-09-17 | 2023-11-10 | 北京控制工程研究所 | 一种用于火星着陆的多策略避障逻辑及控制方法 |
CN114019788A (zh) * | 2021-10-08 | 2022-02-08 | 北京控制工程研究所 | 一种着陆过程基于分区的快速平移避障方法 |
CN114019788B (zh) * | 2021-10-08 | 2024-03-26 | 北京控制工程研究所 | 一种着陆过程基于分区的快速平移避障方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111924142B (zh) | 2022-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109029433B (zh) | 一种移动平台上基于视觉和惯导融合slam的标定外参和时序的方法 | |
CN110174899B (zh) | 一种基于敏捷卫星的高精度成像姿态指向控制方法 | |
CN109307508B (zh) | 一种基于多关键帧的全景惯导slam方法 | |
CN110243358B (zh) | 多源融合的无人车室内外定位方法及系统 | |
CN112634451B (zh) | 一种融合多传感器的室外大场景三维建图方法 | |
CN106780699B (zh) | 一种基于sins/gps和里程计辅助的视觉slam方法 | |
CN112985416B (zh) | 激光与视觉信息融合的鲁棒定位和建图方法及系统 | |
CN107193279A (zh) | 基于单目视觉和imu信息的机器人定位与地图构建系统 | |
CN109631911B (zh) | 一种基于深度学习目标识别算法的卫星姿态转动信息确定方法 | |
CN111924142B (zh) | 一种基于序列图像的软着陆高精度避障方法 | |
CN102944241B (zh) | 基于多胞型线性微分包含的航天器相对姿态确定方法 | |
CN114001733B (zh) | 一种基于地图的一致性高效视觉惯性定位算法 | |
US20050137750A1 (en) | Method and apparatus for using rotational movement amount of mobile device and computer-readable recording medium for storing computer program | |
CN109959374B (zh) | 一种行人惯性导航全时全程逆向平滑滤波方法 | |
CN111623773B (zh) | 一种基于鱼眼视觉和惯性测量的目标定位方法及装置 | |
CN112004183B (zh) | 一种基于卷积神经网络融合IMU和WiFi信息的机器人自主定位方法 | |
CN115272596A (zh) | 一种面向单调无纹理大场景的多传感器融合slam方法 | |
CN112197765B (zh) | 一种实现水下机器人精细导航的方法 | |
CN113129377A (zh) | 一种三维激光雷达快速鲁棒slam方法和装置 | |
CN114993338B (zh) | 基于多段独立地图序列的一致性高效视觉惯性里程计算法 | |
CN114842224A (zh) | 一种基于地理底图的单目无人机绝对视觉匹配定位方案 | |
Xiaoqian et al. | Nonlinear extended Kalman filter for attitude estimation of the fixed-wing UAV | |
CN113379915A (zh) | 一种基于点云融合的行车场景构建方法 | |
CN110864685A (zh) | 一种基于松耦合的车辆单目视觉轮式里程计定位方法 | |
CN113124854A (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 |