一种飞行器飞行稳定控制方法、系统、设备及存储介质与流程

技术特征：
1.一种飞行器飞行稳定控制方法，其特征在于，包括以下步骤：s1、获取飞行器的当前飞行数据，其中，飞行数据包括飞行姿态参数和飞行速度；s2、根据所述飞行器的飞行状态在预设的稳定飞行数据库中匹配对应的稳定飞行数据阈值，所述飞行状态包括垂直起降状态和平飞状态；s3、根据所述当前飞行数据与所述稳定飞行数据阈值的比较结果来判断所述飞行器的当前飞行是否稳定，若判断所述飞行器的当前飞行不稳定，则执行步骤s4，若判断所述飞行器的当前飞行稳定，则执行步骤s5；s4、调整所述飞行器的飞行数据，从而对所述当前飞行数据进行补偿，以使补偿后的飞行数据处于所述稳定飞行数据阈值之内，执行步骤s5；s5、通过激光雷达端对所述飞行器的前方可探测范围内的障碍物进行探测，获取所述障碍物的障碍信息，所述激光雷达设在所述飞行器上，所述障碍信息包括所述障碍物相对所述飞行器的相对位置、运动速度、驻留时间和相对距离；s6、对所述飞行器的预设飞行轨迹和所述障碍信息进行分析，从而判断所述障碍物对所述飞行器的飞行是否构成威胁，若判断所述障碍物对所述飞行器的飞行构成威胁，则执行步骤s7；若判断所述障碍物对所述飞行器的飞行不构成威胁，则重新执行步骤s1；s7、根据所述障碍物相对所述飞行器的相对位置和运动速度生成飞行动作指令，从而使所述飞行器和所述障碍物不发生位置重合，将所述动作指令发送至控制终端，所述飞行动作指令包括飞行器的飞行动作及其对应的动作参数；s8、通过所述控制终端对所述飞行动作指令进行解析，得到动作执行信息，所述动作执行信息包括所述飞行器的各个运动控制器的动作补偿参数；s9、通过所述控制终端将所述动作执行信息发送至所述飞行器的各个运动控制器，以使所述飞行器按照所述动作执行信息调整飞行姿态。2.根据权利要求1所述的飞行器飞行稳定控制方法，其特征在于，所述飞行姿态参数包括俯仰角、偏航角、滚转角和角速度；步骤s2具体包括：s20、基于控制终端获取所述飞行器的飞行状态，所述飞行状态包括垂直起降状态和平飞状态；s21、根据所述飞行状态在预设的稳定飞行数据库中匹配对应的稳定飞行数据阈值，所述预设的稳定飞行数据库包括所述飞行状态及其对应的所述稳定飞行数据阈值，具体匹配过程为，当所述飞行器的所述飞行状态为垂直起降状态时，则所述稳定飞行数据阈值包括：所述俯仰角的变化阈值为0
°
～5
°
，所述偏航角的变化阈值为0
°
～5
°
，所述滚转角的变化阈值为0
°
～5
°
，所述角速度的变化阈值为0～4rad/s，所述飞行速度的变化阈值为0～1m/s；当所述飞行器的所述飞行状态为平飞状态时，则所述稳定飞行数据阈值包括：所述俯仰角的变化阈值为0
°
～60
°
，所述偏航角的变化阈值为0
°
～25
°
，所述滚转角的变化阈值为0
°
～25
°
，所述角速度和所述飞行速度的变化阈值趋于线性变化。3.根据权利要求1所述的飞行器飞行稳定控制方法，其特征在于，步骤s6之前包括：s60、根据任务控制点下发的巡检任务规划所述飞行器的飞行轨迹；s61、建立所述飞行器的巡检空间范围的三维点云地图，在所述三维点云地图中以所述
飞行轨迹的起点为原心，以所述飞行轨迹的起点指向终点的方向为横轴正方向建立三维局部坐标系，将所述飞行器的巡检空间范围内的点云位置统一映射到所述三维局部坐标系中，以得到点云空间坐标系；s62、基于所述点云空间坐标系确定所述飞行轨迹的点云位置坐标序列；s63、根据所述飞行器的当前点云位置坐标以及所述障碍物相对所述飞行器的相对位置，得到所述障碍物的点云位置坐标。4.根据权利要求3所述的飞行器飞行稳定控制方法，其特征在于，步骤s6中的对所述飞行器的预设飞行轨迹和所述障碍信息进行分析，从而判断所述障碍物对所述飞行器的飞行是否构成威胁的步骤具体包括：s601、判断所述障碍物的点云位置坐标是否属于所述点云位置坐标序列内，若判断所述障碍物的点云位置坐标属于所述点云位置坐标序列内，则执行步骤s602，若判断所述障碍物的点云位置坐标不属于所述点云位置坐标序列内，则执行步骤s603；s602、判断所述障碍物的驻留时间是否大于预设的驻留时间阈值，若判断所述障碍物的驻留时间大于所述预设的驻留时间阈值，则判定所述障碍物对所述飞行器的飞行构成威胁，若判断所述障碍物的驻留时间不大于所述飞行时间，则判定所述障碍物对所述飞行器的飞行不构成威胁，并返回步骤s601；s603、根据所述障碍物的驻留时间是否大于所述预设的驻留时间阈值，若判断所述障碍物的驻留时间大于所述预设的驻留时间阈值，则判定所述障碍物对所述飞行器的飞行不构成威胁，若判断所述障碍物的驻留时间不大于所述飞行时间，则执行步骤s604；s604、根据所述障碍物相对所述飞行器的相对距离在预设时间内的变化量判断所述障碍物是否靠近所述飞行器运动，若判断所述障碍物靠近所述飞行器运动时，则判定所述障碍物对所述飞行器的飞行构成威胁，若判断所述障碍物远离所述飞行器运动时，则判定所述障碍物对所述飞行器的飞行不构成威胁。5.根据权利要求4所述的飞行器飞行稳定控制方法，其特征在于，步骤s7具体包括：s701、根据所述障碍物的点云位置坐标和运动速度确定所述飞行器和所述障碍物的重合点云位置坐标；s702、根据所述重合点云位置坐标调整所述飞行器的飞行轨迹，从而使得所述飞行器的飞行轨迹脱离所述重合点云位置坐标，从而生成飞行动作指令，所述飞行动作指令包括飞行器的飞行动作及其对应的动作参数。6.根据权利要求5所述的飞行器飞行稳定控制方法，其特征在于，所述飞行动作包括方向调整动作、自转动作和姿态动作；所述方向调整动作对应的所述动作参数包括所述飞行器在前后方向、上下方向和左右方向上的运动距离以及对应的运动速度；所述自转动作对应的所述动作参数包括自转角速度；所述姿态动作对应的所述动作参数包括俯仰角、偏航角、滚转角和角速度。7.根据权利要求1所述的飞行器飞行稳定控制方法，其特征在于，步骤s9之后包括：s10、重复执行步骤s5，从而获取新的障碍物的障碍信息；s11、对所述飞行器的所述预设飞行轨迹和所述新的障碍物的障碍信息进行分析，从而判断所述新的障碍物对所述飞行器的飞行是否构成威胁，若判断所述新的障碍物对所述飞
行器的飞行不构成威胁，则返回至所述预设飞行轨迹上进行飞行，执行步骤s1，若判断所述新的障碍物对所述飞行器的飞行构成威胁，则执行步骤s7。8.一种飞行器飞行稳定控制系统，其特征在于，包括：获取模块，用于获取飞行器的当前飞行数据，其中，飞行数据包括飞行姿态参数和飞行速度；阈值匹配模块，用于根据所述飞行器的飞行状态在预设的稳定飞行数据库中匹配对应的稳定飞行数据阈值，所述飞行状态包括垂直起降状态和平飞状态；稳定判断模块，用于根据所述当前飞行数据与所述稳定飞行数据阈值的比较结果来判断所述飞行器的当前飞行是否稳定；飞行调整模块，用于调整所述飞行器的飞行数据，从而对所述当前飞行数据进行补偿，以使补偿后的飞行数据处于所述稳定飞行数据阈值之内；障碍探测模块，用于通过激光雷达端对所述飞行器的前方可探测范围内的障碍物进行探测，还用于获取所述障碍物的障碍信息，所述激光雷达设在所述飞行器上，所述障碍信息包括所述障碍物相对所述飞行器的相对位置、运动速度、驻留时间和相对距离；威胁判断模块，用于对所述飞行器的预设飞行轨迹和所述障碍信息进行分析，从而判断所述障碍物对所述飞行器的飞行是否构成威胁；动作指令生成模块，用于根据所述障碍物相对所述飞行器的相对位置和运动速度生成飞行动作指令，从而使所述飞行器和所述障碍物不发生位置重合，还用于将所述动作指令发送至控制终端，所述飞行动作指令包括飞行器的飞行动作及其对应的动作参数；动作指令解析模块，用于通过所述控制终端对所述飞行动作指令进行解析，得到动作执行信息，所述动作执行信息包括所述飞行器的各个运动控制器的动作补偿参数；执行模块，用于通过所述控制终端将所述动作执行信息发送至所述飞行器的各个运动控制器，以使所述飞行器按照所述动作执行信息调整飞行姿态。9.一种电子设备，其特征在于，包括：存储器，用于存储计算机程序；处理器，用于执行所述计算机程序时实现如权利要求1至7任一项所述飞行器飞行稳定控制方法的步骤。10.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质上存储有计算机程序，所述计算机程序被处理器执行时实现如权利要求1至7任一项所述飞行器飞行稳定控制方法的步骤。

技术总结
本申请公开了一种飞行器飞行稳定控制方法、系统、设备及存储介质，通过飞行器的飞行状态结合当前飞行数据判断飞行器是否飞行稳定，若飞行不稳定，则对飞行器的飞行数据进行补偿以使飞行器飞行稳定。同时，通过探测障碍物获取障碍信息，根据障碍信息和飞行器的预设飞行轨迹判断障碍物是否构成威胁，若构成威胁，则根据障碍物相对飞行器的相对位置生成飞行动作指令，以调整飞行器的飞行姿态，从而使飞行器和障碍物不发生位置重合，以实现避障。上述技术方案解决了飞行器易受外在的环境因素影响而导致飞行器出现飞行稳定性较差的技术问题。题。题。


技术研发人员：黄城 郑耀华 原瀚杰 姜天杭 曾水悦 李俊宏 谭健铭
受保护的技术使用者：广东电网有限责任公司肇庆供电局
技术研发日：2021.07.26
技术公布日：2021/10/8