CN107264804A - 一种基于gps的无人飞行器变量喷雾控制装置与方法 - Google Patents
一种基于gps的无人飞行器变量喷雾控制装置与方法 Download PDFInfo
- Publication number
- CN107264804A CN107264804A CN201710333510.4A CN201710333510A CN107264804A CN 107264804 A CN107264804 A CN 107264804A CN 201710333510 A CN201710333510 A CN 201710333510A CN 107264804 A CN107264804 A CN 107264804A
- Authority
- CN
- China
- Prior art keywords
- subsystem
- flow
- control
- mrow
- unmanned vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 239000007921 spray Substances 0.000 title claims abstract description 45
- 238000000034 method Methods 0.000 title claims abstract description 16
- 239000012528 membrane Substances 0.000 claims abstract description 37
- 230000008859 change Effects 0.000 claims abstract description 19
- 238000000926 separation method Methods 0.000 claims abstract description 9
- 230000004888 barrier function Effects 0.000 claims abstract 2
- 239000007788 liquid Substances 0.000 claims description 26
- 238000005507 spraying Methods 0.000 claims description 26
- 238000005070 sampling Methods 0.000 claims description 14
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 13
- 238000004891 communication Methods 0.000 claims description 10
- 230000010354 integration Effects 0.000 claims description 9
- 239000000575 pesticide Substances 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 239000003595 mist Substances 0.000 claims description 6
- 239000002245 particle Substances 0.000 claims description 4
- 239000000295 fuel oil Substances 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 230000003750 conditioning effect Effects 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 claims 1
- 239000003814 drug Substances 0.000 claims 1
- 238000005516 engineering process Methods 0.000 abstract description 11
- 230000033228 biological regulation Effects 0.000 abstract description 3
- 238000011217 control strategy Methods 0.000 abstract 2
- 230000015572 biosynthetic process Effects 0.000 abstract 1
- 241000208340 Araliaceae Species 0.000 description 3
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 3
- 235000003140 Panax quinquefolius Nutrition 0.000 description 3
- 238000005119 centrifugation Methods 0.000 description 3
- 235000008434 ginseng Nutrition 0.000 description 3
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 2
- 239000003905 agrochemical Substances 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000000465 moulding Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 239000000126 substance Substances 0.000 description 2
- 241000196324 Embryophyta Species 0.000 description 1
- 230000004308 accommodation Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000000889 atomisation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000003912 environmental pollution Methods 0.000 description 1
- 239000000686 essence Substances 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000002156 mixing Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000002663 nebulization Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D1/00—Dropping, ejecting, releasing, or receiving articles, liquids, or the like, in flight
- B64D1/16—Dropping or releasing powdered, liquid, or gaseous matter, e.g. for fire-fighting
- B64D1/18—Dropping or releasing powdered, liquid, or gaseous matter, e.g. for fire-fighting by spraying, e.g. insecticides
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B05—SPRAYING OR ATOMISING IN GENERAL; APPLYING FLUENT MATERIALS TO SURFACES, IN GENERAL
- B05B—SPRAYING APPARATUS; ATOMISING APPARATUS; NOZZLES
- B05B12/00—Arrangements for controlling delivery; Arrangements for controlling the spray area
- B05B12/08—Arrangements for controlling delivery; Arrangements for controlling the spray area responsive to condition of liquid or other fluent material to be discharged, of ambient medium or of target ; responsive to condition of spray devices or of supply means, e.g. pipes, pumps or their drive means
- B05B12/085—Arrangements for controlling delivery; Arrangements for controlling the spray area responsive to condition of liquid or other fluent material to be discharged, of ambient medium or of target ; responsive to condition of spray devices or of supply means, e.g. pipes, pumps or their drive means responsive to flow or pressure of liquid or other fluent material to be discharged
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Pest Control & Pesticides (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Catching Or Destruction (AREA)
Abstract
本发明公开了一种基于GPS的无人飞行器变量喷雾控制装置与方法,装置包括飞行控制子***、传感采集子***、流量控制子***及电源模块,传感采集子***分别与飞行控制子***和流量控制子***连接,电源模块分别为飞行控制子***、传感采集子***、流量控制子***供电;方法指通过积分分离的PID控制策略将飞行速度所对应的流量值作为给定值,再由单片机输出相应的PWM信号改变隔膜泵转速,从而实现流量的改变;该PID控制策略指用流量传感器检测喷头的流量,不断地比较过程变量与设定值,不断校正和控制泵的流量,以提高控制精度。本发明采用PWM技术调节隔膜泵实现流量随速度变化而变化的控制,形成效率高、稳定性好、成本低的智能化变量喷雾控制***。
Description
技术领域
本发明涉及农业航空植保机械装备、变量控制技术的研究领域,特别涉及一种基于GPS的无人飞行器变量喷雾控制装置与方法。
背景技术
变量喷雾是实现农业航空领域精准施药技术的一种重要方式。变量喷雾技术可根据作业速度、作物密度及虫害程度自动调节喷量,既节约农药,又可减少农产品中的农药残留和环境污染,是施药技术的重要发展方向。变量喷雾施药可以通过变喷雾时间、变喷雾压力及变药液浓度3种途径实现。PWM技术调节水泵实现流量控制是一种变喷雾时间方法,相对于其他变量喷雾技术其实现简便,对喷雾粒径影响较小,故应用较为广泛。
国内外学者研究开发了不少变量施药***,如控制药液混合比改变药液浓度实现变量施药,但存在浓度延时问题,***复杂,施药剂量调节幅度小。另有基于地理信息***的自动对靶变量喷雾控制装置,变量喷雾装备各个喷头的喷量需要控制中心在变量喷雾处方图的指导下,根据地面移动装载装备的位置、速度、喷雾***的流量以及压力,利用伺服阀来控制,但与无人机喷雾相比,地面移动装载装备喷雾效率较低,且会留下辙印和损坏农作物。
近年来,随着现代农业及高新技术的快速发展,变量喷雾技术主要有基于红外线、超声波、机器视觉及激光雷达等变量喷雾方式,这些方式虽然是技术先进,但是由于过程复杂,操作不易,很难在实际应用中取得良好的喷雾效果。基于GPS的变量喷雾***,由于GPS模块精度高、稳定性好、成本低及普遍适用性等特点使其在农业航空变量喷雾应用中得以考虑,通过改进的PWM算法改变每秒脉冲个数及脉冲宽度来调节流量,优势明显。
发明内容
本发明的主要目的在于克服现有技术的缺点与不足,提供一种基于GPS的无人飞行器变量喷雾的控制装置与方法,将无人机与变量喷雾***有机结合,通过GPS模块测出无人飞行器的飞行速度,采用PWM技术调节隔膜泵实现流量随速度变化而变化的控制,形成效率高、稳定性好、成本低的智能化变量喷雾控制***。
为了达到上述目的,本发明采用以下技术方案:
本发明公开了一种基于GPS的无人飞行器变量喷雾控制装置,飞行控制子***、传感采集子***、流量控制子***及电源模块,所述传感采集子***分别与飞行控制子***和流量控制子***连接,所述电源模块分别为飞行控制子***、传感采集子***、流量控制子***供电;
所述飞行控制子***,用于控制飞行器以适当的姿态、速度及高度飞行;
所述传感采集子***,通过GPS模块实时获取无人飞行器的飞行速度、高度参数,通过流量传感器模块实时获取流经喷头的药液流量,通过液位传感器模块获取药箱中液位高度;
所述流量控制子***,用于控制药液流量随无人飞行器速度、高度改变而改变,实现量精准、变化稳定、喷幅平稳的流量控制;
所述飞行控制子***包括主控制器、动力子***、远程遥控通信子***及飞行数据记录子***,所述主控制器与动力子***、远程遥控通信子***及飞行数据记录子***连接,所述动子***中包括惯性姿态测量装置和数字舵机,所述惯性姿态测量装置,用于实时测量飞行器的姿态信息,便于调整飞行姿态,所述远程通信控制子***与地面控制在无线通信,所述地面控制站,用于操作者调整无人飞行器的姿态、速度及高度;
所述传感采集子***包括GPS模块、流量传感器模块、液位传感器模块,各模块均电气上与挂载在无人飞行器上次控制器相连,并通过信号调理电路将模拟信号变为数字信号上传至次控制器;
所述流量控制子***包括次控制器、药箱、隔膜泵及喷头,其中药箱、隔膜泵、流量传感器及喷头物理上采用水管依次顺序连接,隔膜泵电气上与次控制器相连。
作为优选的技术方案,所述次控制器独立于飞行控制子***的主控制器,用于传感采集子***的数据采集、流量控制子***的流量控制及液位报警提示。
作为优选的技术方案,所述主控制器,设置于飞行控制子***中,处理飞行器位置信息、姿态信息的参数,控制飞行器稳定飞行。
作为优选的技术方案,所述动力子***,用于驱动螺旋桨及控制舵机的驱动,在电动无人机中动力子***包含供电子***;在燃油无人机中动力子***与供电子***独立;
所述远程遥控通信子***,包括无线模块,用于飞行器与地面控制站进行通信;
所述飞行数据记录子***,用于实时记录飞行器飞行过程中经纬度参数、速度参数、海拔参数及喷洒流量参数,并通过文件***将数据存至SD卡中。
作为优选的技术方案,所述GPS模块,实时获取无人飞行器的飞行速度、高度数据;
所述流量传感器模块,物理位置上通过水管将进、出水口分别连接隔膜泵和离心雾化喷头,电气上与次控制器相连,选择次控制器定时器的触发输出事件启动ADC转换,ADC选择连续转换模式,在定时器预置的时间里完成设定的采样次数,舍弃最大值和最小值,通过求和平均计算出当前的ADC转换值;
所述液位传感器模块,物理位置上安装在药箱底部,电气特性上连接次控制器,用于药箱内液位信息的采集,并将信息上传至报警***。
作为优选的技术方案,所述流量控制子***包括次控制器、药箱、PWM控制模块、隔膜泵及离心式喷头;
所述药箱容量约为5L,挂载在无人飞行器的正下方,隔膜泵的正上方,出水口与隔膜泵入水口相连;
所述隔膜泵用于提供药液喷施压力,采用12V供电电压喷雾水泵,最大流量为4.5L/min,出水口经二分流装置分别接两个流量传感器模块,再接至安装在喷杆末端的离心雾化喷头;
所述PWM控制模块采用大功率MOS触发开关驱动模块,用于将PWM占空比信号转化成隔膜泵驱动电压信号。
本发明还提供了一种基于GPS的无人飞行器变量喷雾控制装置的控制方法,包括下述步骤:
(1)次控制器通过串口获取GPS模块上传控制器ROM的无人机飞行速度和高度值;
(2)次控制器在规定高度范围内根据流量控制规则输出不同速度值对应占空比的阶跃PWM控制信号;高度范围限定在1~3m,无人飞行器速度范围为0~5m/s,占空比范围0~100%;
(3)阶跃PWM信号经PWM控制模块变成电压信号传输给隔膜泵,从而控制隔膜泵转速的变化,并产生不同的压力将药液输送至流量传感器模块;
(4)流量传感器模块通过ADC采样获取实时流量数据并反馈至次控制器,通过积分分离的PID控制算法不断修正偏差,实现精准施药;喷雾流量范围为0~4.5L/min;
(5)药液经流量传感器模块输送至离心雾化喷头,使得雾滴粒径大小均匀,喷幅稳定。
作为优选的技术方案,步骤(2)中,所述阶跃PWM信号,是指采用积分分离的PID控制算法避免无人机在变量喷雾作业时电机的频繁启动对电机的损害。
作为优选的技术方案,步骤(4)中,所述积分分离的PID控制算法,其实现如下:
将位置式PID算式写成积分分离形式即为:
式中,
k为采样序号,k=0,1,2,3……;
u(k)为第k次采样时刻的计算机输出值;
e(k)为第k次采样时刻输入的偏差值;
e(k-1)为第(k-1)次采样时刻输入的偏差值;
KP为比例常数;
KI为积分常数,
KD为微分常数,
(1)根据实际情况设定阀值ε>0;
(2)当误差|e(k)|>ε阀值时,采用PD控制,此时没有积分项,为了提高控制精度,PD控制算法采用位置式:
u(k)=KPe(k)+KD[e(k)-e(k-1)]
=A′e(k)+B′e(k-1)=A′e(k)+f(k-1)
式中:
f(k-1)=B′e(k-1)
(3)当|e(k)|≤ε时,采用PID控制,为了减少次控制器运算量,进行增量式PID控制算法,即:
u(k)-u(k-1)=Ae(k)-Be(k-1)+Ce(k-2)
u(k)u(k-1)=Ae(k)+u(k-1)-Be(k-1)+Ce(k-2)
=Ae(k)+g(k-1)
式中:
g(k-1)=u(k-1)-Be(k-1)+Ce(k-2)。
作为优选的技术方案,所述流量控制规则指当无人飞行器的飞行速度增大时,单位时间内喷雾量也随之增大,反之单位时间内喷雾量减小,当无人飞行器飞行速度为零时,停止喷雾。无人飞行器的飞行速度和单位时间内的喷雾量可以表示为
式中:q为喷头流量(L/min)
Q为农药喷施量(L/m2)
v为无人机的飞行速度
d为喷幅(m)。
本发明与现有技术相比,具有如下优点和有益效果:
1、本发明引入具有流量反馈的积分分离PID控制算法,流量控制稳定性好,鲁棒性强,响应速度快,避免了无人飞行器在变量喷雾作业时电机的频繁启动对电机的损害。
2、本发明引入无人飞行器作为载具,与地面喷雾载具相比,效率较高,不会留下辙印和损坏农作物。
3、本发明引入双控制器,其中主控制器用于飞行控制,次控制器用于信息采集和流量控制,分工明确,喷雾***不受无人飞行器型号的限制,可移植性强。
4、本发明引入精度高、稳定性好、成本低及适用普遍的GPS模块,使本发明具有良好的可推广性。
附图说明
图1本发明的结构示意图;
图2本发明工作原理示意图;
图3本发明的电路电气结构图;
图4本发明的PID控制原理图;
其中,1—GPS模块,2—流量传感器模块,3—液位传感器模块,4—药箱,5—PWM控制模块,6—隔膜泵,7—离心式喷头,8—报警***,9—地面控制站。
具体实施方式
下面结合实施例及附图对本发明作进一步详细的描述,但本发明的实施方式不限于此。
实施例
如图1所示,在本实施例中,操作者通过地面控制站控制无人飞行器在作业区域距离作物顶部1~3m的高度飞行。喷雾装置通过GPS模块1获取无人飞行器的飞行速度并送入主、次控制器进行处理,次控制器根据不同速度值输出不同占空比的PWM控制信号,此信号传递至PWM控制模块,PWM控制模块将PWM占空比信号转化为相应的隔膜泵输入电压信号,从而控制隔膜泵6的转速改变以提供变化的喷雾压力,最后将药液输送至离心雾化喷头,实现变量喷雾。期间,流量传感器实时检测经喷头的流量值反馈至单片机,通过积分分离PID算法不断修正偏差,达到精准施药的目的。工作过程中无人飞行器的速度、高度、经纬度,流量及液位等数据均通过文件***存至SD卡。
如图2、3所示,在本实施例中,一种基于GPS的无人飞行器变量喷雾控制装置,包括传感采集子***、流量控制子***及飞行控制子***;所述传感采集***包括GPS模块1、流量传感器模块2及液位传感器模块3,各模块均与挂载在无人飞行器上次控制器相连;所述次控制器是指独立于飞行控制主控制器的控制单元,仅用于传感器数据采集、流量控制及液位报警提示等;所述流量控制子***包括次控制器、PWM控制模块、药箱4、隔膜泵6及离心式喷头7,其中药箱、隔膜泵、流量传感器模块及离心式喷头采用水管依次顺序连接,PWM控制模块5和隔膜泵电气上与次控制器相连。所述飞行控制子***分别与动力子***、远程遥控通信子***、飞行数据记录子***。
所述次控制器是指独立于飞行控制主控制器的控制单元,仅用于传感采集子***的数据采集、流量控制子***的流量控制及液位报警提示等,本实施例中通过报警***8进行报警,该报警***包括蜂鸣器和LED两种方式的报警提示;
所述主控制器,用于仅用于飞行控制子***,处理飞行器位置信息、姿态信息等参数,控制飞行器稳定飞行;
所述飞行控制子***,用于控制飞行器以适当的姿态、速度及高度飞行;
所述动力子***,用于驱动螺旋桨及控制舵机,在电动无人机中包含供电子***;在燃油无人机中动力子***与供电子***独立。
所述远程遥控通信子***,用于飞行器与地面控制站进行通信,通信特点为低速率、长距离、高可靠性;
所述飞行数据记录子***,用于实时记录飞行器飞行过程中经纬度参数、速度参数、海拔参数及喷洒流量参数,并通过文件***将数据存至SD卡中;
所述飞行控制子***包括地面控制站、主控制器、GPS模块、惯性姿态测量装置和数字舵机;
所述地面控制站9,用于操作者调整无人飞行器的姿态、速度及高度等;
所述GPS模块是指GPS接收机根据NMEA-0183协议的标准规范,将无人飞行器的位置、速度及高度等信息通过串口传送到主、次控制器;
所述NMEA-0183协议所规定的通讯语句都已是以ASCII码为基础,NMEA-0183协议语句的数据格式如下:“$”为语句起始标志;“,”为域分隔符;“*”为校验和识别符,其后面的两位数为校验和,代表了“$”和“*”之间所有字符的按位异或值(不包括这两个字符);“/”为终止符,所有的语句必须以此来结束;
所述惯性姿态测量装置,用于实时测量飞行器的姿态信息,便于调整飞行姿态;
所述传感采集***是指通过GPS模块1实时获取无人飞行器的飞行速度、高度等参数,通过流量传感器模块实时获取流经喷头的药液流量,通过液位传感器模块获取药箱中液位高度;
所述流量传感器模块2,物理位置上通过水管将进、出水口分别连接隔膜泵和离心雾化喷头,电气上与次控制器相连,选择次控制器定时器的触发输出事件启动ADC转换,ADC选择连续转换模式,在定时器预置的时间里完成52次采样,舍弃最大值和最小值,通过求和平均计算出当前的ADC转换值。考虑到经ADC转换后的数字量所存在的噪声干扰,采用软件方法进行滤波处理。本***在算术平均值的基础上采用了加权平均值滤波算法,以确保测量结果的准确性;
所述液位传感器模块3,物理位置上安装在药箱底部,电气特性上连接次控制器,用于药箱内液位信息采集,并将信息上传至报警***;
所述报警***8包括LED灯和蜂鸣器,报警触发时伴随着LED的闪烁和蜂鸣器的警报声;
所述流量控制子***用于控制流量随无人飞行器速度、高度改变而改变,实现量精准、变化稳定、喷幅平稳的流量控制。
所述流量控制子***包括次控制器、药箱、PWM控制模块、隔膜泵及离心式喷头;
所述药箱容量约为5L,挂载在无人飞行器的正下方,隔膜泵的正上方,出水口与隔膜泵入水口相连;
所述隔膜泵用于提供药液喷施压力,采用12V供电电压喷雾水泵,最大流量为4.5L/min,出水口经二分流装置分别接两个流量传感器模块,再接至安装在喷杆末端的离心雾化喷头;
所述PWM控制模块采用大功率MOS触发开关驱动模块,用于将PWM占空比信号转化成隔膜泵驱动电压信号;
在本实施例中,所述基于GPS的无人飞行器变量喷雾的控制方法,包括以下步骤:
(1)次控制器通过串口获取GPS模块上传控制器ROM的无人机飞行速度和高度值;
(2)次控制器在规定高度范围内根据流量控制规则输出不同速度值对应占空比的阶跃PWM控制信号;高度范围限定在1~3m,无人飞行器速度范围为0~5m/s,占空比范围0~100%;
(3)阶跃PWM信号经PWM控制模块变成电压信号传输给隔膜泵,从而控制隔膜泵转速的变化,并产生不同的压力将药液输送至流量传感器模块。
(4)流量传感器模块通过ADC采样获取实时流量数据并反馈至次控制器,通过PID算法不断修正偏差,实现精准施药;喷雾流量范围为0~4.5L/min;
(5)药液经流量传感器模块输送至离心雾化喷头,使得雾滴粒径大小均匀,喷幅稳定。
优选的,所述阶跃PWM信号,是指采用积分分离的PID控制算法避免无人机在变量喷雾作业时电机的频繁启动对电机的损害;
如图4所示,在本实施例中,所述积分分离的PID控制算法,其实现如下:
(1)根据实际情况设定阀值ε;
(2)当误差e(t)>ε时,采用PD控制,可避免过大的超调,有使***有较快的响应;
(3)当误差e(t)≤ε时,采用PID控制,可保证***的控制精度;
所述流量控制规则指当无人飞行器的飞行速度增大时,单位时间内喷雾量也随之增大,反之单位时间内喷雾量减小,当无人飞行器飞行速度为零时,停止喷雾。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
Claims (10)
1.一种基于GPS的无人飞行器变量喷雾控制装置,其特征在于,飞行控制子***、传感采集子***、流量控制子***及电源模块,所述传感采集子***分别与飞行控制子***和流量控制子***连接,所述电源模块分别为飞行控制子***、传感采集子***、流量控制子***供电;
所述飞行控制子***,用于控制飞行器以适当的姿态、速度及高度飞行;
所述传感采集子***,通过GPS模块实时获取无人飞行器的飞行速度、高度参数,通过流量传感器模块实时获取流经喷头的药液流量,通过液位传感器模块获取药箱中液位高度;
所述流量控制子***,用于控制药液流量随无人飞行器速度、高度改变而改变,实现量精准、变化稳定、喷幅平稳的流量控制;
所述飞行控制子***包括主控制器、动力子***、远程遥控通信子***及飞行数据记录子***,所述主控制器与动力子***、远程遥控通信子***及飞行数据记录子***连接,所述动子***中包括惯性姿态测量装置和数字舵机,所述惯性姿态测量装置,用于实时测量飞行器的姿态信息,便于调整飞行姿态,所述远程通信控制子***与地面控制在无线通信,所述地面控制站,用于操作者调整无人飞行器的姿态、速度及高度;
所述传感采集子***包括GPS模块、流量传感器模块、液位传感器模块,各模块均电气上与挂载在无人飞行器上次控制器相连,并通过信号调理电路将模拟信号变为数字信号上传至次控制器;
所述流量控制子***包括次控制器、药箱、隔膜泵及喷头,其中药箱、隔膜泵、流量传感器及喷头物理上采用水管依次顺序连接,隔膜泵电气上与次控制器相连。
2.根据权利要求1所述一种基于GPS的无人飞行器变量喷雾控制装置,其特征在于,所述次控制器独立于飞行控制子***的主控制器,用于传感采集子***的数据采集、流量控制子***的流量控制及液位报警提示。
3.根据权利要求1所述一种基于GPS的无人飞行器变量喷雾控制装置,其特征在于,所述主控制器,设置于飞行控制子***中,处理飞行器位置信息、姿态信息的参数,控制飞行器稳定飞行。
4.根据权利要求1所述一种基于GPS的无人飞行器变量喷雾控制装置,其特征在于,所述动力子***,用于驱动螺旋桨及控制舵机的驱动,在电动无人机中动力子***包含供电子***;在燃油无人机中动力子***与供电子***独立;
所述远程遥控通信子***,包括无线模块,用于飞行器与地面控制站进行通信;
所述飞行数据记录子***,用于实时记录飞行器飞行过程中经纬度参数、速度参数、海拔参数及喷洒流量参数,并通过文件***将数据存至SD卡中。
5.根据权利要求1所述一种基于GPS的无人飞行器变量喷雾控制装置,其特征在于,所述GPS模块,实时获取无人飞行器的飞行速度、高度数据;
所述流量传感器模块,物理位置上通过水管将进、出水口分别连接隔膜泵和离心雾化喷头,电气上与次控制器相连,选择次控制器定时器的触发输出事件启动ADC转换,ADC选择连续转换模式,在定时器预置的时间里完成设定的采样次数,舍弃最大值和最小值,通过求和平均计算出当前的ADC转换值;
所述液位传感器模块,物理位置上安装在药箱底部,电气特性上连接次控制器,用于药箱内液位信息的采集,并将信息上传至报警***。
6.根据权利要求1所述一种基于GPS的无人飞行器变量喷雾控制装置,其特征在于,所述流量控制子***包括次控制器、药箱、PWM控制模块、隔膜泵及离心式喷头;
所述药箱容量约为5L,挂载在无人飞行器的正下方,隔膜泵的正上方,出水口与隔膜泵入水口相连;
所述隔膜泵用于提供药液喷施压力,采用12V供电电压喷雾水泵,最大流量为4.5L/min,出水口经二分流装置分别接两个流量传感器模块,再接至安装在喷杆末端的离心雾化喷头;
所述PWM控制模块采用大功率MOS触发开关驱动模块,用于将PWM占空比信号转化成隔膜泵驱动电压信号。
7.一种基于GPS的无人飞行器变量喷雾控制装置的控制方法,其特征在于,包括下述步骤:
(1)次控制器通过串口获取GPS模块上传控制器ROM的无人机飞行速度和高度值;
(2)次控制器在规定高度范围内根据流量控制规则输出不同速度值对应占空比的阶跃PWM控制信号;高度范围限定在1~3m,无人飞行器速度范围为0~5m/s,占空比范围0~100%;
(3)阶跃PWM信号经PWM控制模块变成电压信号传输给隔膜泵,从而控制隔膜泵转速的变化,并产生不同的压力将药液输送至流量传感器模块;
(4)流量传感器模块通过ADC采样获取实时流量数据并反馈至次控制器,通过积分分离的PID控制算法不断修正偏差,实现精准施药;喷雾流量范围为0~4.5L/min;
(5)药液经流量传感器模块输送至离心雾化喷头,使得雾滴粒径大小均匀,喷幅稳定。
8.根据权利要求7所述的基于GPS的无人飞行器变量喷雾的控制方法,其特征在于,步骤(2)中,所述阶跃PWM信号,是指采用积分分离的PID控制算法避免无人机在变量喷雾作业时电机的频繁启动对电机的损害。
9.根据权利要求7所述的基于GPS的无人飞行器变量喷雾的控制方法,其特征在于,步骤(4)中,所述积分分离的PID控制算法,其实现如下:
将位置式PID算式写成积分分离形式即为:
<mrow>
<mi>u</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>P</mi>
</msub>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>&alpha;K</mi>
<mi>I</mi>
</msub>
<msubsup>
<mi>&Sigma;</mi>
<mrow>
<mi>n</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mi>k</mi>
</msubsup>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>j</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>K</mi>
<mi>D</mi>
</msub>
<mo>&lsqb;</mo>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
式中,
k为采样序号,k=0,1,2,3……;
u(k)为第k次采样时刻的计算机输出值;
e(k)为第k次采样时刻输入的偏差值;
e(k-1)为第(k-1)次采样时刻输入的偏差值;
KP为比例常数;
KI为积分常数,
KD为微分常数,
(1)根据实际情况设定阀值ε>0;
(2)当误差|e(k)|>ε阀值时,采用PD控制,此时没有积分项,为了提高控制精度,PD控制算法采用位置式:
u(k)=KPe(k)+KD[e(k)-e(k-1)]
=A′e(k)+B′e(k-1)=A′e(k)+f(k-1)
式中:
<mrow>
<msup>
<mi>B</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>P</mi>
</msub>
<mfrac>
<msub>
<mi>T</mi>
<mi>D</mi>
</msub>
<mi>T</mi>
</mfrac>
</mrow>
f(k-1)=B′e(k-1)
(3)当|e(k)|≤ε时,采用PID控制,为了减少次控制器运算量,进行增量式PID控制算法,即:
u(k)-u(k-1)=Ae(k)-Be(k-1)+Ce(k-2)
u(k)u(k-1)=Ae(k)+u(k-1)-Be(k-1)+Ce(k-2)
=Ae(k)+g(k-1)
式中:
<mrow>
<mi>B</mi>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>P</mi>
</msub>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>+</mo>
<mn>2</mn>
<mfrac>
<msub>
<mi>T</mi>
<mi>D</mi>
</msub>
<mi>T</mi>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>C</mi>
<mo>=</mo>
<msub>
<mi>K</mi>
<mi>P</mi>
</msub>
<mfrac>
<msub>
<mi>T</mi>
<mi>D</mi>
</msub>
<mi>T</mi>
</mfrac>
</mrow>
g(k-1)=u(k-1)-Be(k-1)+Ce(k-2)。
10.根据权利要求7所述的基于GPS的无人飞行器变量喷雾的控制方法,其特征在于,所述流量控制规则指当无人飞行器的飞行速度增大时,单位时间内喷雾量也随之增大,反之单位时间内喷雾量减小,当无人飞行器飞行速度为零时,停止喷雾。无人飞行器的飞行速度和单位时间内的喷雾量可以表示为
<mrow>
<mi>q</mi>
<mo>=</mo>
<mfrac>
<mrow>
<mi>Q</mi>
<mi>v</mi>
<mi>d</mi>
</mrow>
<mn>60</mn>
</mfrac>
</mrow>
式中:q为喷头流量(L/min)
Q为农药喷施量(L/m2)
v为无人机的飞行速度
d为喷幅(m)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710333510.4A CN107264804A (zh) | 2017-05-12 | 2017-05-12 | 一种基于gps的无人飞行器变量喷雾控制装置与方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710333510.4A CN107264804A (zh) | 2017-05-12 | 2017-05-12 | 一种基于gps的无人飞行器变量喷雾控制装置与方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107264804A true CN107264804A (zh) | 2017-10-20 |
Family
ID=60073971
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710333510.4A Pending CN107264804A (zh) | 2017-05-12 | 2017-05-12 | 一种基于gps的无人飞行器变量喷雾控制装置与方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107264804A (zh) |
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107725310A (zh) * | 2017-11-09 | 2018-02-23 | 农业部南京农业机械化研究所 | 一种植保无人机施药泵及其控制方法 |
CN108116669A (zh) * | 2017-12-23 | 2018-06-05 | 中山市得高行知识产权中心(有限合伙) | 一种具有自动检测余药量装置的农用无人机 |
CN108271493A (zh) * | 2018-02-11 | 2018-07-13 | 华南农业大学 | 一种基于无人机的茶园喷雾***及喷雾方法 |
CN108363335A (zh) * | 2018-04-03 | 2018-08-03 | 南京林业大学 | 农用无人机航空施药作业监控装置 |
CN108507645A (zh) * | 2018-05-28 | 2018-09-07 | 拓攻(南京)机器人有限公司 | 无人机上流量计的校准系数确定方法、校准方法及装置 |
CN108522472A (zh) * | 2018-04-08 | 2018-09-14 | 吴李海 | 一种植保多旋翼无人机 |
CN108760283A (zh) * | 2018-08-17 | 2018-11-06 | 农业部南京农业机械化研究所 | 一种遥控可重复雾滴喷洒质量测试装置及方法 |
CN109122634A (zh) * | 2018-08-10 | 2019-01-04 | 华南农业大学 | 一种基于机器视觉的无人机区域对靶变量施药控制装置与方法 |
CN109258601A (zh) * | 2018-08-10 | 2019-01-25 | 华南农业大学 | 一种智能化的除草无人机自动对靶喷雾流量控制装置与方法 |
CN109613856A (zh) * | 2018-12-03 | 2019-04-12 | 广西云瑞科技有限公司 | 一种基于植保无人机水泵和航向灯的控制装置和方法 |
WO2019085834A1 (zh) * | 2017-11-01 | 2019-05-09 | 华南理工大学 | 一种无人飞行器稳定飞行控制方法 |
DE102018104827A1 (de) * | 2018-03-02 | 2019-09-05 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Unbemannter Drehflügler, System und Verfahren zum Ausbringen eines Spritzguts |
CN110547280A (zh) * | 2019-10-09 | 2019-12-10 | 张青丰 | 一种农用雾化喷药无人机 |
AU2018402492B2 (en) * | 2018-06-29 | 2020-07-09 | Nanjing Institute Of Agricultural Mechanization, Ministry Of Agriculture And Rural Affairs | Method for testing spray flow of diaphragm pump of plant protection unmanned aerial vehicle based on microphone |
CN111495634A (zh) * | 2020-04-21 | 2020-08-07 | 深圳市优必选科技股份有限公司 | 一种喷壶控制电路、喷壶控制装置及机器人 |
CN111974572A (zh) * | 2020-08-21 | 2020-11-24 | 广州大学 | 一种雾化装置的雾化方法 |
CN112154996A (zh) * | 2020-09-17 | 2021-01-01 | 华南农业大学 | 一种双重pid控制精准变量施药***及其反馈调节方法 |
CN112181029A (zh) * | 2020-10-15 | 2021-01-05 | 苏州千诚锐创机器人科技有限公司 | 一种pid控制植保无人机喷洒***和方法 |
CN112748745A (zh) * | 2021-01-21 | 2021-05-04 | 江苏科技大学 | 无人机与随动小车的联控方法及*** |
CN112859900A (zh) * | 2021-01-21 | 2021-05-28 | 江苏科技大学 | 无人机喷涂稳定性自适应控制方法及*** |
CN112892944A (zh) * | 2021-01-21 | 2021-06-04 | 江苏科技大学 | 适用于变曲率外板的无人机智能喷涂装置及动态调整方法 |
CN113460308A (zh) * | 2021-07-30 | 2021-10-01 | 中国农业大学 | 一种无人机变量施药控制***及方法 |
CN113557480A (zh) * | 2020-10-26 | 2021-10-26 | 深圳市大疆创新科技有限公司 | 液体喷洒装置及其控制方法、无人飞行器和存储介质 |
CN113598147A (zh) * | 2021-07-27 | 2021-11-05 | 吉林大学重庆研究院 | 一种基于pwm的植保无人机机载变量控制*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104670496A (zh) * | 2015-03-11 | 2015-06-03 | 西南大学 | 一种六轴式农药喷雾飞行装置及控制方法 |
CN105173085A (zh) * | 2015-09-18 | 2015-12-23 | 山东农业大学 | 无人机变量施药自动控制***及方法 |
CN205499375U (zh) * | 2016-01-20 | 2016-08-24 | 南昌中航天信航空科技有限公司 | 植保无人飞行器喷洒控制装置 |
CN105905302A (zh) * | 2016-06-02 | 2016-08-31 | 中国农业大学 | 一种植保无人机智能施药***及控制方法 |
-
2017
- 2017-05-12 CN CN201710333510.4A patent/CN107264804A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104670496A (zh) * | 2015-03-11 | 2015-06-03 | 西南大学 | 一种六轴式农药喷雾飞行装置及控制方法 |
CN105173085A (zh) * | 2015-09-18 | 2015-12-23 | 山东农业大学 | 无人机变量施药自动控制***及方法 |
CN205499375U (zh) * | 2016-01-20 | 2016-08-24 | 南昌中航天信航空科技有限公司 | 植保无人飞行器喷洒控制装置 |
CN105905302A (zh) * | 2016-06-02 | 2016-08-31 | 中国农业大学 | 一种植保无人机智能施药***及控制方法 |
Non-Patent Citations (1)
Title |
---|
刘雨棣,雷新颖: "《计算机控制技术》", 30 November 2013 * |
Cited By (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11721219B2 (en) | 2017-11-01 | 2023-08-08 | South China University Of Technology | Method for controlling steady flight of unmanned aircraft |
WO2019085834A1 (zh) * | 2017-11-01 | 2019-05-09 | 华南理工大学 | 一种无人飞行器稳定飞行控制方法 |
CN107725310A (zh) * | 2017-11-09 | 2018-02-23 | 农业部南京农业机械化研究所 | 一种植保无人机施药泵及其控制方法 |
CN108116669A (zh) * | 2017-12-23 | 2018-06-05 | 中山市得高行知识产权中心(有限合伙) | 一种具有自动检测余药量装置的农用无人机 |
CN108271493A (zh) * | 2018-02-11 | 2018-07-13 | 华南农业大学 | 一种基于无人机的茶园喷雾***及喷雾方法 |
CN108271493B (zh) * | 2018-02-11 | 2024-03-12 | 华南农业大学 | 一种基于无人机的茶园喷雾***及喷雾方法 |
DE102018104827B4 (de) | 2018-03-02 | 2022-11-10 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Unbemannter Drehflügler, System und Verfahren zum Ausbringen eines Spritzguts |
DE102018104827A1 (de) * | 2018-03-02 | 2019-09-05 | Deutsches Zentrum für Luft- und Raumfahrt e.V. | Unbemannter Drehflügler, System und Verfahren zum Ausbringen eines Spritzguts |
CN108363335A (zh) * | 2018-04-03 | 2018-08-03 | 南京林业大学 | 农用无人机航空施药作业监控装置 |
CN108522472A (zh) * | 2018-04-08 | 2018-09-14 | 吴李海 | 一种植保多旋翼无人机 |
CN108507645A (zh) * | 2018-05-28 | 2018-09-07 | 拓攻(南京)机器人有限公司 | 无人机上流量计的校准系数确定方法、校准方法及装置 |
AU2018402492B2 (en) * | 2018-06-29 | 2020-07-09 | Nanjing Institute Of Agricultural Mechanization, Ministry Of Agriculture And Rural Affairs | Method for testing spray flow of diaphragm pump of plant protection unmanned aerial vehicle based on microphone |
CN109258601A (zh) * | 2018-08-10 | 2019-01-25 | 华南农业大学 | 一种智能化的除草无人机自动对靶喷雾流量控制装置与方法 |
CN109122634A (zh) * | 2018-08-10 | 2019-01-04 | 华南农业大学 | 一种基于机器视觉的无人机区域对靶变量施药控制装置与方法 |
CN108760283B (zh) * | 2018-08-17 | 2023-12-29 | 农业部南京农业机械化研究所 | 一种遥控可重复雾滴喷洒质量测试装置及方法 |
CN108760283A (zh) * | 2018-08-17 | 2018-11-06 | 农业部南京农业机械化研究所 | 一种遥控可重复雾滴喷洒质量测试装置及方法 |
CN109613856A (zh) * | 2018-12-03 | 2019-04-12 | 广西云瑞科技有限公司 | 一种基于植保无人机水泵和航向灯的控制装置和方法 |
CN110547280A (zh) * | 2019-10-09 | 2019-12-10 | 张青丰 | 一种农用雾化喷药无人机 |
CN111495634A (zh) * | 2020-04-21 | 2020-08-07 | 深圳市优必选科技股份有限公司 | 一种喷壶控制电路、喷壶控制装置及机器人 |
CN111974572A (zh) * | 2020-08-21 | 2020-11-24 | 广州大学 | 一种雾化装置的雾化方法 |
CN112154996A (zh) * | 2020-09-17 | 2021-01-01 | 华南农业大学 | 一种双重pid控制精准变量施药***及其反馈调节方法 |
CN112154996B (zh) * | 2020-09-17 | 2024-05-10 | 华南农业大学 | 一种双重pid控制精准变量施药***及其反馈调节方法 |
CN112181029A (zh) * | 2020-10-15 | 2021-01-05 | 苏州千诚锐创机器人科技有限公司 | 一种pid控制植保无人机喷洒***和方法 |
CN113557480A (zh) * | 2020-10-26 | 2021-10-26 | 深圳市大疆创新科技有限公司 | 液体喷洒装置及其控制方法、无人飞行器和存储介质 |
CN112859900A (zh) * | 2021-01-21 | 2021-05-28 | 江苏科技大学 | 无人机喷涂稳定性自适应控制方法及*** |
CN112892944A (zh) * | 2021-01-21 | 2021-06-04 | 江苏科技大学 | 适用于变曲率外板的无人机智能喷涂装置及动态调整方法 |
CN112859900B (zh) * | 2021-01-21 | 2022-11-08 | 江苏科技大学 | 无人机喷涂稳定性自适应控制方法及*** |
CN112748745A (zh) * | 2021-01-21 | 2021-05-04 | 江苏科技大学 | 无人机与随动小车的联控方法及*** |
CN113598147A (zh) * | 2021-07-27 | 2021-11-05 | 吉林大学重庆研究院 | 一种基于pwm的植保无人机机载变量控制*** |
CN113460308A (zh) * | 2021-07-30 | 2021-10-01 | 中国农业大学 | 一种无人机变量施药控制***及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107264804A (zh) | 一种基于gps的无人飞行器变量喷雾控制装置与方法 | |
CN105905302B (zh) | 一种植保无人机智能施药***及控制方法 | |
CN109258601B (zh) | 一种智能化的除草无人机自动对靶喷雾流量控制装置与方法 | |
CN106970634B (zh) | 一种智能植保无人机的控制管理***及其控制方法 | |
CN105197243B (zh) | 一种农用无人机机载变量施药***及方法 | |
CN205661666U (zh) | 一种植保无人机智能施药*** | |
CN105707040B (zh) | 一种飞行器航空精准喷施控制***和方法 | |
CN108605923A (zh) | 农药施药监测与精准流量控制装置及方法 | |
CN105843236A (zh) | 一种植保无人机喷洒控制***及其喷洒控制方法 | |
CN103770943A (zh) | 一种智能施药无人直升机 | |
CN104670496A (zh) | 一种六轴式农药喷雾飞行装置及控制方法 | |
CN205018139U (zh) | 一种农用无人机机载变量施药机 | |
CN108536170B (zh) | 一种航空变量施药监控装置及方法 | |
CN109353521A (zh) | 一种精准喷洒的无人机***及其控制方法 | |
WO2021087736A1 (zh) | 水泵流量的控制方法、水泵控制***和农业无人飞行器 | |
CN108536203A (zh) | 一种无人机施药控制方法及*** | |
CN105984588A (zh) | 一种基于旋翼无人机机载的新型变量喷雾*** | |
CN106719555A (zh) | 一种无人机搭载式农药喷洒*** | |
CN211581326U (zh) | 一种植保无人机农药喷洒*** | |
CN204415735U (zh) | 一种可全自主飞行并喷洒农药的无人直升机*** | |
CN208271034U (zh) | 一种航空变量施药监控装置 | |
CN105900965A (zh) | 一种四旋翼植保无人机农药静电喷洒*** | |
CN205060033U (zh) | 飞行高度精确的农药喷洒机 | |
CN205327422U (zh) | 一种具有喷洒装置的植保无人机控制*** | |
CN108190026A (zh) | 一种植保无人机智能控制*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20171020 |