[发明专利]一种无人机无线电高度表高度及升降速度自动修正方法

权利要求书

1、一种无人机无线电高度表高度及升降速度自动修正方法，其特征在于包括如下步骤：

步骤一：根据飞机上每一个无线电高度表所测的高度H_cli和升降速度解算得到飞机重心处高度H_zxi及升降速度i代表无线电高度表的个数，i＝1，2，……n；由无线电高度表测得飞机的高度H_cli、飞机的俯仰角θ、滚转角γ、横滚角速度ω_x、偏航角速度ω_y、俯仰角速度ω_z，解算得到飞机重心O处高度H_zxi：

H_zxi＝H_cli-b_i·sinγ+l_i·sinθ+h_i·cosθ·cosγ

对上式进行求导，解算飞机重心O处升降速度

H·zxi=H·cli-bi·cosγ·γ·+li·cosθ·θ·-hisinθ·θ··cosγ-hisinγ·γ··cosθ]]>

其中，γ·=ωx-tgθ·(ωy·cosγ-ωz·sinγ)θ·=ωy·sinγ+ωz·cosγ;]]>

步骤二：对飞机重心处高度H_zxi及升降速度进行信号表决得到信号表决结果H_yd及

步骤三：起飞时计算无线电高度表的系统偏差ΔH；

ΔH＝H₀-H_yd

其中H₀为已知的起飞时飞机重心位置离地距离；

步骤四：根据系统偏差ΔH对起飞前的无线电高度表信号表决结果进行修正；使得飞机起飞时位于地面状态的真实高度与已知的起飞时飞机重心位置离地距离H₀相等：

H_起飞时＝H_yd+ΔH＝H₀

步骤五：在后续的飞行及着陆过程中，重复步骤一和步骤二，实时得到信号表决结果H_yd及并由步骤三中得到的无线电高度表的系统偏差ΔH得到真实飞行高度H和升降速度

H=Hyd+ΔHH·=H·yd.]]>