[发明专利]无人飞行器的控制方法、飞行控制器及无人飞行器

摘要

本发明实施例提供一种无人飞行器的控制方法、飞行控制器及无人飞行器，该方法包括：获取第一探测设备的第一探测值，以及第二探测设备的第二探测值；根据第一探测值和第二探测值，确定无人飞行器(100)距离下方地面的高度。本发明实施例通过无人飞行器(100)上设置的两个探测设备分别探测无人飞行器(100)距离其正下方地面的高度，以及距离其斜前方地面的距离，根据无人飞行器(100)距离其正下方地面的高度和距离其斜前方地面的垂直高度，确定出无人飞行器(100)距离其下方地面的高度，提高了无人飞行器(100)距离其下方地面高度的计算精度，根据该高度进行地形跟随，提高了无人飞行器(100)地形跟随的精确度。

主权项

1.一种无人飞行器的控制方法，其特征在于，所述无人飞行器包括第一探测设备和第二探测设备，所述第一探测设备和所述第二探测设备分别用于测量所述无人飞行器距离地面的高度，所述第一探测设备的探测方向与所述无人飞行器的偏航轴方向成预设角度，所述第二探测设备的探测方向沿所述无人飞行器的偏航轴方向设置；所述方法包括：获取所述第一探测设备的第一探测值，以及所述第二探测设备的第二探测值；根据所述第一探测值和所述第二探测值，确定所述无人飞行器距离所述无人飞行器的下方地面的高度；所述根据所述第一探测值和所述第二探测值，确定所述无人飞行器距离所述无人飞行器的下方地面的高度，包括：根据所述第一探测值和所述第二探测值进行数据融合，得到融合高度，所述融合高度为所述无人飞行器距离所述无人飞行器的下方地面的高度；所述根据所述第一探测值和所述第二探测值进行数据融合，包括：根据所述第一探测值，确定第一高度，所述第一高度是所述无人飞行器距离第一地面的垂直高度，所述第一地面在所述第一探测设备的探测方向上；根据所述第二探测值，确定第二高度，所述第二高度是所述无人飞行器距离第二地面的垂直高度，所述第二地面在所述第二探测设备的探测方向上；根据所述第一高度和所述第二高度，进行数据融合；所述根据所述第一高度和所述第二高度，进行数据融合，包括：根据当前时刻所述第一高度的新息差和当前时刻所述第二高度的新息差，确定所述第一高度的估计值的融合比重、以及所述第二高度的估计值的融合比重；根据所述第一高度的估计值的融合比重、当前时刻所述第一高度的估计值、所述第二高度的估计值的融合比重、当前时刻所述第二高度的估计值，计算当前时刻的融合高度；其中，所述新息差为测量值与估计值之差。