一种无人机动态控制方法、系统、设备及存储介质与流程

1.本发明涉及无人机飞行控制技术领域，尤其涉及一种无人机动态控制方法系统、设备及存储介质。


背景技术：

2.无人机电子围栏是指用户为了执行特定范围内的任务而划定建立的功能区，无人机必须在该区域内部执行任务，不得飞出。如植保机进行田间喷药、测绘机进行区域测绘等等应用，都需要无人机在一块特定区域内来回飞行。所以，针对电子围栏，也必须设计飞控使得无人机不得冲出该围栏。
3.在无人机飞控系统中植入电子围栏后，无人机会通过定位系统自动识别与电子围栏的相对地理位置，从而在电子围栏的区域中飞行。电子围栏是静态固定的，而飞机是飞行运动的。如何保证运动的飞机在电子围栏内飞行存在两个关键点：一是精准判断飞机相对于静态电子围栏的位置，即飞机实时到围栏边界的距离；二是接近围栏边缘时需有效减速至悬停，防止冲出围栏。
4.针对以上两个关键点，通常做法是利用组合导航确定飞机相对于围栏的位置、利用位置控制器实现接近禁飞区边缘时减速至悬停。这种做法简单干脆，但在实际飞行中较难操作，因为仅考虑飞机的位置是不完善的，比如飞机位置接近围栏某边缘但速度方向背离该边缘，此时不应介入控制器减速；反之，即使飞机没有靠近围栏边缘，但飞机实时速度很大同时朝向某边缘，这时应充分考虑预见飞机以当前速度飞行的未来位置与状态，在飞行过程中应及时施加动态干预减速，否则未来极有可能来不及减速而冲出围栏。


技术实现要素：

5.本发明要解决的技术问题在于针对现有技术中的缺陷，提供一种基于无人机的当前位置，预测无人机未来是否有离开电子围栏的倾向，从而对无人机进行实时动态控制的方法。
6.本发明解决其技术问题所采用的技术方案是：一种无人机动态控制方法，包括，步骤a：构建与地面平行的平面坐标系，获取电子围栏的边界点坐标和连接关系，以及处于电子围栏内的无人机坐标；步骤b：计算以当前速度飞行时间后无人机将达到的位置，基于当前坐标和时间后的坐标建立当前时刻无人机的飞行轨迹函数，其中，为大常数；步骤c：根据电子围栏各边界线的端点坐标，建立每个边界线的坐标范围及线性函数；步骤d：计算飞行轨迹与边界线的交点，并获得无人机与交点的距离；步骤e：基于无人机当前速度确定无人机安全距离，在无人机与交点的距离小于安全距离时，控制无人机减速，使无人机在电子围栏边缘刹停。
7.优选的，步骤a中先建立北东地ned三维坐标系，获取无人机的空间位置坐标
，以及当前速度，并将无人机的空间位置和当前速度投影到水平面内，无人机坐标为 ，当前速度为 。
8.优选的，所述电子围栏由n个边界点 顺序连接并首尾闭合得到，获取每个边界点 的坐标 及顺序i，在ne坐标系中确定电子围栏区域。
9.优选的，所述计算以当前速度飞行 时间后无人机将达到的位置 的方法为， 的选取需要确保点在电子围栏外。
10.优选的，步骤c中基于电子围栏边界点的坐标和顺序能够确定每个边界线的两个端点位置，每个边界线的函数均为线性方程，通过端点坐标能够计算出每个边界线的函数并给予端点坐标限定函数范围，然后与飞行轨迹的函数进行求解，在边界线的坐标范围内存在共同解时，飞行轨迹与该边界线存在交点 ，并获取无人机与交点的距离，如果与多个边界线存在交点，则获取交点距离的最小值。
11.优选的，所述无人机与电子围栏交点的最小距离为：比较无人机与电子围栏的最小距离 和安全距离 ，当 时，不做处理；当 时，对无人机进行制动。
12.优选的，无人机的安全距离为其中， ， 为无人机的刹车效率。
13.本发明还公开了一种基于电子围栏的无人机动态控制系统，包括，坐标系构建模块：构建与地面平行的平面坐标系，获取电子围栏的边界点坐标和连接关系，以及处于电子围栏内的无人机坐标；飞行轨迹计算模块：计算以当前速度飞行 时间后无人机将达到的位置，基于当前坐标和 时间后的坐标建立当前时刻无人机的飞行轨迹函数，其中，为 大常数；边界线函数计算模块：根据电子围栏各边界线的端点坐标，建立每个边界线的坐标范围及线性函数；距离计算模块：计算飞行轨迹与边界线的交点，并获得无人机与交点的最小距离；控制模块：基于无人机当前速度确定无人机安全距离，在无人机与交点的距离小于安全距离时，控制无人机减速，使无人机在电子围栏边缘刹停。
14.本发明还公开了一种电子处理设备，包括至少一个处理器和存储有至少一个执行程序的存储装置，当所述至少一个执行程序被所述至少一个处理器执行，所述至少一个处理器实现所述无人机动态控制方法。
15.本发明还公开了一种计算机可读存储介质，存储有计算机程序，所述计算机程序
被处理器执行时能够实现所述无人机动态控制方法。
16.本发明的有益效果是：通过构建坐标系，建立飞行轨迹与电子围栏边界的函数关系，获得飞行轨迹与电子围栏的交点，基于无人机速度确定无人机的安全距离，并在无人机与交点的距离小于安全距离时，控制无人机减速，由此将制动响应距离与无人机速度建立起关系，提高安全性，且可以通过连续采集信号实现无人机的实时动态控制，确保无人机不会离开电子围栏区域。
附图说明
17.下面将结合附图及实例对本发明作进一步说明。
18.图1是本发明实施例提供的无人机动态控制方法的流程图；图2是本发明的实施例提供的无人机动态控制方法的坐标系示意图；图3是本发明的实施例提供的无人机动态控制方法的无人机与电子围栏的交点计算方式示意图；图4是本发明的实施例提供的无人机动态控制方法基于安全距离的控制策略示意图。
具体实施方式
19.下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明，但不以任何形式限制本发明。应当指出的是，对本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进。这些都属于本发明的保护范围。
20.本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”、“第三”、“第四”等(如果存在)是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的本发明的实施例，例如能够以除了在这里图示或描述的那些以外的顺序实施。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
21.下面以具体地实施例对本发明的技术方案进行详细说明。下面这几个具体的实施例可以相互结合，对于相同或相似的概念或过程可能在某些实施例不再赘述。
22.实施例1：如图1所示，本实施例提供一种无人机动态控制方法，包括，步骤a：构建与地面平行的平面坐标系，获取电子围栏的边界点坐标和连接关系，以及处于电子围栏内的无人机坐标；步骤b：计算以当前速度飞行 时间后无人机将达到的位置，基于当前坐标和 时间后的坐标建立当前时刻无人机的飞行轨迹函数，其中，为 大常数；步骤c：根据电子围栏各边界线的端点坐标，建立每个边界线的坐标范围及线性函数；步骤d：计算飞行轨迹与边界线的交点，并获得无人机与交点的距离；
步骤e：基于无人机当前速度确定无人机安全距离，在无人机与交点的距离小于安全距离时，控制无人机减速，使无人机在电子围栏边缘刹停。
23.本实施例通过构建坐标系，建立飞行轨迹与电子围栏边界的函数关系，获得飞行轨迹与电子围栏的交点，基于无人机当前速度确定无人机的安全距离，并在无人机与交点的距离小于安全距离时，控制无人机减速，由此将制动响应距离与无人机速度建立起关系，提高安全性，且可以通过连续采集信号实现无人机的实时动态控制，确保无人机不会离开电子围栏区域。
24.具体的，本实施例提供的无人机动态控制方法包括，步骤a：构建与地面平行的平面坐标系，获取电子围栏的边界点坐标和连接关系，以及处于电子围栏内的无人机坐标；参考图2，本实施例中先建立北东地ned三维坐标系，获取无人机的空间位置坐标，以及无人机控制的当前速度 ，并将无人机的空间位置和当前速度投影到水平面内，得到无人机坐标为 ，当前速度为 。
25.所述电子围栏由n个边界点 顺序连接并首尾闭合得到，获取每个边界点 的坐标 及顺序i，顺次连接边界点即可在ne坐标系中确定电子围栏区域。
26.步骤b：计算以当前速度飞行 时间后无人机将达到的位置，基于当前坐标和 时间后的坐标建立当前时刻无人机的飞行轨迹函数，其中，为 大常数；结合图3，所述计算以当前速度飞行 时间后无人机将达到的位置的方法为， 的选取需要确保点在电子围栏外，一般根据电子围栏的最长尺寸*10后得到。
27.步骤c：根据电子围栏各边界线的端点坐标，建立每个边界线的坐标范围及线性函数；电子围栏每个边界线的函数均为线性方程，通过端点坐标能够计算出每个边界线的函数并给予端点坐标限定函数范围，然后与飞行轨迹的函数进行求解，在边界线的坐标范围内存在共同解时，飞行轨迹与该边界线存在交点 ，并获取无人机与交点的距离，如果与多个边界线存在交点，则获取交点距离的最小值。
28.步骤d：计算飞行轨迹与边界线的交点，并获得无人机与交点的距离；所述无人机与电子围栏交点的最小距离为： 。
29.步骤e：基于无人机当前速度确定无人机安全距离，在无人机与交点的距离小于安全距离时，控制无人机减速，使无人机在电子围栏边缘刹停。
30.参考图4，比较无人机与电子围栏的最小距离 和安全距离 ，
当 时，不做处理；当 时，对无人机进行制动。
31.其中，无人机的安全距离为其中， ， 为无人机的刹车效率。
32.实施例2：本实施例还提供了一种基于电子围栏的无人机动态控制系统，其包括，坐标系构建模块：构建与地面平行的平面坐标系，获取电子围栏的边界点坐标和连接关系，以及处于电子围栏内的无人机坐标；飞行轨迹计算模块：计算以当前速度飞行 时间后无人机将达到的位置，基于当前坐标和 时间后的坐标建立当前时刻无人机的飞行轨迹函数，其中，为 大常数；边界线函数计算模块：根据电子围栏各边界线的端点坐标，建立每个边界线的坐标范围及线性函数；距离计算模块：计算飞行轨迹与边界线的交点，并获得无人机与交点的最小距离；控制模块：基于无人机当前速度确定无人机安全距离，在无人机与交点的距离小于安全距离时，控制无人机减速，使无人机在电子围栏边缘刹停。
33.实施例3：本实施例还提供了一种电子处理设备，包括至少一个处理器和存储有至少一个执行程序的存储装置，当所述至少一个执行程序被所述至少一个处理器执行，所述至少一个处理器如下方法：步骤a：构建与地面平行的平面坐标系，获取电子围栏的边界点坐标和连接关系，以及处于电子围栏内的无人机坐标；步骤b：计算以当前速度飞行 时间后无人机将达到的位置，基于当前坐标和 时间后的坐标建立当前时刻无人机的飞行轨迹函数，其中，为 大常数；步骤c：根据电子围栏各边界线的端点坐标，建立每个边界线的坐标范围及线性函数；步骤d：计算飞行轨迹与边界线的交点，并获得无人机与交点的距离；步骤e：基于无人机当前速度确定无人机安全距离，在无人机与交点的距离小于安全距离时，控制无人机减速，使无人机在电子围栏边缘刹停。
34.实施例4：本实施例还提供了一种计算机可读存储介质，存储有计算机程序，所述计算机程序被处理器执行时能够实现如下方法：步骤a：构建与地面平行的平面坐标系，获取电子围栏的边界点坐标和连接关系，以及处于电子围栏内的无人机坐标；步骤b：计算以当前速度飞行 时间后无人机将达到的位置，基于当前坐标和 时间后的坐标建立当前时刻无人机的飞行轨迹函数，其中，为 大常数；步骤c：根据电子围栏各边界线的端点坐标，建立每个边界线的坐标范围及线性函数；
步骤d：计算飞行轨迹与边界线的交点，并获得无人机与交点的距离；步骤e：基于无人机当前速度确定无人机安全距离，在无人机与交点的距离小于安全距离时，控制无人机减速，使无人机在电子围栏边缘刹停。
35.本领域内的技术人员应明白，本发明的实施例可提供为方法、设备(系统)或计算机程序产品。因此，本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方 面的实施例的形式。而且，本发明可采用在一个或多个其中包含有计算机可用程序代码的 计算机可用存储介质(包括但不限于磁盘存储器、cd
‑
rom、光学存储器等)上实施的计算机 程序产品的形式。
36.本说明书中各个实施例采用递进的方式描述，每个实施例重点说明的都是与其他实施例的不同之处，各个实施例之间相同相似部分互相参见即可。对所公开的实施例的上述说明，使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的，本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下，在其它实施例中实现。因此，本发明将不会被限制于本文所示的这些实施例，而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
37.以上对本发明的具体实施例进行了描述。需要理解的是，本发明并不局限于上述特定实施方式，本领域技术人员可以在权利要求的范围内做出各种变形或修改，这并不影响本发明的实质内容。