[发明专利]一种植保无人机悬停稳定装置及其控制方法

说明书

本发明属于农业装备技术领域，具体涉及一种植保无人机悬停稳定装置及其控制方法。本发明提供的植保无人机悬停稳定装置包括：移动端，移动端固定在无人机上；固定端，固定端有多个，固定在温室内的顶部；固定端发出初始信号给移动端，移动端接收到初始信号后发出反馈信号给固定端；控制中心，控制中心根据固定端发出的初始信号和接收到的反馈信号计算得到移动端的实际位置，控制中心根据移动端的实际位置与无人机设定路径或设定位置之间的偏差发出控制信号给移动端。本发明为植保无人机提供了一套新的控制方案，提高了无人机在小空间及复杂空间内的控制精度，实现无人机在温室内部的安全可靠使用。

技术领域

本发明属于农业装备技术领域，具体涉及一种植保无人机悬停稳定装置及其控制方法。

背景技术

智慧农业技术是指利用现代信息技术结合现代农业技术以实现高效高质量耕作的技术的总称。近年来，采用无人机进行农药喷洒、生长状况监测、农场巡视等功能在农业生产中被广泛接收和应用，能够大幅度地将农业工作者从繁重的体力劳动中解放出来。但是，现有无人机多采用人工操控或北斗等远程定位操控方式，人工操控对操作人员的技术要求较高，且操作精度不理想。远程定位操控方式信号传输距离较远，而且电磁波信号在穿过温室时会受到金属框架的干扰，定位精度受限，高精度的飞行路径和姿态控制难以实现。因此，目前无人机的应用仍主要限制在开放场景中，在狭小空间内工作可靠性还难以达到要求，很容易造成撞击和坠机事故。

发明内容

针对现有技术存在的不足，本发明提供一种植保无人机悬停稳定装置及其控制方法，其目的是实现无人机的精确控制，实现无人机在温室内部的安全可靠使用。

为了达到上述目的，本发明通过以下技术方案来实现：一种植保无人机悬停稳定装置，包括：

移动端，移动端固定在无人机上，可以集成固定，也可以可拆卸方式固定；

固定端，固定端有多个，固定在温室内的顶部；固定端发出初始信号给移动端，移动端接收到初始信号后发出反馈信号给固定端；初始信号和反馈信号可以是电磁波信号，也可以是超声波信号；

控制中心，控制中心根据固定端发出的初始信号和接收到的反馈信号计算得到移动端的实际位置，控制中心根据移动端的实际位置与无人机设定路径或设定位置之间的偏差发出控制信号给移动端。若初始信号和反馈信号均为超声波信号，可直接测量固定端发出初始信号至接收到反馈信号的时间差得到各固定端至移动端的距离；若初始信号和反馈信号均为电磁波信号，可使用平均法测量固定端发出初始信号至接收到反馈信号的时间差得到各固定端至移动端的距离，从而将时间的测量成本降低至可接受范围内。得到距离以后可以计算得到移动端的实际位置。

此套装置可以有效规避人工操控和远程定位操控存在的众多缺陷，实现无人机在狭小空间内的精确控制。

进一步地，各个固定端优选均通过导线与控制中心实现电连接。导线连接相比无线电连接可实现较高的信号稳定性，能够避免信号传输路径上的遮挡和干扰。

进一步地，固定端的安装高度比温室内作物的高度高至少1.8米。固定端的安装高度过低可能会导致信号在传输过程中被阻挡，也会导致移动端与固定端的空间位置接近共平面，引起位置计算误差偏大。实践中，跨度12米的温室，固定端的安装高度优选比温室内作物的高度高2.2米；跨度9.6米的温室，固定端的安装高度优选比温室内作物的高度高2.0米。这样，无人机与作物保持1.0米左右作业距离的情况下依然能够获得厘米级的定位精度。

进一步地，固定端的一种优选的布置方式是：固定端分为三组，其中两组分别沿温室的两侧分布，另一组沿温室顶部中央分布；沿温室两侧分布的各个固定端均处于同一高度；沿温室顶部中央分布的各个固定端均处于同一高度，但与温室两侧的固定端的高度不同。

进一步地，本发明还提供上述植保无人机悬停稳定装置的控制方法，包括以下步骤：

（S1）控制中心控制固定端发出初始信号；