CN108594802A - 探测器目标着陆区域确定及避障制导方法与装置 - Google Patents

探测器目标着陆区域确定及避障制导方法与装置 Download PDF

Info

Publication number
CN108594802A
CN108594802A CN201810168097.5A CN201810168097A CN108594802A CN 108594802 A CN108594802 A CN 108594802A CN 201810168097 A CN201810168097 A CN 201810168097A CN 108594802 A CN108594802 A CN 108594802A
Authority
CN
China
Prior art keywords
detector
touchdown area
target
engine
guidance
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
CN201810168097.5A
Other languages
English (en)
Other versions
CN108594802B (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 Control Engineering
Original Assignee
Beijing Institute of Control 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 Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN201810168097.5A priority Critical patent/CN108594802B/zh
Publication of CN108594802A publication Critical patent/CN108594802A/zh
Application granted granted Critical
Publication of CN108594802B publication Critical patent/CN108594802B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Navigation (AREA)

Abstract

本发明提供一种探测器目标着陆区域确定及避障制导方法与装置,属于航天器制导、导航与控制技术领域。所述方法包括:当探测器转入动力下降过程时,获取天体表面着陆区域图像,并判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域。本发明既实现了初步避障制导,又避免了背罩等抛弃物在动力下降过程中对探测器的干扰、碰撞等影响,显著减少了动力减速过程中的推进剂消耗。

Description

探测器目标着陆区域确定及避障制导方法与装置
技术领域
本发明涉及一种探测器目标着陆区域确定方法、装置及避障制导方法与装置,属于航天器制导、导航与控制技术领域。
背景技术
天体探测器在着陆时,需要规避天体表面障碍物,目前常规避障方法包括:通过探测器上配置的光学相机采集天体表面图像,根据图像信息确定天体表面安全着落点,实现对障碍物的避让,例如,嫦娥系列月球软着陆动力下降过程采用上述方法进行避障。
随着航天技术的发展,人类对火星的探索研究需求日益强烈,相比月球环境,火星表面具有大气层,因而探测器通常采用伞降的方式进行减速,当速度降低到一定程度时,会抛掉伞和背罩,转入动力下降过程。
现有避障方法无法规避伞和背罩等抛弃物可能对探测器造成的影响。
发明内容
本技术发明的解决问题是:克服现有技术的不足,提供一种探测器目标着陆区域确定及避障制导方法与装置,既实现了初步避障制导,又避免了背罩等抛弃物在动力下降过程中对探测器的干扰、碰撞等影响,显著减少了动力减速过程中的推进剂消耗。
本发明目的通过以下技术方案予以实现:
一种探测器目标着陆区域确定方法,包括:
当探测器转入动力下降过程时,获取天体表面着陆区域图像,并判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;
若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;
若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域。
一种探测器避障制导方法,包括:
当探测器转入动力下降过程时,获取天体表面着陆区域图像,并判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;
若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;
若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域;
根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息,确定发动机开机时间,所述偏置角为发动机推力与所述探测器的速度反方向之间的夹角;
根据所述目标着陆区域及所述的偏置角,确定发动机常推力方向;
根据所述发动机开机时间及发动机常推力方向,发送发动机常推力开机指令以控制发动机进入常推力工作模式实现避障制导。
在一可选实施例中,所述发送发动机常推力开机指令以控制发动机进入常推力工作模式实现避障制导之后,还包括:
获取所述目标着陆区域的图像,并根据所述目标着陆区域的图像确定当前安全着陆点位置;
根据所述当前安全着陆点位置、探测器的初始状态信息及探测器的目标状态信息,确定发动机变推力大小和方向,以使所述发动机进入变推力工作模式实现变推力制导。
在一可选实施例中,所述状态信息包括重力加速度、高度及速度,所述根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息,确定发动机开机时间,包括:
根据式(1),确定发动机开机后探测器在当地垂向方向上的加速度大小atmp
根据式(2),确定发动机开机时的垂向速度vtmp
根据式(3),确定发动机开机时间tstart
其中,Fmax为发动机最大推力,θmax为偏置角,m0为探测器的初始质量,h0为探测器的初始高度,hf为探测器的目标高度,dh0为探测器的初始垂向速度,g为重力加速度,θ为探测器的初始速度与当地垂向夹角。
在一可选实施例中,所述根据所述目标着陆区域及所述的偏置角,确定发动机常推力方向,包括:
确定所述目标着陆区域的方向矢量;
根据所述探测器的速度方向及所述偏置角,确定发动机常推力偏置方向;
根据所述目标着陆区域的方向矢量及发动机常推力偏置方向,确定发动机常推力方向。
在一可选实施例中,所述根据所述目标着陆区域的图像确定当前安全着陆点位置,包括:
根据所述目标着陆区域的图像,确定安全着陆点方向;
根据所述安全着陆点方向计算所述目标着陆区域图像的成像时刻对应的安全着陆点位置;
根据天体自转角速度及所述成像时刻对应的安全着陆点位置,计算当前时刻安全着陆点的位置。
在一可选实施例中,所述状态信息包括重力加速度、高度及速度,根据所述当前安全着陆点位置、探测器的初始状态信息及探测器的目标状态信息,确定发动机变推力大小和方向,包括:
根据式(4),确定发动机制导剩余时间tgo
根据式(5),确定发动机变推力F的大小和方向;
其中:af、vf和hf分别为探测器的目标垂向加速度、目标垂向速度和目标高度,h和dh分别为探测器当前高度和垂向速度,m为探测器的质量,atG、vtG和rtG分别为探测器在制导坐标系下的目标加速度、目标速度和位置,rG=CGI(rI-rLI),vG=CGIvBI,CGI为由惯性坐标系到制导坐标系的转换矩阵,rI为探测器惯性位置矢量,rLI为安全着陆点位置矢量,vBI为探测器相对天体表面的速度矢量。
一种探测器目标着陆区域确定装置,包括:
获取模块,用于当探测器转入动力下降过程时,获取天体表面着陆区域图像;
判断模块,用于判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;
确定模块,用于若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域。
一种探测器避障制导装置,包括:
目标着陆区域确定模块,用于当探测器转入动力下降过程时,获取天体表面着陆区域图像,并判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域;
开机时间确定模块,用于根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息,确定发动机开机时间,所述偏置角为发动机推力与所述探测器的速度反方向之间的夹角;
常推力方向确定模块,用于根据所述目标着陆区域及所述的偏置角,确定发动机常推力方向;
指令发送模块,用于根据所述发动机开机时间及发动机常推力方向,发送发动机常推力开机指令以控制发动机进入常推力工作模式实现避障制导。
在一可选实施例中,所述的探测器避障制导装置,还包括:
安全着陆点位置确定模块,用于获取所述目标着陆区域的图像,并根据所述目标着陆区域的图像确定当前安全着陆点位置;
变推力确定模块,用于根据所述当前安全着陆点位置、探测器的初始状态信息及探测器的目标状态信息,确定发动机变推力大小和方向,以使所述发动机进入变推力工作模式实现变推力制导。
在一可选实施例中,所述状态信息包括重力加速度、高度及速度,所述开机时间确定模块,用于:
根据式(1),确定发动机开机后探测器在当地垂向方向上的加速度大小atmp
根据式(2),确定发动机开机时的垂向速度vtmp
根据式(3),确定发动机开机时间tstart
其中,Fmax为发动机最大推力,θmax为偏置角,m0为探测器的初始质量,h0为探测器的初始高度,hf为探测器的目标高度,dh0为探测器的初始垂向速度,g为重力加速度,θ为探测器的初始速度与当地垂向夹角。
在一可选实施例中,所述常推力方向确定模块,用于:
确定所述目标着陆区域的方向矢量;
根据所述探测器的速度方向及所述偏置角,确定发动机常推力偏置方向;
根据所述目标着陆区域的方向矢量及发动机常推力偏置方向,确定发动机常推力方向。
在一可选实施例中,所述安全着陆点位置确定模块,用于:
根据所述目标着陆区域的图像,确定安全着陆点方向;
根据所述安全着陆点方向计算所述目标着陆区域图像的成像时刻对应的安全着陆点位置;
根据天体自转角速度及所述成像时刻对应的安全着陆点位置,计算当前时刻安全着陆点的位置。
在一可选实施例中,所述状态信息包括重力加速度、高度及速度,所述变推力确定模块,用于:
根据式(4),确定发动机制导剩余时间tgo
根据式(5),确定发动机变推力F的大小和方向;
其中:af、vf和hf分别为探测器的目标垂向加速度、目标垂向速度和目标高度,h和dh分别为探测器当前高度和垂向速度,m为探测器的质量,atG、vtG和rtG分别为探测器在制导坐标系下的目标加速度、目标速度和位置,rG=CGI(rI-rLI),vG=CGIvBI,CGI为由惯性坐标系到制导坐标系的转换矩阵,rI为探测器惯性位置矢量,rLI为安全着陆点位置矢量,vBI为探测器相对天体表面的速度矢量。
本发明具有如下有益效果:
(1)本发明实施例提供的探测器目标着陆区域确定方法,通过探测器的速度方向与当地垂向方向的夹角的大小制定不同的目标着陆区域确定方案,以根据目标着陆区域进行制导,既实现了初步避障制导,又避免了背罩等抛弃物在动力下降过程中对探测器的干扰、碰撞等影响,显著减少了动力减速过程中的推进剂消耗;
(2)通过根据安全着陆点位置进行变推力制导,可以实现精确的避障,进一步提高了规避障碍物的能力。
附图说明
图1为本发明实施例提供的一种探测器目标着陆区域确定方法流程图;
图2为本发明实施例提供的一种探测器避障制导方法流程图;
图3为本发明实施例提供的一种探测器目标着陆区域确定装置结构示意图;
图4为本发明实施例提供的一种探测器避障制导装置结构示意图。
具体实施方式
下面结合附图对本发明作进一步详细说明:
参见图1,本发明实施例提供了一种探测器目标着陆区域确定方法,包括:
步骤101:当探测器转入动力下降过程时,获取天体表面着陆区域图像,并判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;
具体地,本发明实施例中,所述天体为具有大气层的天体,如火星;所述探测器为采用伞降方式减速的探测器,当减到预设速度时抛掉伞和背罩等抛弃物,进入动力下降过程,抛弃物抛出时,抛弃物速度方向与探测器速度方向一致;本发明实施例中,可以通过光学相机获取天体表面着陆区域图像;
具体地,本发明实施例中,所述夹角的最大值优选3-7°;可以通过常规图像处理获取探测器的速度方向与当地垂向方向的夹角;
若是,则进行步骤102:根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;
具体地,本发明实施例中,以速度矢量在图像平面上的投影为分界线,将所述着陆区域图像划分成两个子区域,可以通过常规图像处理手段,确定障碍物多少;
若否,则进行步骤103:以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域;
具体地,本发明实施例中,以所述着陆区域图像的像平面几何中心为中心,以沿像素行和列方向为界,将所述着陆区域图像划分成四个子区域;在其他实施例中,还可以根据图像的两条对角线将图像划分成四个子区域,本发明不作限定;本发明实施例提供的探测器目标着陆区域确定方法,通过探测器的速度方向与当地垂向方向的夹角的大小制定不同的目标着陆区域确定方案,以根据目标着陆区域进行制导,既实现了初步避障制导,又避免了背罩等抛弃物在动力下降过程中对探测器的干扰、碰撞等影响,显著减少了动力减速过程中的推进剂消耗。
本发明实施例还提供了一种探测器避障制导方法,包括:
步骤201:确定目标着陆区域;
具体地,本发明实施例中,采用上述目标着陆区域确定方法实施例确定目标着陆区域,具体描述参见上述方法实施例;
步骤202:根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息,确定发动机开机时间,所述偏置角为发动机推力与所述探测器的速度反方向之间的夹角;
具体地,本发明实施例中,偏置角的大小可以根据需要设置,优选30°,当偏置角为30°时,既能规避抛弃物,又能保证探测器能进行正常减速;所述状态信息可以包括质量、重力加速度、速度、位置等信息;
步骤203:根据所述目标着陆区域,确定发动机常推力方向;
具体地,本发明实施例中,以探测器的速度反方向为常推力的标准方向,常推力方向由标准方向向目标着陆区域方向偏置,偏置的角度为上述预设偏置角;所述根据所述目标着陆区域及所述的偏置角,确定发动机常推力方向,包括:确定所述目标着陆区域的方向矢量;根据所述目标着陆区域的方向矢量及所述偏置角,确定发动机常推力偏置角度及方向;根据所述探测器的速度方向及发动机常推力偏置角度及方向,确定发动机常推力方向。
步骤204:根据所述发动机开机时间及发动机常推力方向,发送发动机常推力开机指令以控制发动机进入常推力工作模式实现避障制导。
本发明实施例提供的探测器避障制导方法,通过探测器的速度方向与当地垂向方向的夹角的大小制定不同的目标着陆区域确定方案,根据目标着陆区域确定发动机常推力方向,根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息确定开机时间,以控制发动机工作实现制导,既实现了初步避障,又避免了背罩等抛弃物在动力下降过程中对探测器的干扰、碰撞等影响,显著减少了动力减速过程中的推进剂消耗。
进一步地,所述发送发动机常推力开机指令以控制发动机进入常推力工作模式实现避障制导之后,还包括:
步骤301:获取所述目标着陆区域的图像,并根据所述目标着陆区域的图像确定当前安全着陆点位置;
具体地,本发明实施例中可以根据图像处理方法确定安全着陆点位置;
步骤302:根据所述当前安全着陆点位置、探测器的初始状态信息及探测器的目标状态信息,确定发动机变推力大小和方向,以使所述发动机进入变推力工作模式实现变推力制导。
通过根据安全着陆点位置进行变推力制导,可以实现精确的避障,进一步提高了规避障碍物的能力。
在一可选实施例中,所述状态信息包括重力加速度、高度及速度,所述根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息,确定发动机开机时间,包括:
根据式(1),确定探测器在当地垂向方向上的加速度大小atmp
根据式(2)确定发动机开机时的垂向速度vtmp
根据式(3),确定发动机开机时间tstart
其中,Fmax为发动机最大推力,θmax为偏置角,m0为探测器的初始质量,h0为探测器的初始高度,hf为探测器的目标高度,dh0为探测器的初始垂向速度,g为重力加速度,θ为探测器的初始速度与当地垂向夹角。
在一可选实施例中,所述根据所述目标着陆区域的图像确定当前安全着陆点位置,包括:
根据所述目标着陆区域的图像,确定安全着陆点方向;
根据所述安全着陆点方向计算所述目标着陆区域的图像的成像时刻对应的安全着陆点位置;
根据天体自转角速度及所述成像时刻对应的安全着陆点位置,计算当前时刻安全着陆点的位置。
在一可选实施例中,所述状态信息包括重力加速度、高度及速度,所述根据所述当前安全着陆点位置、探测器的初始状态信息及探测器的目标状态信息,确定发动机变推力大小和方向,包括:
根据式(4),确定发动机制导剩余时间tgo
根据式(5),确定发动机变推力F的大小和方向;
其中:af、vf和hf分别为探测器的目标垂向加速度、目标垂向速度和目标高度,h和dh分别为探测器当前高度和垂向速度,m为探测器的质量,atG、vtG和rtG分别为探测器在制导坐标系下的目标加速度、目标速度和位置,rG=CGI(rI-rLI),vG=CGIvBI,CGI为由惯性坐标系到制导坐标系的转换矩阵,rI为探测器惯性位置矢量,rLI为安全着陆点位置矢量,vBI为探测器相对天体表面的速度矢量。
具体地,本发明实施例中,所述制导坐标系为以着陆点为原点,指向天向为x轴正向,以指向东向为y轴正向,以指向北向为z轴正向的天东北坐标系。
以下为本发明的一具体实施例:
本实施例提供了一种探测器避障制导方法,包括:
第一步,确定目标着陆区域:
利用光学成像敏感器获取着陆区图像信息,根据探测器的惯性位置矢量和速度矢量确定目标着陆区方向矢量;
定义rI为探测器惯性位置矢量,vBI为探测器相对天体表面的速度矢量,ωOrbit为探测器轨道法线方向,Tm0为目标着陆区域方向矢量,Tm01为根据光学图像获取的安全着陆区域方向矢量。
(1)基于探测器惯性位置和速度矢量计算探测器速度方向与当地垂向夹角θ:
(2)根据速度方向与当地垂向夹角确定目标着陆区方向矢量:
若θ>5°,则
否则
Tm0=Tm01 (9)
第二步,根据所述目标着陆区域,确定发动机常推力方向:
(1)计算发动机开机时间tstart
根据式(1),确定探测器在当地垂向方向上的加速度大小atmp
根据式(2),确定发动机开机时的垂向速度vtmp
根据式(3),确定发动机开机时间tstart
其中,Fmax为发动机最大推力,θmax为偏置角,m0为探测器的初始质量,h0为探测器的初始高度,hf为探测器的目标高度,dh0为探测器的初始垂向速度,g为重力加速度,θ为探测器的初始速度与当地垂向夹角。
(2)根据所述目标着陆区域,确定发动机常推力方向:
Tv=VectorRotation(Tv0,E0max) (12)
其中,Tv0为探测器速度反方向,Tm0为目标着陆区域方向,
Tv=VectorRotation(Tv0,E0max)表示将矢量Tv0绕E0旋转θmax角得到最终制导常推力方向Tv
第三步,精避障变推力制导:
(1)确定目标着陆区域图像的成像时刻对应的安全着陆点位置:
定义rLOSI为光学避障敏感器获取的安全着陆点视线方向。根据成像时刻探测器位置rI0和高度h0可计算成像时刻对应的安全着陆点位置rLI0
(2)计算当前时刻安全着陆点的位置:
定义ωmI为天体自转角速度,则自转角速度的方向u为:
利用四元数表示的由于天体旋转带来坐标基准变化为:
其中Φ=||ωmI||t,t为与成像时刻的时间间隔,随着天体的旋转,当前安全着陆点位置为:
rLI=Aq(qm)rLI0 (16)
其中Aq(qm)表示由四元数qm得到的旋转矩阵。
(3)制导剩余时间tgo计算:
根据式(4),确定发动机制导剩余时间tgo
其中,af、vf和hf分别为探测器的目标垂向加速度、目标垂向速度和目标高度,h和dh分别为探测器当前高度和垂向速度;
(4)根据式(5),确定发动机变推力F的大小和方向;
其中,m为探测器质量,atG、vtG和rtG分别为探测器在制导坐标系下的目标加速度、目标速度和位置,具体地:
atG=[af 0 0]T
vtG=[vf 0 0]T
rtG=[hf 0 0]T
rG、vG分别为制导系下当前制导位置和速度:
rG=CGI(rI-rLI)
vG=CGIvBI
其中CGI为由惯性坐标系到制导坐标系的转换矩阵,rI为探测器惯性位置矢量,rLI为安全着陆点位置矢量,vBI为探测器相对天体表面的速度矢量。
参见图3,本发明实施例还提供了一种探测器目标着陆区域确定装置,包括:
获取模块10,用于当探测器转入动力下降过程时,获取天体表面着陆区域图像;
判断模块20,用于判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;
确定模块30,用于若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域。
参见图4,本发明实施例还提供了一种探测器避障制导装置,包括:
目标着陆区域确定模块1,用于当探测器转入动力下降过程时,获取天体表面着陆区域图像,并判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域;
开机时间确定模块2,用于根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息,确定发动机开机时间,所述偏置角为发动机推力与所述探测器的速度反方向之间的夹角;
常推力方向确定模块3,用于根据所述目标着陆区域及所述的偏置角,确定发动机常推力方向;
指令发送模块4,用于根据所述发动机开机时间及发动机常推力方向,发送发动机常推力开机指令以控制发动机进入常推力工作模式实现避障制导。
在一可选实施例中,所述的探测器避障制导装置,还包括:
安全着陆点位置确定模块,用于获取所述目标着陆区域的图像,并根据所述目标着陆区域的图像确定当前安全着陆点位置;
变推力确定模块,用于根据所述当前安全着陆点位置、探测器的初始状态信息及探测器的目标状态信息,确定发动机变推力大小和方向,以使所述发动机进入变推力工作模式实现变推力制导。
在一可选实施例中,所述状态信息包括重力加速度、高度及速度,所述开机时间确定模块,用于:
根据式(1),确定发动机开机后探测器在当地垂向方向上的加速度大小atmp
根据式(2),确定发动机开机时的垂向速度vtmp
根据式(3),确定发动机开机时间tstart
其中,Fmax为发动机最大推力,θmax为偏置角,m0为探测器的初始质量,h0为探测器的初始高度,hf为探测器的目标高度,dh0为探测器的初始垂向速度,g为重力加速度,θ为探测器的初始速度与当地垂向夹角。
在一可选实施例中,所述常推力方向确定模块,用于:
确定所述目标着陆区域的方向矢量;
根据所述探测器的速度方向及所述偏置角,确定发动机常推力偏置方向;
根据所述目标着陆区域的方向矢量及发动机常推力偏置方向,确定发动机常推力方向。
在一可选实施例中,所述安全着陆点位置确定模块,用于:
根据所述目标着陆区域的图像,确定安全着陆点方向;
根据所述安全着陆点方向计算所述目标着陆区域图像的成像时刻对应的安全着陆点位置;
根据天体自转角速度及所述成像时刻对应的安全着陆点位置,计算当前时刻安全着陆点的位置。
在一可选实施例中,所述状态信息包括重力加速度、高度及速度,所述变推力确定模块,用于:
根据式(4),确定发动机制导剩余时间tgo
根据式(5),确定发动机变推力F的大小和方向;
其中:af、vf和hf分别为探测器的目标垂向加速度、目标垂向速度和目标高度,h和dh分别为探测器当前高度和垂向速度,m为探测器的质量,atG、vtG和rtG分别为探测器在制导坐标系下的目标加速度、目标速度和位置,rG=CGI(rI-rLI),vG=CGIvBI,CGI为由惯性坐标系到制导坐标系的转换矩阵,rI为探测器惯性位置矢量,rLI为安全着陆点位置矢量,vBI为探测器相对天体表面的速度矢量。
本发明装置实施例与方法实施例一一对应,具有方法实施例所具有的所有有益效果,详细描述参见对应的方法实施例,在此不再赘述。
本发明未详细说明部分属于本领域技术人员公知常识。所述的具体实施例仅是对本发明精神作举例说明。本发明所属技术领域的人员可以对所述的具体实施例做不同的修改或补充或采用类似的方式代替,但不偏离本发明的精神或者超越所附权利要求书所定义的范围。
本发明未详细说明部分属于本领域技术人员公知常识。

Claims (10)

1.一种探测器目标着陆区域确定方法,其特征在于,包括:
当探测器转入动力下降过程时,获取天体表面着陆区域图像,并判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;
若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;
若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域。
2.一种探测器避障制导方法,其特征在于,包括:
当探测器转入动力下降过程时,获取天体表面着陆区域图像,并判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;
若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;
若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域;
根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息,确定发动机开机时间,所述偏置角为发动机推力与所述探测器的速度反方向之间的夹角;
根据所述目标着陆区域及所述的偏置角,确定发动机常推力方向;
根据所述发动机开机时间及发动机常推力方向,发送发动机常推力开机指令以控制发动机进入常推力工作模式实现避障制导。
3.根据权利要求2所述的探测器避障制导方法,其特征在于,所述发送发动机常推力开机指令以控制发动机进入常推力工作模式实现避障制导之后,还包括:
获取所述目标着陆区域的图像,并根据所述目标着陆区域的图像确定当前安全着陆点位置;
根据所述当前安全着陆点位置、探测器的初始状态信息及探测器的目标状态信息,确定发动机变推力大小和方向,以使所述发动机进入变推力工作模式实现变推力制导。
4.根据权利要求2或3所述的探测器避障制导方法,其特征在于,所述状态信息包括重力加速度、高度及速度,所述根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息,确定发动机开机时间,包括:
根据式(1),确定发动机开机后探测器在当地垂向方向上的加速度大小atmp
根据式(2),确定发动机开机时的垂向速度vtmp
根据式(3),确定发动机开机时间tstart
其中,Fmax为发动机最大推力,θmax为偏置角,m0为探测器的初始质量,h0为探测器的初始高度,hf为探测器的目标高度,dh0为探测器的初始垂向速度,g为重力加速度,θ为探测器的初始速度与当地垂向夹角。
5.根据权利要求2所述的探测器避障制导方法,其特征在于,所述根据所述目标着陆区域及所述的偏置角,确定发动机常推力方向,包括:
确定所述目标着陆区域的方向矢量;
根据所述目标着陆区域的方向矢量及所述偏置角,确定发动机常推力偏置角度及方向;
根据所述探测器的速度方向及发动机常推力偏置角度及方向,确定发动机常推力方向。
6.根据权利要求3所述的探测器避障制导方法,其特征在于,所述根据所述目标着陆区域的图像确定当前安全着陆点位置,包括:
根据所述目标着陆区域的图像,确定安全着陆点方向;
根据所述安全着陆点方向计算所述目标着陆区域图像的成像时刻对应的安全着陆点位置;
根据天体自转角速度及所述成像时刻对应的安全着陆点位置,计算当前时刻安全着陆点的位置。
7.根据权利要求3所述的探测器避障制导方法,其特征在于,所述状态信息包括重力加速度、高度及速度,根据所述当前安全着陆点位置、探测器的初始状态信息及探测器的目标状态信息,确定发动机变推力大小和方向,包括:
根据式(4),确定发动机制导剩余时间tgo
根据式(5),确定发动机变推力F的大小和方向;
其中:af、vf和hf分别为探测器的目标垂向加速度、目标垂向速度和目标高度,h和dh分别为探测器当前高度和垂向速度,m为探测器的质量,atG、vtG和rtG分别为探测器在制导坐标系下的目标加速度、目标速度和位置,rG=CGI(rI-rLI),vG=CGIvBI,CGI为由惯性坐标系到制导坐标系的转换矩阵,rI为探测器惯性位置矢量,rLI为安全着陆点位置矢量,vBI为探测器相对天体表面的速度矢量。
8.一种探测器目标着陆区域确定装置,其特征在于,包括:
获取模块,用于当探测器转入动力下降过程时,获取天体表面着陆区域图像;
判断模块,用于判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;
确定模块,用于若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域。
9.一种探测器避障制导装置,其特征在于,包括:
目标着陆区域确定模块,用于当探测器转入动力下降过程时,获取天体表面着陆区域图像,并根据所述着陆区域图像判断所述探测器的速度方向与当地垂向方向的夹角是否在预设范围内;若是,则根据所述探测器的速度方向,将所述着陆区域图像划分成两个子区域,将障碍物少的子区域作为目标着陆区域;若否,则以所述着陆区域图像的几何中心为中心,将所述着陆区域图像划分成四个子区域,将障碍物少的子区域作为目标着陆区域;
开机时间确定模块,用于根据预设的偏置角、探测器的初始状态信息及探测器的目标状态信息,确定发动机开机时间,所述偏置角为发动机推力与所述探测器的速度反方向之间的夹角;
常推力方向确定模块,用于根据所述目标着陆区域及所述的偏置角,确定发动机常推力方向;
指令发送模块,用于根据所述发动机开机时间及发动机常推力方向,发送发动机常推力开机指令以控制发动机进入常推力工作模式实现避障制导。
10.根据权利要求9所述的探测器避障制导装置,其特征在于,还包括:
安全着陆点位置确定模块,用于获取所述目标着陆区域的图像,并根据所述目标着陆区域的图像确定当前安全着陆点位置;
变推力确定模块,用于根据所述当前安全着陆点位置、探测器的初始状态信息及探测器的目标状态信息,确定发动机变推力大小和方向,以使所述发动机进入变推力工作模式实现变推力制导。
CN201810168097.5A 2018-02-28 2018-02-28 探测器目标着陆区域确定及避障制导方法与装置 Active CN108594802B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810168097.5A CN108594802B (zh) 2018-02-28 2018-02-28 探测器目标着陆区域确定及避障制导方法与装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810168097.5A CN108594802B (zh) 2018-02-28 2018-02-28 探测器目标着陆区域确定及避障制导方法与装置

Publications (2)

Publication Number Publication Date
CN108594802A true CN108594802A (zh) 2018-09-28
CN108594802B CN108594802B (zh) 2021-06-11

Family

ID=63625519

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810168097.5A Active CN108594802B (zh) 2018-02-28 2018-02-28 探测器目标着陆区域确定及避障制导方法与装置

Country Status (1)

Country Link
CN (1) CN108594802B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109460057A (zh) * 2018-11-16 2019-03-12 航宇救生装备有限公司 一种面向多目标的网格化翼伞归航方法
CN109696917A (zh) * 2019-01-28 2019-04-30 中国人民解放军军事科学院国防科技创新研究院 一种航天器自动交会避障方法及系统
CN110542423A (zh) * 2019-07-23 2019-12-06 北京控制工程研究所 一种月球软着陆垂直接近避障制导方法
CN111766883A (zh) * 2020-07-06 2020-10-13 北京理工大学 小天体协同附着鲁棒避障控制方法
CN112129318A (zh) * 2020-02-26 2020-12-25 上海航天控制技术研究所 一种基于加速度计反馈的火星探测轨道精确控制方法
CN113885542A (zh) * 2021-09-17 2022-01-04 北京控制工程研究所 一种用于火星着陆的多策略避障逻辑及控制方法
CN114019788A (zh) * 2021-10-08 2022-02-08 北京控制工程研究所 一种着陆过程基于分区的快速平移避障方法

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104590589A (zh) * 2014-12-22 2015-05-06 哈尔滨工业大学 基于燃料最优的火星探测器着陆制导方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104590589A (zh) * 2014-12-22 2015-05-06 哈尔滨工业大学 基于燃料最优的火星探测器着陆制导方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
ANDRES HUERTAS等: "Passive imaging based multi-cue hazard detection for spacecraft safe landing", 《2006 IEEE AEROSPACE CONFERENCE》 *
丁萌: "空间探测器着陆过程中的机器视觉关键技术研究", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 *
郭延宁等: "基于燃料最优解的火星精确着陆制导策略研究", 《深空探测学报》 *
郭延宁等: "基于路径点优化的火星着陆器动力下降段反馈制导律研究", 《中国宇航学会深空探测技术专业委员会第九届学术年会论文集》 *

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109460057B (zh) * 2018-11-16 2021-10-15 航宇救生装备有限公司 一种面向多目标的网格化翼伞归航方法
CN109460057A (zh) * 2018-11-16 2019-03-12 航宇救生装备有限公司 一种面向多目标的网格化翼伞归航方法
CN109696917A (zh) * 2019-01-28 2019-04-30 中国人民解放军军事科学院国防科技创新研究院 一种航天器自动交会避障方法及系统
CN110542423A (zh) * 2019-07-23 2019-12-06 北京控制工程研究所 一种月球软着陆垂直接近避障制导方法
CN110542423B (zh) * 2019-07-23 2021-06-11 北京控制工程研究所 一种月球软着陆垂直接近避障制导方法
CN112129318B (zh) * 2020-02-26 2022-10-14 上海航天控制技术研究所 一种基于加速度计反馈的火星探测轨道精确控制方法
CN112129318A (zh) * 2020-02-26 2020-12-25 上海航天控制技术研究所 一种基于加速度计反馈的火星探测轨道精确控制方法
CN111766883B (zh) * 2020-07-06 2021-06-15 北京理工大学 小天体协同附着鲁棒避障控制方法
CN111766883A (zh) * 2020-07-06 2020-10-13 北京理工大学 小天体协同附着鲁棒避障控制方法
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
CN108594802B (zh) 2021-06-11

Similar Documents

Publication Publication Date Title
CN108594802A (zh) 探测器目标着陆区域确定及避障制导方法与装置
CN106708066B (zh) 基于视觉/惯导的无人机自主着陆方法
CN104326093B (zh) 光学成像小卫星姿态控制系统及工作模式在轨切换方法
CN1039301C (zh) 卫星姿态控制的测试设备及其应用
CN107600464B (zh) 利用星敏感器信息的飞轮控制捕获太阳及对日定向方法
CN110174899A (zh) 一种基于敏捷卫星的高精度成像姿态指向控制方法
US20140236398A1 (en) Vision-Based Aircraft Landing Aid
CN105160125B (zh) 一种星敏感器四元数的仿真分析方法
CN105956233B (zh) 太阳同步轨道卫星单视场星敏感器安装指向设计方法
JP2017065467A (ja) 無人機およびその制御方法
CN105159321B (zh) 一种基于无人飞行器的拍照方法和无人飞行器
JPH0577245B2 (zh)
CN106814753A (zh) 一种目标位置矫正方法、装置及系统
JPH0133400B2 (zh)
CN104061904B (zh) 一种确定林窗形状和面积的方法
CN101592490A (zh) 一种自适应控阵星敏感器
CN109373998A (zh) 基于多传感器数据的旋转体姿态测量方法
KR20140037998A (ko) 구조물 점검용 비행 장치
CN210201937U (zh) 一种影像采集装置
CN106959097A (zh) 一种基于飞艇的光电经纬仪交会测量系统及方法
CN106672265B (zh) 一种基于光流信息的小天体定点着陆制导控制方法
CN110300941A (zh) 一种云台的转动控制方法、装置及控制设备、移动平台
Palomino et al. Control strategy using vision for the stabilization of an experimental PVTOL aircraft setup
US8538606B2 (en) Systems, methods, and apparatus for sensing flight direction of a spacecraft
CN103955138A (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