一种无人飞行器自主安全飞行控制方法
【技术领域】：
[0001] 本发明属于无人飞行器技术领域，特指一种无人飞行器自主安全飞行控制方法。
【背景技术】：
[0002] 当前，无人飞行器技术迅猛发展，无人飞行器能够搭载很多先进设备，通过自驾仪 预设航迹和人在回路远程遥控的方式，执行各种各样的任务，可以有效规避飞行员驾驶飞 机所承担的风险，这体现出了无人飞行器巨大的安全优势。
[0003] 同时，随着无人飞行器民用化的步伐，无人飞行器在航拍摄影、城市道路测绘、交 通监控等领域的应用也越来越广泛。执行这样的任务，无人飞行器的自主飞行能力和安全 性能不容忽视，因为城市人口密集，无人飞行器一旦从高空坠落，往往会带来严重的后果。 无人飞行器执行任务的可靠性、任务能力，尤其是安全性也越来越受到人们的关注和重视， 也有很多问题需要进一步完善。
[0004] 问题一，无人飞行器在空中执行飞行任务，根据任务需求，任务高度，任务速度都 有可能在较大范围内变化，这就涉及到无人飞行器飞行状态改变过程中，自身控制舵面中 立位置的调整问题。在经典控制方法中，一般都是依靠对误差的积分求出新的平衡位置，误 差的积分中包含了所有的历史信息，其中包括扰动过大的错误信息等。离当前时间较远的 历史信息和错误信息对当前状态改变是没有益处的，一方面历史状态与当前状态的控制舵 面的中立位置不同，历史信息阻碍当前状态的改变，需要超调较长时间才能消除历史信息 的影响，影响收敛速度；另一方面，错误的历史信息需要较大的超调来消除，影响状态改变 的稳定性。
[0005] 问题二，无人飞行器在空中执行飞行任务，其飞行航迹是由一系列带有顺序编号 的航路点组成的，航路点主要包含了经炜度、高度、飞行速度等信息，主要作用为引导无人 飞行器沿固定轨迹飞行，航路点可简称为航点。航路点通常是飞行前设计好，上传到无人飞 行器自驾仪里，也可以实时在线更改，飞行前设计好的航路点称为预设航路点或预设航点， 两个相邻编号的预设航路点之间连线的轨迹称为预设航迹，在实时飞行过程中，无人机被 控制系统指引希望到达而暂未到达的航路点称为当前的目标航路点或目标航点。无人机到 达目标航路点附近以后，控制系统将按照一定的控制逻辑对目标航路点进行操作，将目标 航路点切换为下一编号或指定编号的航路点。航路点切换过程中切换逻辑十分重要，切换 逻辑需要对无人飞行器飞行精度和飞行安全进行综合考量。如果过分要求无人飞行器飞行 精度，将航路点切换的提前转弯半径设置的很小，无人飞行器由于受本身转弯半径的限制 和风的扰动的影响，可能始终无法飞进切换区域，导致无人飞行器在目标航路点附近以大 坡度滚转角转圈，极易诱使无人飞行器坠毁；同样，如果仅考虑安全性，只要无人飞行器与 目标航路点平行于航迹的距离小于一定的值就切换到下一航路点，那么，此时无人飞行器 可能与目标航路点垂直于航迹的距离还较远，无人飞行器还没有能执行该航路点预设的侦 查或打击任务，就已经切换到下一航路点，这样无疑会影响无人飞行器执行任务的能力。
【发明内容】
[0006] 本发明针对现有无人飞行器控制方法的不足，提出了一种无人飞行器自主安全飞 行控制方法，能够有效解决无人飞行器自主飞行控制过程中的安全性问题。
[0007] 本发明的技术方案是：
[0008] 本发明主要包括两部分，一是在飞行过程中，针对无人飞行器飞行状态切换，采用 对误差数据进行滑动窗口滤波，可以有效剔除与当前状态无关的历史数据、扰动过大的数 据，加快收敛过程，减小超调，增加无人飞行器状态改变过程的稳定性。二是针对无人飞行 器航路点切换，通过以下逻辑进行航路点的切换，首先判断无人飞行器与当前目标航路点 之间的距离，同时，为了飞行安全考虑，当不满足上述切换条件而判断出无人飞行器与目标 航路点平行于航迹的距离小于一定值时，系统也会自动将目标航路点切换至下一航路点。 本发明公开的方法可以有效提高无人飞行器状态改变的稳定性和航路点切换的可靠性，能 够切实提高飞行安全性。
[0009] -种无人飞行器自主安全飞行控制方法，其特征在于：包括无人飞行器飞行状态 安全切换和无人飞行器航路点安全切换两部分，
[0010] 所述无人飞行器飞行状态安全切换，包括以下步骤：
[0011] S1. 1 :自驾仪启动，传感器初始化，所有积分项的误差数据初始化为零；
[0012] S1. 2 :无人飞行器起飞，先进入爬升模式，待爬到指定高度，进入巡航模式，误差数 据开始积分；
[0013] S1. 3 :判断误差是否过大，如在边界值范围内，直接记录；如超过边界值，按照边 界值记录；
[0014] S1. 4 :设定保存误差数据的总数，当记录的误差数据的总数等于设定值时，以后每 记录一个最新的误差数据，就删除一个最久远的历史数据，不断更新误差数据，保持数据总 数为设定值。
[0015] 所述无人飞行器航路点安全切换，包括以下步骤：
[0016] S2. 1 :根据无人飞行器当前位置信息和预设航路点的位置信息，计算无人飞行器 当前位置和当前目标航路点之间的距离D;
[0017] S2. 2 :判断距离D是否小于预设提前转弯半径，如果小于，将当前目标航路点切换 至下一目标航路点，转入步骤S2. 1 ;如果不小于，进入步骤S2. 3 ;
[0018] S2. 3 :根据无人飞行器当前位置信息和预设航路点的位置信息，计算无人飞行器 当前位置与当前目标航路点之间平行于预设航迹的距离d;
[0019] S2. 4 :判断该距离d是否小于预设的安全切换量，如果小于，将当前目标航路点切 换至下一目标航路点，然后转入步骤S2.1;如果不小于，直接转入步骤S2.1，进行新一轮判 断。
[0020] 针对【背景技术】中所述的问题一，本发明设计了飞行状态安全切换方法，对误差数 据进行滑动窗口滤波，及时剔除与当前状态无关的历史数据、扰动过大的数据，使与当前状 态有关的误差数据及时占优，可以有效加快收敛速度，减小超调，增加状态改变过程中的稳 定性。
[0021] 针对【背景技术】中所述的问题二，本发明充分考虑航路点切换过程中的精度要求和 安全、可靠性要求，设计了航路点安全切换方法，通过以下逻辑进行飞行过程中航路点的切 换。首先根据无人飞行器与目标航路点之间的距离判断是否切换到下一航路点，再判断无 人飞行器与目标航路点平行于航迹的距离是否满足切换条件，不仅能满足无人飞行器执行 任务时的精度要求，也能保证航路点切换的可靠性和安全性。
[0022] 与现有技术相比，本发明的优点是：（1)通过对误差数据进行滑动窗口滤波的方 法，及时剔除了与当前状态无关的历史数据、扰动过大的错误数据，加快了状态的改变过 程，提高了收敛速度，减小了不必要的超调，增加了飞行状态改变过程中的稳定性。（2)综 合考虑了无人飞行器执行任务时对航路点切换精度和可靠性的要求，首先判断是否满足提 前转弯半径的切换条件，如果满足，就自动切换到下一航路点，不必再继续向目标航路点飞 行，节约了飞行时间；当出现了异常情况，比如较强侧风干扰时，无人飞行器无法飞进提前 转弯半径的区域，但是只要无人飞行器在平行于预设航迹的方向上与目标航路点之间的距 离小于一定的值，就可以自动切换到下一航路点，使无人飞行器安全离开侧风干扰较强的 区域，保证了无人飞行器的安全，提高了航路点切换的安全性和可靠性。
【附图说明】
[0023] 图