一种融合相对高度和绝对高度获得导航高度的方法技术

一种融合相对高度和绝对高度获得导航高度的方法，它有五大步骤：一、采用相对高度测量计，获取飞行器距离地面的相对高度hrelat；二、采用绝对高度测量计，获取飞行器的绝对高度habs；三、根据相对高度hrelat的大小，确定导航高度来源；四、若上述步骤三确定导航高度来源为绝对高度habs，使用绝对高度habs计算导航高度hNavi；五、若上述步骤三确定导航高度来源为相对高度hrelat，使用相对高度hrelat和地面海拔高度hground计算导航高度hNavi，然后计算并记录导航高度hNavi与绝对高度habs的差值hoffset。本发明专利技术提高了导航高度的可靠性和准确性；飞行器近地飞行时，跟随上升地形飞行，而跟随下降地形飞行时可及时切出并返回到期望高度，从而保障飞行安全。

【技术实现步骤摘要】
一种融合相对高度和绝对高度获得导航高度的方法
本专利技术涉及一种融合相对高度和绝对高度获得导航高度的方法，它是用于获得无人飞行器导航高度的方法，通过融合相对高度和绝对高度，得到精确可靠的导航高度，主要用于无人飞行器导航控制

技术介绍
无人飞行器的飞行高度获取方法包括使用绝对高度测量计获取绝对高度，使用相对高度测量计获取相对高度。绝对高度测量计包括GPS(GlobalPositioningSystem)定位系统、气压高度计等仪器；相对高度测量计包括超声波高度测量计、激光高度测量计、无线电高度测量计等仪器。绝对高度测量计测量范大，可在飞行器整个升限内使用。但是在靠近地面时，易受周围建筑物、树木、天气变化等因素影响而使测量精度降低甚至失效，因此使用绝对高度直接作为导航高度将给飞行控制系统带来极大地不确定性和不可靠性，尤其在无人飞行器的起飞和着陆阶段，绝对高度无法满足飞行控制系统对高度通道的控制要；而且，绝对高度无法反映地面海拔高度的变化情况，因此使用绝对高度导航，无人飞行器无法获得距离地面的相对高度数据，从而无法保障近地飞行时的飞行安全。相对高度测量计可以获取飞行器距离地面的相对高度数据，但是测量范围小，在飞行器远离地面飞行时，相对高度会超出相对高度测量计的量程范围，造成相对高度无法作为导航高度使用。综合上述原因，无人飞行器通常同时搭载绝对高度测量计和相对高度测量计，获取绝对高度和相对高度共同作为导航高度。但是绝对高度和相对高度适用于导航的高度范围不同，物理形式也不同，两者共同作为导航高度时，会给飞行控制系统带来以下问题。一是导航高度来源切换的问题，无人飞行器从起飞到着陆，期间会执行一定的飞行任务，飞行控制系统需要根据飞行任务执行高度选择使用相对高度还是绝对高度作为导航高度。如果飞行任务执行高度距离地面较近，飞行过程中相对高度都在相对高度测量计量程范围以内，可以选用相对高度作为导航高度；如果飞行任务执行高度距离地面较远，飞行过程中相对高度在相对高度测量计量程范围以外，则必须选用绝对高度作为导航高度；如果飞行任务执行高度同时包括近地面和远地面，在飞行过程中相对高度既有在相对高度测量计量程范围内的阶段，也有在相对高度测量计量程范围外的阶段，则需要判断何时使用相对高度何时使用绝对高度。二是相对高度和绝对高度的物理形式不相同的问题，相对高度是指飞行器相对地面的垂直距离，绝对高度是指飞行器相对平均海平面的垂直距离，也叫“海拔高度”，在数值上差距较大，因此在相对高度和绝对高度共同作为导航高度时，需要将两者的物理形式统一：如果导航高度统一采用绝对高度形式，应将用于导航的相对高度转换为绝对高度；如果导航高度统一采用相对高度形式，则应将用于导航的绝对高度转换为相对高度。否则将导致导航高度的物理形式不明确，使飞行控制系统使用导航高度时发生错误，引发飞行事故。例如，飞行控制系统中的飞行期望高度为相对高度形式，当前值为100m，如果导航高度为绝对高度形式，当前值为500m，那么飞行控制系统将做出当前飞行高度远大于飞行期望高度的错误判断，从而使无人飞行器高度快速下降，如果此时地面海拔高度大于100m，就会发生触地坠毁的事故。三是导航高度在相对高度和绝对高度之间切换时存在高度跳变问题，不同的高度测量计测量精度和测量范围存在差别，因此，即使相对高度和绝对高度作为导航高度时转换为相同物理形式，但两者提供的高度数值仍存在不同。如果将来源于相对高度的导航高度和来源于绝对高度的导航高度直接切换，将引起导航高度值的跳变，从而使飞行控制系统输出的控制量发生跳变，引起飞行器的飞行高度和飞行姿态产生较大变化，甚至引发飞行事故。本专利技术通过融合相对高度和绝对高度，解决了将相对高度和绝对高度共同作为导航高度时存在的上述问题。首先，明确了导航高度的切换条件，在相对高度测量计量程范围内确定切换上限和切换下限，相对高度大于切换上限时，导航高度使用绝对高度，相对高度小于切换下限时，导航高度使用相对高度，切换上限和切换下限之间的区域作为缓冲区，相对高度位于此区间时，导航高度来源与进入该区间之前的高度来源相同，不发生切换，从而避免了因高度测量误差造成的导航高度的频繁切换。其次，统一了导航高度的物理形式，导航高度来源无论是相对高度还是绝对高度，导航高度都为绝对高度的物理形式，其中导航高度来源为相对高度时，通过相对高度加地面海拔高度的方法使导航高度转换为绝对高度形式；因此，飞行控制系统中使用的其他高度(如期望高度)可以统一采用绝对高度形式，避免了因物理形式不同而发生的导航事故。再次，设计了高度平滑功能，使导航高度来源切换时，导航高度可以平稳过渡，不会发生跳变。高度平滑功能通过适时调用高度平滑函数实现，在导航高度来源由相对高度切换为绝对高度时，调用高度平滑函数，逐步消除使用相对高度时的导航高度与绝对高度的差值，使切换平稳过渡；同时，在导航高度来源为相对高度时，若地面海拔高度被重新计算，同样调用高度平滑函数，逐步消除前后地面海拔高度的差值，防止导航高度跳变。最后，设计了地面海拔高度的更新机制，在导航高度来源由绝对高度切换为相对高度的周期，计算地面海拔高度，用于导航高度的计算；同时在导航高度来源为相对高度时，如果当前地面海拔高度与用于导航高度计算的地面海拔高度的差值超过设定阈值，则重新计算地面海拔高度。以上两种条件下对地面海拔高度的计算统称为地面海拔高度更新机制，通过更新地面海拔高度，可使飞行器的导航高度以绝对高度为真值得到校正，从而有利于导航高度来源由相对高度向绝对高度切换时的快速平稳过渡；而且，地面海拔高度的更新可使飞行器及时停止跟随下降地形飞行，返回到期望高度。
技术实现思路
本专利技术要解决的技术问题是：提供一种融合相对高度和绝对高度获得导航高度的方法，使飞行控制系统使用导航高度导航时无需判断飞行器所处高度和飞行任务执行高度，也无需考虑不同高度来源时导航高度的物理形式不一致和高度跳变问题；同时，导航高度兼具相对高度和绝对高度的优点，提高导航高度的精确可靠性。本专利技术解决其技术问题所采用的技术方案是：一种融合相对和绝对高度获得导航高度的方法，其特征在于，需要以下设备条件：(1)相对高度测量计，用于获取飞行器距离地面的相对高度，相对高度测量计可以是超声波高度测量计、激光高度测量计、无线电高度测量计等任何可获得飞行器距离地面相对高度的传感器；(2)绝对高度测量计，用于获取飞行器的绝对高度，绝对高度测量计可以是GPS(GlobalPositioningSystem)定位系统、气压高度计等任何可获得飞行器绝对高度的传感器；(3)导航计算机，用于接收上述相对高度和绝对高度，并根据相对高度的大小确定导航高度来源，通过融合相对高度和绝对高度获得导航高度。一种融合相对高度和绝对高度获得导航高度的方法，其特征在于，它包括以下步骤：步骤一：采用相对高度测量计，获取飞行器距离地面的相对高度hrelat；步骤二：采用绝对高度测量计，获取飞行器的绝对高度habs；步骤三：根据相对高度hrelat的大小，确定导航高度来源，该步骤的实施需要以下条件：在相对高度测量计的量程范围内，设定导航高度来源切换上限hmax_limit和切换下限hmin_limit；确定导航高度来源的具体方法为：若相对高度本文档来自技高网...

【技术保护点】
一种融合相对高度和绝对高度获得导航高度的方法，其特征在于：它包括以下步骤：步骤一：采用相对高度测量计，获取飞行器距离地面的相对高度hrelat；步骤二：采用绝对高度测量计，获取飞行器的绝对高度habs；步骤三：根据相对高度hrelat的大小，确定导航高度来源，该步骤的实施需要以下条件：在相对高度测量计的量程范围内，设定导航高度来源切换上限hmax_limit和切换下限hmin_limit；确定导航高度来源的具体方法为：若相对高度hrelat大于导航高度来源切换上限hmax_limit，导航高度来源选择为绝对高度；若相对高度hrelat小于导航高度来源切换下限hmin_limit，导航高度来源选择为相对高度；若相对高度hrelat位于导航高度来源切换下限hmin_limit和切换上限hmax_limit之间，导航高度来源与上一周期导航高度来源相同，不发生变化；步骤四：若上述步骤三确定导航高度来源为绝对高度habs，使用绝对高度habs计算导航高度hNavi；步骤五：若上述步骤三确定导航高度来源为相对高度hrelat，使用相对高度hrelat和地面海拔高度hground计算导航高度hNavi，然后计算并记录导航高度hNavi与绝对高度habs的差值hoffset。...

【技术特征摘要】
1.一种融合相对高度和绝对高度获得导航高度的方法，其特征在于：它包括以下步骤：步骤一：采用相对高度测量计，获取飞行器距离地面的相对高度hrelat；步骤二：采用绝对高度测量计，获取飞行器的绝对高度habs；步骤三：根据相对高度hrelat的大小，确定导航高度来源，该步骤的实施需要以下条件：在相对高度测量计的量程范围内，设定导航高度来源切换上限hmax_limit和切换下限hmin_limit；确定导航高度来源的具体方法为：若相对高度hrelat大于导航高度来源切换上限hmax_limit，导航高度来源选择为绝对高度；若相对高度hrelat小于导航高度来源切换下限hmin_limit，导航高度来源选择为相对高度；若相对高度hrelat位于导航高度来源切换下限hmin_limit和切换上限hmax_limit之间，导航高度来源与上一周期导航高度来源相同，不发生变化；步骤四：若上述步骤三确定导航高度来源为绝对高度habs，使用绝对高度habs计算导航高度hNavi；步骤五：若上述步骤三确定导航高度来源为相对高度hrelat，使用相对高度hrelat和地面海拔高度hground计算导航高度hNavi，然后计算并记录导航高度hNavi与绝对高度habs的差值hoffset；其中，步骤四中所述的“使用绝对高度habs计算导航高度hNavi”，其具体计算步骤为：(4.1)判断上一周期的导航高度来源是否为相对高度hrelat；(4.2)若步骤(4.1)确定上一周期的导航高度来源为相对高度hrelat，启用高度平滑函数，减小导航高度hNavi与绝对高度habs的差值hoffset，将高度平滑函数返回值赋值给变量hsmooth_offset；否则，不启用高度平滑函数；这里应注意，“启用”高度平滑函数是指“开始调用”高度平滑函数，在变量hsmooth_offset为0时，停止调用高度平滑函数；所述的“高度平滑函数”，其具体形式如下：公式(1)中函数fhan(x1(k)-v(k),x2(k),r,h1)的表达式如下：公式(2)中函数fsg(x,d)的表达式如下：y＝fsg(x,d)＝(sign(x+d)-sign(x-d))/2(3)公式(2)(3)中函数sign(x)为符号函数，具体表达式如下：其中，fh＝fhan(x1(k)-v(k),x2(k),r,h1)是二阶离散系统的最速控制函数，作用是使变量x1(k)以有限步从其初始值x1(0)到达期望值v(k)并跟踪期望值v(k)，v(k)既可以是变量也可以是常量；公式(1)(2)中主要参数的定义如下：h为离散系统的积分步长；r为快速因子，r取值越大，变量x1(k)对期望值v(k)的跟踪速度越快；h1为滤波因子，h1取值越小，变量x1(k)对期望值v(k)的跟踪速度越快；公式(1)(2)用作高度平滑函数时，在第一次被调用时，将x1(k)初始值x1(0)赋值为步骤五中“计算并记录的导航高度hNavi与绝对高度habs的差值hoffset”，期望值v(k)为常量0；因此调用高度平滑函数，将使导航高度hNavi与绝对高度habs的差值hoffset以有限步减小到0，高度平滑函数的返回值为x1(k)；(4.3)使用绝对高度habs和变量hsmooth_offset计算导航高度hNavi；其具体计算公式如下：hNavi＝habs+hsmooth_offset式中，hNavi为导航高度，habs为绝对高度，hsmooth_offset为高度平滑函数的返回值；以上步骤四的实施过程中，高度平滑函数的调用将使导航高度来源由相对高度切换为绝对高度时，不会发生导航高度的跳变，有利于对无人飞行器高度的控制。2.根据权利要求1所述的一种融合相对高度和绝对高度获得导航高度的方法，其特征在于：步骤五中所述的“使用相对高度hrelat和地面海拔高度hground计算导航高度...

【专利技术属性】
技术研发人员：蒙志君，陈旭智，林子豪，周尧明，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：北京;11