一种智能植保无人机的控制管理系统及其控制方法与流程

本发明涉及一种智能植保无人机的控制管理系统及其控制方法，属于导航定位与控制的
技术领域：
。
背景技术：
：植保无人机在给农作物喷洒农药时，经常会出现药物喷洒不均匀的现象。其主要由三个方面的原因，第一，飞行高度、飞行速度及水泵输出量均会影响最后附着在农作物上的药量，但是许多无人机在作业时，没有将这三者进行整体的考虑，因此在加减速或转弯处，飞机高度、速度发生变化后，导致药量不均匀。第二，在喷洒过程中，可能会由部分喷嘴被堵塞，如果没有及时发现，将会导致成块的农作物被漏掉。第三，药量较低或机载农药用尽时，未能及时记录停药点或没有记录停药点，致使小片农作物被遗漏。不同的农作物，对农药的需求量不同。同一种农作物对不同农药的需求量也不同。因此在改变作业对象时，无人机在单位时间内的喷药量要发生改变。如果通过调节水泵压力大小来改变喷药量，会使农药的雾化效果变差，甚至是变成水滴状。如果通过飞机飞行速度或高度来改变喷药量，会降低打药效率。这些方法无法使植保无人机的喷洒效果在面对不同作物时，均处于一个较好的状态。因此，要进一步提高植保无人机的工作质量，解决上述问题是迫切需要的。技术实现要素：本发明需要解决的技术问题是针对上述现有技术的不足，而提供一种喷洒农药均匀的植保无人机的控制管理系统及其控制方法。为解决上述技术问题，本发明采用的技术方案是：一种智能植保无人机的控制管理系统，包括飞行控制系统和智能喷洒管理系统，所述飞行控制系统包括主控芯片a以及分别电气连接在主控芯片a上的姿态传感器、差分gps、气压计、无线电数传、动力电量检测模块，所述智能喷洒管理系统包括辅控芯片b、流量计、电源模块、水泵及常闭电磁阀，所述主控芯片a、辅控芯片b、电源模块、常闭电磁阀依次串联，所述水泵电气连接电源模块，水泵外设置有药箱，药箱、水泵、常闭电磁阀通过管道依次连接。所述常闭电磁阀外设置有喷洒装置，常闭电磁阀与喷洒装置之间还设置有流量计，常闭电磁阀、流量计、喷头依次管道连接，所述流量计电气连接辅控芯片b。所述喷洒装置包括六个喷嘴，六个喷嘴按机头方向三行两列安装在飞机底部，其中每行为一组喷嘴，共三组喷组，均向下喷洒农药。一种智能植保无人机的控制管理系统的控制方法，其特征在于，包括以下步骤：a.给fcs设定飞行航线、喷洒面积和用药量。其中飞行航线包括了飞机自动飞行时的经纬度、高度及速度信息；b.将喷洒面积、用药量及飞行航线中的飞行高度数据发送给isms，isms根据这些数据计算出需要开启的最佳喷嘴组数及飞机巡航速度，巡航速度发送给fcs用于控制飞行速度，具体计算方式如下：i、计算喷洒系统喷洒宽度w根据飞行高度h、农作物高度h及喷嘴喷洒角度θ计算出单个喷嘴喷洒宽度w1，因为每组喷嘴包含两个并列的喷嘴，所以喷洒系统的喷洒宽度w＝2*w1；ii、计算需要开启的喷嘴组数k1设喷洒面积为s，用药量为vol，预先设定无人机速度为va，喷洒面积及用药量源数据在步骤a中获得，预先设定无人机速度源数据在步骤a中的飞行航线数据中获取，喷洒宽度w在计算过程i中获得，由此计算出无人机喷洒农药的总流量a，公式如下：在所受水泵压力恰好使喷雾均匀时的喷洒效率最高，此时的压力值也常作为喷嘴工作的最小压力pmin，此时单个喷嘴的喷洒流量为则一组喷嘴的流量为可以求出所需的开启的喷嘴组数为k，此时k若为小数，不满足实际情况，可k取数轴上比k小且离k最近的整数k1，然后通过加大压力的方式，补偿剩余所需流量；iii、增压补偿流量r计算设在pmin下，采用k1组喷嘴后，为满足喷洒总流量a的需求，单组喷嘴还需补充的流量r，公式为r＝(k-k1)*(2*a)iv、最佳巡航速度va1计算单个喷嘴所受水泵压力从pmin增加到pmax时，单个喷嘴的流量增加量为b，则压力后，已开启所有喷嘴总流量相比pmin时增加量为(2*b)*k1。若r大于(2*b)*k1。，即无法通过增加压强来满足喷洒总流量为a的需求，则可以通过适当的放慢飞行速度来增加流量；使水泵压强最大时，喷嘴喷洒流量最大，此时飞机飞行速度变化量最小，对于作业效率降低最小；单个喷嘴在水泵压力最大时的流量为(a+b)，则单组喷嘴的总流量为2*(a+b)；假设无人机在速度为va1，喷嘴总流量为2*(a+b)*k1时，正好能使vol升农药均匀喷洒在面积为s的农田上，则应该满足如下关系式，从而可以求出最佳飞机巡航速度va1；若r小于(2*b)*k,即可以通过增加压强来满足喷洒总流量为a的需求，巡航速度为飞行航线任务中的巡航速度信息；c.在进行植保作业时，辅控芯片b捕获流量计输出的脉冲信号，根据脉冲信号的频率计算出单个喷嘴喷洒的农药的流量，然后对每个喷嘴的流量数据进行检测，检测结果分为三种情况：a、每个喷嘴流量均处于设定的最低值之上；b、单个喷嘴流量处于最低值之下；c、每个喷嘴流量均处于最低值之下；在检测情况为a时，求取流量的均值，当做反馈信号用于流量控制；在检测情况为b时，关闭水泵，并发送故障指令1给fcs，fcs收到指令后，记录当前的gps坐标并返航；在检测情况为c时，关闭水泵，并发送故障指令2给fcs，fcs收到指令后，记录当前的gps坐标并返航，故障指令1表示某一个或多个喷嘴的喷洒状态异常，故障指令2表示所有喷嘴的喷洒状态异常；d.正常作业时，流量检测结果为a，根据反馈回来的流量信息，可以对喷洒量进行控制，首先从fcs获取当前无人机飞行的速度，通过无人机飞行速度和单个喷嘴流量，可以计算单个喷嘴的流量a1为：其中此处h0和ca0为飞机的实际高度和速度，将期望流量与当前流量做差经过pid运算，生成pwm占空比的修正量，输出给电源模块，控制水泵压力，使单个喷嘴流速发生变化，使无人机喷洒更加均匀，该流量再由流量计发送给辅控芯片b，为步骤b作数据参考；即当飞机正常作业时，也可以通过飞行速度和飞行当fcs检测到动力电池低电量时，发送关机指令给isms，isms关闭水泵及所有常闭进水阀，fcs记录当前gps坐标，返航。与现有技术相比，本发明的一种智能植保无人机的控制管理系统及其控制方法，在需要不同的喷药量时，智能选择要开启的喷嘴数量，来决定喷药量的大小。在喷药量需求较小时，通过减少喷嘴数量来减小喷药量，能使喷雾仍然维持在一个较好的状态。同时可以做到高度变化不大，速度变化不大的情况下，改变喷药量。既能改变喷药量大小，也能维持较高的喷药效率。在喷药过程中，通过引入飞行速度、飞行高度及喷嘴流量的信号，进行闭环控制。在使得飞机在加减速、匀速或转向的同时，附着在农作物上的药物量尽可能一致。附图说明图1是本发明的结构示意图；图2是无人机上的喷嘴示意图；图3为流量控制流程图。具体实施方式下面结合附图详细说明本发明的优选技术方案。如图1所示，本发明的一种智能植保无人机的控制管理系统及其控制方法，用于解决植保无人机在喷洒农药时喷洒不均匀，以及改变作业对象时，喷洒效果一致性变差的问题；主要由两大模块组成：飞行控制系统和智能喷洒管理系统。飞行控制系统包含主控芯片a、姿态传感器、差分gps、气压计、无线电数传、动力电量检测模块等；智能喷洒管理系统包含：辅控芯片b、流量计、电源模块、水泵及常闭电磁阀(常闭电磁阀分为六个进水阀，见图一)等，系统结构框图见图1，图中细线连接部分将采用电气连接，粗线箭头连接的地方采用水管连接；所述常闭电磁阀外设置有喷洒装置，常闭电磁阀与喷洒装置之间还设置有流量计，常闭电磁阀、流量计、喷头依次管道连接，所述流量计电气连接辅控芯片b；所述所述喷洒装置包括六个喷嘴，六个喷嘴按机头方向三行两列安装在飞机底部，其中每行为一组喷嘴，共三组喷组，均向下喷洒农药。飞行控制系统的主要功能是：根据姿态传感器和gps给出的姿态、位置及速度信息，控制飞机在喷洒作业时的飞行轨迹及飞行速度。与地面站通信，并在工作工程中，与喷洒管理系统实时通信：1、发送开始工作和停止工作信号给喷洒管理系统；2、发送高度信息、速度信息给喷洒管理系统，并从喷洒管理系统获取期望速度；3、从喷洒管理系统中获取工作状态字，当获取药量为零或喷嘴故障的信号时，记录当前gps位置。记录的gps位置可以作为下次作业的起始点。智能喷洒管理系统的主要功能是：1、依据设定喷药量大小，通过主控芯片结合提前设置的喷嘴的参数，决定要开启的喷嘴的数量，并将开关信号输出给电源，给需要开启的喷嘴所对应的常闭电磁阀供电，开启相应喷嘴，不同的无人机可挂载的喷嘴数量不同，本系统最多支持控制6个喷嘴。2、从流量计处获取四个喷嘴的流量信息，当所有喷嘴的流量数据均正常时，结合当前的飞行高度、飞行速度，计算出当前的控制量，输出控制信号给电源模块来控制水泵压力小幅度变化，进一步控制己开启的喷嘴的出药量，保证均匀喷药。3、检测到单个喷嘴的流量处于异常时，关闭水泵，给飞控发出单个喷嘴异常的信号。检测到所有喷嘴流量均处于一个较低值时，关闭水泵，给飞控发出药量不足的信号。飞行控制系统选型：主控芯片a选择stm32f407zgt6，姿态传感器选择x-sens的mti-300，差分gpa采用诺瓦泰oem-617机载板卡及其配套基站，气压计选择ms5611。智能喷洒管理系统选型：辅控芯片b选择stm32f103zet6；水泵采用普兰迪pld-1202微型隔膜水泵，最大压力0.6mpa；流量计采用okd-hz06s霍尔流量传感器，常闭电磁阀选用dc12v常闭进水阀，电源模块基于开关三极管设计。另外，在详细说明时，采用某品牌vp110喷嘴，其在不同压力下的流量表如表1所示：压力(mpa)流量(升/分钟)0.20.450.30.550.40.63表1喷嘴参数表具体的，喷嘴在植保无人机下的安装图示意如图2，其中1、2、3为一组，4、5、6为一组，每个喷嘴对应一个流量计，每个流量计又对用一个进水阀。本系统的工作过程介绍如下，在介绍中以下名词将采用括号内的简写代替：飞行控制系统(fcs)，喷洒管理系统(isms)。a.给fcs设定飞行航线、喷洒面积和用药量。其中飞行航线包括了飞机自动飞行时的经纬度、高度及速度信息；b.将喷洒面积、用药量及飞行航线中的飞行高度数据发送给isms，isms根据这些数据计算出需要开启的最佳喷嘴组数及飞机巡航速度，巡航速度发送给fcs用于控制飞行速度，具体计算方式如下：i、计算喷洒系统喷洒宽度w根据飞行高度h、农作物高度h及喷嘴喷洒角度θ计算出单个喷嘴喷洒宽度w1，因为每组喷嘴包含两个并列的喷嘴，所以喷洒系统的喷洒宽度w＝2*w1；ii、计算需要开启的喷嘴组数k1设喷洒面积为s，用药量为vol，预先设定无人机速度为va，喷洒面积及用药量源数据在步骤a中获得，预先设定无人机速度源数据在步骤a中的飞行航线数据中获取，喷洒宽度w在计算过程i中获得，由此计算出无人机喷洒农药的总流量a，公式如下：在所受水泵压力恰好使喷雾均匀时的喷洒效率最高，此时的压力值也常作为喷嘴工作的最小压力pmin，此时单个喷嘴的喷洒流量为则一组喷嘴的流量为可以求出所需的开启的喷嘴组数为k，此时k若为小数，不满足实际情况，可k取数轴上比k小且离k最近的整数k1，然后通过加大压力的方式，补偿剩余所需流量；iii、增压补偿流量r计算设在pmin下，采用k1组喷嘴后，为满足喷洒总流量a的需求，单组喷嘴还需补充的流量r，公式为r＝(k-k1)*(2*a)iv、最佳巡航速度va1计算单个喷嘴所受水泵压力从pmin增加到pmax时，单个喷嘴的流量增加量为b，则压力后，已开启所有喷嘴总流量相比pmin时增加量为(2*b)*k1。若r大于(2*b)*k1。，即无法通过增加压强来满足喷洒总流量为a的需求，则可以通过适当的放慢飞行速度来增加流量；使水泵压强最大时，喷嘴喷洒流量最大，此时飞机飞行速度变化量最小，对于作业效率降低最小；单个喷嘴在水泵压力最大时的流量为(a+b)，则单组喷嘴的总流量为2*(a+b)；假设无人机在速度为va1，喷嘴总流量为2*(a+b)*k1时，正好能使vol升农药均匀喷洒在面积为s的农田上，则应该满足如下关系式，从而可以求出最佳飞机巡航速度va1；若r小于(2*b)*k,即可以通过增加压强来满足喷洒总流量为a的需求，巡航速度为飞行航线任务中的巡航速度信息；c.在进行植保作业时，辅控芯片b捕获流量计输出的脉冲信号，根据脉冲信号的频率计算出单个喷嘴喷洒的农药的流量，然后对每个喷嘴的流量数据进行检测，检测结果分为三种情况：a、每个喷嘴流量均处于设定的最低值之上；b、单个喷嘴流量处于最低值之下；c、每个喷嘴流量均处于最低值之下；在检测情况为a时，求取流量的均值，当做反馈信号用于流量控制；在检测情况为b时，关闭水泵，并发送故障指令1给fcs，fcs收到指令后，记录当前的gps坐标并返航；在检测情况为c时，关闭水泵，并发送故障指令2给fcs，fcs收到指令后，记录当前的gps坐标并返航，故障指令1表示某一个或多个喷嘴的喷洒状态异常，故障指令2表示所有喷嘴的喷洒状态异常；d.正常作业时，流量检测结果为a，根据反馈回来的流量信息，可以对喷洒量进行控制，首先从fcs获取当前无人机飞行的速度，通过无人机飞行速度和单个喷嘴流量，可以计算单个喷嘴的流量a1为：其中此处h0和va0为飞机的实际高度和速度此处h0和va0为飞机的实际高度和速度。将期望流量与当前流量做差得到流量误差，流量误差经过pid(比例、微分和积分)控制器运算，生成pwm(脉冲宽度调制)占空比的修正量，输出给电源模块，控制水泵压力，使单个喷嘴流速发生变化，使无人机喷洒更加均匀，该流量再由流量计发送给辅控芯片b，为步骤b作数据参考；pid控制器是由比例单元、积分单元和微分单组成。pid控制器可以根据历史数据和差别的出现率来调整输入值，这样可以使系统更加准确，更加稳定。pwm(脉冲宽度调制)是一种模拟控制方式，其根据相应载荷的变化来调制晶体管基极或mos管栅极的偏置，来实现晶体管或mos管导通时间的改变，从而实现电源模块输出的改变，并使电源的输出电压在工作条件变化时保持恒定。即当飞机正常作业时，也可以通过飞行速度和飞行当fcs检测到动力电池低电量时，发送关机指令给isms，isms关闭水泵及所有常闭进水阀，fcs记录当前gps坐标，返航。当前第1页12