CN107728631A - 基于质量测量的植保无人机控制***及方法 - Google Patents
基于质量测量的植保无人机控制***及方法 Download PDFInfo
- Publication number
- CN107728631A CN107728631A CN201710872384.XA CN201710872384A CN107728631A CN 107728631 A CN107728631 A CN 107728631A CN 201710872384 A CN201710872384 A CN 201710872384A CN 107728631 A CN107728631 A CN 107728631A
- Authority
- CN
- China
- Prior art keywords
- plant protection
- unmanned plane
- protection unmanned
- compensation rate
- gravity
- 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.)
- Granted
Links
- 238000005259 measurement Methods 0.000 title claims abstract description 33
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000005484 gravity Effects 0.000 claims abstract description 115
- 239000003905 agrochemical Substances 0.000 claims abstract description 20
- 239000000575 pesticide Substances 0.000 claims abstract description 8
- 238000005507 spraying Methods 0.000 claims abstract description 6
- 230000000694 effects Effects 0.000 claims abstract description 3
- 238000004364 calculation method Methods 0.000 claims description 23
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000005611 electricity Effects 0.000 claims description 6
- 238000004088 simulation Methods 0.000 claims description 6
- 230000008859 change Effects 0.000 description 9
- 230000036544 posture Effects 0.000 description 8
- 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 6
- 238000010586 diagram Methods 0.000 description 6
- 230000008901 benefit Effects 0.000 description 4
- 239000007921 spray Substances 0.000 description 4
- 238000005183 dynamical system Methods 0.000 description 3
- 230000009467 reduction Effects 0.000 description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000007667 floating Methods 0.000 description 2
- 238000009472 formulation Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 239000000203 mixture Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000010355 oscillation Effects 0.000 description 2
- 230000036624 brainpower Effects 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000003912 environmental pollution Methods 0.000 description 1
- 230000010006 flight Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
Classifications
-
- 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/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种基于质量测量的植保无人机控制***及方法,其中的方法用于对正在进行农药喷洒作用的植保无人机的飞行进行控制,包括:实时测量植保无人机的农药消耗量;将植保无人机的初始质量减去农药消耗量得到植保无人机的实时总质量;根据植保无人机的实时总质量计算植保无人机实时的水平姿态的第一重力距补偿量;根据植保无人机的实时姿态信息和第一重力距补偿量计算植保无人机在不同飞行姿态下的第二重力距补偿量;根据第二重力距补偿量调整植保无人机的电机的转速。其提升了植保无人机的控制精度和增加了植保无人机飞行的平稳性和安全性。
Description
技术领域
本发明涉及无人机术领域,特别是涉及基于质量测量的植保无人机控制***及方法。
背景技术
多旋翼无人机的控制方法一般都是根据位置、姿态需求按照一定的控制算法分解得到总的拉力及体坐标系下的三个扭矩指令,然后根据多旋翼特定的构型分布对应的分配矩阵分解得到每个电机的转速平方指令,进而得到每个电机的转速指令。最后通过电机调速器控制电机的转速。
然而,多旋翼植保无人机比较特殊,其作业飞行过程中所运载的药液不断减少会导致飞机重量(即质量)不断减小。此外,对于重量分布不是中心对称的植保无人机,其重量不断变化还会导致其重心位置不断改变,为了保证飞机的平稳飞行,其飞控***的控制分配矩阵需要相应地进行动态改变。这是由于控制分配矩阵一般是建立在飞机的几何中心,当几何中心与重心重合时,重力矩为零,因此重力变化对于控制分配的影响不存在。当重心不在几何中心,且重心位置发生动态改变时,原来不考虑重力矩的力矩方程不再平衡,必须增加重力矩相关项才能够保证方程动态平衡。
因此,对于多旋翼植保无人机,需要对其质量与重力附加力矩实时估计,才能够得到精确的动力学控制模型。为了减少农药用量、降低农药残留、减小生态环境污染,精准农业航空理念和超低剂量喷洒等技术的推广应用对植保无人机的精准控制要求越来越高。
发明内容
鉴于上述问题,本发明的一个目的是要提供一种克服上述问题或者至少部分地解决上述问题的基于质量测量的植保无人机控制***及方法。
本发明一个进一步的目的是提升植保无人机的控制精度和增加植保无人机飞行的平稳性和安全性。
根据本发明的一个方面,本发明提供了一种基于质量测量的植保无人机控制方法,用于对正在进行农药喷洒作用的植保无人机的飞行进行控制,包括:
实时测量植保无人机的农药消耗量;
将植保无人机的初始质量减去农药消耗量得到植保无人机的实时总质量;
根据植保无人机的实时总质量计算植保无人机实时的水平姿态的第一重力距补偿量;
根据植保无人机的实时姿态信息和第一重力距补偿量计算植保无人机在不同飞行姿态下的第二重力距补偿量;
根据第二重力距补偿量调整植保无人机的电机的转速。
可选地,根据植保无人机的实时总质量计算植保无人机实时的水平姿态的第一重力距补偿量的步骤包括:
获取第一重力距补偿量的拟合计算公式,拟合计算公式表示出植保无人机的实时总质量与第一重力距补偿量的对应关系;
将植保无人机的实时总质量输入计算拟合公式进行计算,得到第一重力距补偿量。
可选地,拟合计算公式为:
ΔM1x(M)=KxM+Bx;
ΔM1y(M)=KyM+By;
其中,ΔM1x(M)为水平方向X轴对应的第一重力矩补偿量,ΔM1y(M)为水平方向Y轴对应的第一重力矩补偿量,M为植保无人机的实时总质量,Kx、Bx均为预设常数。
可选地,植保无人机的实时姿态信息包括植保无人机的滚转角和俯仰角;
根据植保无人机的实时姿态信息和第一重力距补偿量计算植保无人机在不同飞行姿态下的第二重力距补偿量的步骤包括:
获取计算植保无人机在不同飞行姿态下的第二重力距补偿量的计算公式;
将滚转角和俯仰角输入计算公式得到第二重力距补偿量;
计算公式为:ΔM2x=ΔM1xcosΦ,
其中,ΔM2x为水平方向X轴对应的第二重力距补偿量,ΔM2y为水平方向Y轴对应的第二重力距补偿量,ΔM1x为水平方向X轴对应的第一重力矩补偿量,ΔM1y为水平方向Y轴对应的第一重力矩补偿量,Φ为滚转角,为俯仰角。
可选地,根据第二重力距补偿量调整植保无人机的电机的转速的步骤包括:
根据第二重力距补偿量调整植保无人机的控制分配器的输入,以完成控制分配的补偿;
根据控制分配器的输入和控制分配矩阵计算植保无人机的所有电机的转速指令;
根据电机的转速指令控制电机的转速。
根据本发明另一个方面,还提供了一种基于质量测量的植保无人机控制***,包括:
流量计,配置为实时测量植保无人机的农药消耗量;
质量计算单元,配置为将植保无人机的初始质量减去农药消耗量得到植保无人机的实时总质量;
第一计算单元,配置为根据植保无人机的实时总质量计算植保无人机实时的水平姿态的第一重力距补偿量;
第二计算单元,配置为根据植保无人机的实时姿态信息和第一重力距补偿量计算植保无人机在不同飞行姿态下的第二重力距补偿量;
控制单元,配置为根据第二重力距补偿量调整植保无人机的电机的转速。
可选地,第一计算单元还配置为:
获取第一重力距补偿量的拟合计算公式,拟合计算公式表示出植保无人机的实时总质量与第一重力距补偿量的对应关系;
将植保无人机的实时总质量输入计算拟合公式进行计算,得到第一重力距补偿量。
可选地,拟合计算公式为:
ΔM1x(M)=KxM+Bx;
ΔM1y(M)=KyM+By;
其中,ΔM1x(M)为水平方向X轴对应的第一重力矩补偿量,ΔM1y(M)为水平方向Y轴对应的第一重力矩补偿量,M为植保无人机的实时总质量,Kx、Bx均为预设常数。
可选地,控制***还包括:
陀螺仪,配置为测量植保无人机的滚转角和俯仰角;
第二计算单元还配置为:
获取计算植保无人机在不同飞行姿态下的第二重力距补偿量的计算公式,将滚转角和俯仰角输入计算公式得到第二重力距补偿量;
计算公式为:ΔM2x=ΔM1xcosΦ,
其中,ΔM2x为水平方向X轴对应的第二重力距补偿量,ΔM2y为水平方向Y轴对应的第二重力距补偿量,ΔM1x为水平方向X轴对应的第一重力矩补偿量,ΔM1y为水平方向Y轴对应的第一重力矩补偿量,Φ为滚转角,为俯仰角。
可选地,控制单元包括:
第三计算单元,配置为根据第二重力距补偿量调整植保无人机的控制分配器的输入,以完成控制分配的补偿;根据控制分配器的输入和控制分配矩阵计算植保无人机的所有电机的转速指令;
电调,配置为根据电机的转速指令控制电机的转速。
本发明的基于质量测量的植保无人机控制方法,利用额定的初始质量减去实时测量的农药消耗量得到植保无人机的实时总质量,利用植保无人机的实时总质量得到第一重力距补偿量,并根据第一重力距补偿量和植保无人机的飞行姿态得到不同飞行姿态下的第二重力距补偿量,再根据第二重力距补偿量调整植保无人机的电机的转速,从而解决了变质量的植保无人机的平稳飞行控制问题,提升了植保无人机在农药喷洒作用过程中的飞行的平稳性和安全性。
进一步地,本发明的基于质量测量的植保无人机控制方法中,根据植保无人机的实时总质量的变化对植保无人机的飞行进行控制,可明显改善植保无人机起飞或降落过程的平稳性,增加飞行安全性;并可减小飞行过程中刹车期间的振荡摆幅,减少能源消耗,增加飞行时间以及提高植保无人机的抗风能力。
根据下文结合附图对本发明具体实施例的详细描述,本领域技术人员将会更加明了本发明的上述以及其他目的、优点和特征。
附图说明
后文将参照附图以示例性而非限制性的方式详细描述本发明的一些具体实施例。附图中相同的附图标记标示了相同或类似的部件或部分。本领域技术人员应该理解,这些附图未必是按比例绘制的。附图中:
图1是根据本发明一个实施例的植保无人机的示意性结构图;
图2是根据本发明一个实施例的基于质量测量的植保无人机控制***的电器部件的示意图;
图3是根据本发明一个实施例的基于质量测量的植保无人机控制方法的流程图;以及
图4是植保无人机的经典控制***框图。
具体实施方式
本实施例首先提供了一种基于质量测量的植保无人机控制***,图1是根据本发明一个实施例的基于质量测量的植保无人机控制***的电器部件的示意图。
由于植保无人机比较特殊在进行农药喷洒的作业飞行过程中所运载的药液不断减少会导致飞机重量(即质量)不断减小,植保无人机的飞行稳定性会受到植保无人机质量变化的影响。为此,本实施例提供了一种基于质量测量的植保无人机控制***,其目的在于引入植保无人机实时变化的质量解决植保无人机因质量变化而导致的飞行稳定性降低的问题。
如图1所示,本实施例的植保无人机可为多旋翼植保无人机。植保无人机一般性包括机架1、动力电池2、飞控***3、动力***4、药箱5以及喷洒组件6。动力***4包括电调4-1、电机4-2、旋翼4-3,其中旋翼4-3安装在电机4-2上,电机4-2安装在机架1上。喷洒组件6包括水泵6-1、流量计6-2和喷头6-3。动力电池2、飞控***3、动力***4、药箱5以及喷洒组件6都安装在机架1上。
基于质量测量的植保无人机控制***一般性地包括流量计6-2。流量计6-2配置为实时测量植保无人机的农药消耗量。流量计6-2可在不增加额外传感器的情况下同时作为喷洒量传感器,以实现变量喷洒和智能喷洒的作业效果。
图2是根据本发明一个实施例的基于质量测量的植保无人机控制***的电器部件的示意图。如图2所示,特别地,基于质量测量的植保无人机控制***还包括质量计算单元120、第一计算单元130、第二计算单元150和控制单元170。
质量计算单元120配置为将植保无人机的初始质量减去流量计6-2测得的农药消耗量得到植保无人机的实时总质量。第一计算单元130配置为根据植保无人机的实时总质量计算植保无人机实时的水平姿态的第一重力距补偿量。第二计算单元150配置为根据植保无人机的实时姿态信息和第一重力距补偿量计算植保无人机在不同飞行姿态下的第二重力距补偿量。控制单元170配置为根据第二重力距补偿量调整植保无人机的电机4-2的转速。
植保无人机的质量减少的过程与施药量密切相关,无人机的总质量始终等于初始总质量减去施药量。相应的无人机的实时重力附加力矩也与无人机的总质量始终密切相关,成线性关系。
第一计算单元130还配置为获取第一重力距补偿量的拟合计算公式,拟合计算公式表示出植保无人机的实时总质量与第一重力距补偿量的对应关系;将植保无人机的实时总质量输入计算拟合公式进行计算,得到第一重力距补偿量。
拟合计算公式的确定具体为:首先测得植保无人机处于悬停状态时的不同质量情况下的第一重力距补偿量,记录下流量计6-2测得的农药消耗量,将植保无人机的初始质量减去农药消耗量得到植保无人机的实时总质量,进而拟合出第一重力距补偿量与植保无人机的实时总质量的线性方程。
上述拟合计算公式为ΔM1x(M)=KxM+Bx,ΔM1y(M)=KyM+By。其中,ΔM1x(M)为水平方向X轴对应的第一重力矩补偿量,ΔM1y(M)为水平方向Y轴对应的第一重力矩补偿量,M为植保无人机的实时总质量,Kx、Bx均为预设常数,也即为拟合后得到的常数。
控制***还包括姿态信息测量装置140。姿态信息测量装置140配置为测量植保无人机的实时姿态,也即测量植保无人机实时的滚转角和俯仰角。第二计算单元150还配置为获取计算植保无人机在不同飞行姿态下的第二重力距补偿量的计算公式,将滚转角和俯仰角输入计算公式得到第二重力距补偿量。
计算植保无人机在不同飞行姿态下的第二重力距补偿量的计算公式为:ΔM2x=ΔM1xcosΦ,其中,ΔM2x为水平方向X轴对应的第二重力距补偿量,ΔM2y为水平方向Y轴对应的第二重力距补偿量,ΔM1x为水平方向X轴对应的第一重力矩补偿量,ΔM1y为水平方向Y轴对应的第一重力矩补偿量,Φ为滚转角,为俯仰角。
控制单元170包括第三计算单元171和电调4-1。第三计算单元171配置为根据第二重力距补偿量调整植保无人机的控制分配器的输入,以完成控制分配的补偿,并根据控制分配器的输入和控制分配矩阵计算植保无人机的所有电机4-2的转速指令。
控制分配器的输入根据植保无人机的位置控制(包括位置环与速度环)、姿态控制(包括姿态角控制环路与角速度控制环路)、控制分配、电机4-2控制的方法确定,本实施例中的位置控制、姿态控制、控制分配、电机4-2控制采用传统的控制方法,确定控制分配器的输入。
控制分配矩阵根据植保无人机的特定的构型分布确定。根据植保无人机特定的构型分布对应的分配矩阵分解得到每个电机4-2的转速平方指令,进而得到每个电机4-2的转速指令,最后通过电调4-1,也即电机4-2调速器控制电机4-2的转速,实施对植保无人机飞行的控制。
图3是根据本发明一个实施例的基于质量测量的植保无人机控制方法的流程图。如图3所示,基于上述基于质量测量的植保无人机控制***,本实施例还提供了一种基于质量测量的植保无人机控制方法,其目的在于引入植保无人机实时变化的质量解决植保无人机因质量变化而导致的飞行稳定性降低的问题。基于质量测量的植保无人机控制方法包括:
步骤S302,实时测量植保无人机的农药消耗量。
步骤S304,将植保无人机的初始质量减去农药消耗量得到植保无人机的实时总质量。
步骤S306,根据植保无人机的实时总质量计算植保无人机实时的水平姿态的第一重力距补偿量。
步骤S308,根据植保无人机的实时姿态信息和第一重力距补偿量计算植保无人机在不同飞行姿态下的第二重力距补偿量。
步骤S310,根据第二重力距补偿量调整植保无人机的电机4-2的转速。
根据植保无人机的实时总质量计算植保无人机实时的水平姿态的第一重力距补偿量的步骤包括:
获取第一重力距补偿量的拟合计算公式,拟合计算公式表示出植保无人机的实时总质量与第一重力距补偿量的对应关系;
将植保无人机的实时总质量输入计算拟合公式进行计算,得到第一重力距补偿量。
拟合计算公式的确定具体为:首先测得植保无人机处于悬停状态时的不同质量情况下的第一重力距补偿量,记录下流量计6-2测得的农药消耗量,将植保无人机的初始质量减去农药消耗量得到植保无人机的实时总质量,进而拟合出第一重力距补偿量与植保无人机的实时总质量的线性方程。
上述拟合计算公式为ΔM1x(M)=KxM+Bx,ΔM1y(M)=KyM+By。其中,ΔM1x(M)为水平方向X轴对应的第一重力矩补偿量,ΔM1y(M)为水平方向Y轴对应的第一重力矩补偿量,M为植保无人机的实时总质量,Kx、Bx均为预设常数,也即为拟合后得到的系数。
植保无人机的实时姿态信息包括植保无人机的滚转角和俯仰角。根据植保无人机的实时姿态信息和第一重力距补偿量计算植保无人机在不同飞行姿态下的第二重力距补偿量的步骤包括:获取计算植保无人机在不同飞行姿态下的第二重力距补偿量的计算公式,将滚转角和俯仰角输入计算公式得到第二重力距补偿量。计算植保无人机在不同飞行姿态下的第二重力距补偿量的计算公式计算公式为:ΔM2x=ΔM1xcosΦ,其中,ΔM2x为水平方向X轴对应的第二重力距补偿量,ΔM2y为水平方向Y轴对应的第二重力距补偿量,ΔM1x为水平方向X轴对应的第一重力矩补偿量,ΔM1y为水平方向Y轴对应的第一重力矩补偿量,Φ为滚转角,为俯仰角。
根据第二重力距补偿量调整植保无人机的电机4-2的转速的步骤包括:
根据第二重力距补偿量调整植保无人机的控制分配器的输入,以完成控制分配的补偿,并根据控制分配器的输入和控制分配矩阵计算植保无人机的所有电机4-2的转速指令,再根据电机4-2的转速指令控制电机4-2的转速。
图4是植保无人机的经典控制***框图。如图4所示,采用经典的位置环与速度环方法控制无人机的位置速度。具体地,采用经典的位置控制(包括位置环与速度环)、姿态控制(包括姿态角控制环路与角速度控制环路)、控制分配、电机4-2控制的方法。
采用上述经典控制方法得到控制分配器的输入为(τx,τy,τz,fd)。其中(τx,τy,τz)为三轴力矩指令,来自姿态控制器的输出,fd为总拉力指令。
以典型的四旋翼为例,假设采用X型构型,则有如下的分配方程:
上述分配方程中,d为各个电机4-2到几何中心的距离,CT为拉力系数,CM为扭矩系数。分别为1#,2#,3#,4#电机4-2的转速。
如果无人机的重心位于几何中心,悬停且不发生偏航运动时,τx=τy=τz=0,即姿态控制器的输出(τx,τy,τz)都应该为0。但是针对变质量植保无人机***,无人机的重心不再位于几何中心,则姿态控制器会输出一定的值,(τx,τy)不再为全零,此时的(τx,τy)称之为第一重力力矩补偿量(ΔMx,ΔMy),且满足ΔMx=τx,ΔMy=τy。
植保无人机实时飞行中,再根据植保无人机的实时总质量和根据重力距补偿量与植保无人机的实时总质量的线性拟合公式,得到:ΔM1x(M)=KxM+Bx,ΔM1y(M)=KyM+By。其中,ΔM1x(M)为水平方向X轴对应的第一重力矩补偿量,ΔM1y(M)为水平方向Y轴对应的第一重力矩补偿量,M为植保无人机的实时总质量,Kx、Bx均为拟合后得到的系数。
植保无人机实时飞行中,根据飞控***的导航模块得到当前的实时姿态(滚转角Φ,俯仰角),计算出不同姿态情况下的第二重力力矩补偿量。也即为ΔM2x=ΔM1xcosΦ,其中,ΔM2x为水平方向X轴对应的所述第二重力距补偿量,ΔM2y为水平方向Y轴对应的所述第二重力距补偿量,ΔM1x为水平方向X轴对应的所述第一重力矩补偿量,ΔM1y为水平方向Y轴对应的所述第一重力矩补偿量,Φ为所述滚转角,为所述俯仰角。
然后再根据计算出的不同姿态情况下的第二重力力矩补偿量改变控制分配方程的输入。不进行重力力矩补偿的情况下,控制分配的输入是(τx,τy,τz,fd),改变控制分配后的输入是
改变控制分配的输入后,经过控制分配矩阵得到每个电机4-2的转速指令。即:
每个电调4-1根据上述每个电机4-2的转速指令控制电机4-2的转速,实施对植保无人机飞行的控制。
本实施例的基于质量测量的植保无人机控制方法,利用额定的初始质量减去实时测量的农药消耗量得到植保无人机的实时总质量,利用植保无人机的实时总质量得到第一重力距补偿量,并根据第一重力距补偿量和植保无人机的飞行姿态得到不同飞行姿态下的第二重力距补偿量,再根据第二重力距补偿量调整植保无人机的电机4-2的转速,从而解决了变质量的植保无人机的平稳飞行控制问题,提升了植保无人机在农药喷洒作用过程中的飞行的平稳性和安全性。
进一步地,本实施例的基于质量测量的植保无人机控制方法中,根据植保无人机的实时总质量的变化对植保无人机的飞行进行控制,可明显改善植保无人机起飞或降落过程的平稳性,增加飞行安全性;并可减小飞行过程中刹车期间的振荡摆幅,减少能源消耗,增加飞行时间以及提高植保无人机的抗风能力。
至此,本领域技术人员应认识到,虽然本文已详尽示出和描述了本发明的多个示例性实施例,但是,在不脱离本发明精神和范围的情况下,仍可根据本发明公开的内容直接确定或推导出符合本发明原理的许多其他变型或修改。因此,本发明的范围应被理解和认定为覆盖了所有这些其他变型或修改。
Claims (10)
1.一种基于质量测量的植保无人机控制方法,用于对正在进行农药喷洒作用的植保无人机的飞行进行控制,包括:
实时测量所述植保无人机的农药消耗量;
将所述植保无人机的初始质量减去所述农药消耗量得到所述植保无人机的实时总质量;
根据所述植保无人机的实时总质量计算所述植保无人机实时的水平姿态的第一重力距补偿量;
根据所述植保无人机的实时姿态信息和所述第一重力距补偿量计算所述植保无人机在不同飞行姿态下的第二重力距补偿量;
根据所述第二重力距补偿量调整所述植保无人机的电机的转速。
2.根据权利要求1所述的控制方法,其中,根据所述植保无人机的实时总质量计算所述植保无人机实时的水平姿态的第一重力距补偿量的步骤包括:
获取所述第一重力距补偿量的拟合计算公式,所述拟合计算公式表示出所述植保无人机的实时总质量与所述第一重力距补偿量的对应关系;
将所述植保无人机的实时总质量输入所述计算拟合公式进行计算,得到所述第一重力距补偿量。
3.根据权利要求2所述的控制方法,其中
所述拟合计算公式为:
ΔM1x(M)=KxM+Bx;
ΔM1y(M)=KyM+By;
其中,ΔM1x(M)为水平方向X轴对应的所述第一重力矩补偿量,ΔM1y(M)为水平方向Y轴对应的所述第一重力矩补偿量,M为所述植保无人机的实时总质量,Kx、Bx均为预设常数。
4.根据权利要求3所述的控制方法,其中,
所述植保无人机的实时姿态信息包括所述植保无人机的滚转角和俯仰角;
根据所述植保无人机的实时姿态信息和所述第一重力距补偿量计算所述植保无人机在不同飞行姿态下的第二重力距补偿量的步骤包括:
获取计算所述植保无人机在不同飞行姿态下的第二重力距补偿量的计算公式;
将所述滚转角和俯仰角输入所述计算公式得到所述第二重力距补偿量;
所述计算公式为:ΔM2x=ΔM1xcosΦ,
其中,ΔM2x为水平方向X轴对应的所述第二重力距补偿量,ΔM2y为水平方向Y轴对应的所述第二重力距补偿量,ΔM1x为水平方向X轴对应的所述第一重力矩补偿量,ΔM1y为水平方向Y轴对应的所述第一重力矩补偿量,Φ为所述滚转角,为所述俯仰角。
5.根据权利要求1所述的控制方法,其中,根据所述第二重力距补偿量调整所述植保无人机的电机的转速的步骤包括:
根据所述第二重力距补偿量调整所述植保无人机的控制分配器的输入,以完成控制分配的补偿;
根据所述控制分配器的输入和控制分配矩阵计算所述植保无人机的所有电机的转速指令;
根据所述电机的转速指令控制所述电机的转速。
6.一种基于质量测量的植保无人机控制***,包括:
流量计,配置为实时测量植保无人机的农药消耗量;
质量计算单元,配置为将所述植保无人机的初始质量减去所述农药消耗量得到所述植保无人机的实时总质量;
第一计算单元,配置为根据所述植保无人机的实时总质量计算所述植保无人机实时的水平姿态的第一重力距补偿量;
第二计算单元,配置为根据所述植保无人机的实时姿态信息和所述第一重力距补偿量计算所述植保无人机在不同飞行姿态下的第二重力距补偿量;
控制单元,配置为根据所述第二重力距补偿量调整所述植保无人机的电机的转速。
7.根据权利要求6所述的控制***,其中
所述第一计算单元还配置为:
获取所述第一重力距补偿量的拟合计算公式,所述拟合计算公式表示出所述植保无人机的实时总质量与所述第一重力距补偿量的对应关系;
将所述植保无人机的实时总质量输入所述计算拟合公式进行计算,得到所述第一重力距补偿量。
8.根据权利要求7所述的控制***,其中
所述拟合计算公式为:
ΔM1x(M)=KxM+Bx;
ΔM1y(M)=KyM+By;
其中,ΔM1x(M)为水平方向X轴对应的所述第一重力矩补偿量,ΔM1y(M)为水平方向Y轴对应的所述第一重力矩补偿量,M为所述植保无人机的实时总质量,Kx、Bx均为预设常数。
9.根据权利要求8所述的控制***,还包括:
陀螺仪,配置为测量所述植保无人机的滚转角和俯仰角;
所述第二计算单元还配置为:
获取计算所述植保无人机在不同飞行姿态下的第二重力距补偿量的计算公式,将所述滚转角和俯仰角输入所述计算公式得到所述第二重力距补偿量;
所述计算公式为:ΔM2x=ΔM1xcosΦ,
其中,ΔM2x为水平方向X轴对应的所述第二重力距补偿量,ΔM2y为水平方向Y轴对应的所述第二重力距补偿量,ΔM1x为水平方向X轴对应的所述第一重力矩补偿量,ΔM1y为水平方向Y轴对应的所述第一重力矩补偿量,Φ为所述滚转角,为所述俯仰角。
10.根据权利要求6所述的控制***,其中,所述控制单元包括:
第三计算单元,配置为根据所述第二重力距补偿量调整所述植保无人机的控制分配器的输入,以完成控制分配的补偿;根据所述控制分配器的输入和控制分配矩阵计算所述植保无人机的所有电机的转速指令;
电调,配置为根据所述电机的转速指令控制所述电机的转速。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710872384.XA CN107728631B (zh) | 2017-09-25 | 2017-09-25 | 基于质量测量的植保无人机控制***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710872384.XA CN107728631B (zh) | 2017-09-25 | 2017-09-25 | 基于质量测量的植保无人机控制***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107728631A true CN107728631A (zh) | 2018-02-23 |
CN107728631B CN107728631B (zh) | 2021-06-18 |
Family
ID=61207881
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710872384.XA Active CN107728631B (zh) | 2017-09-25 | 2017-09-25 | 基于质量测量的植保无人机控制***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107728631B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108829129A (zh) * | 2018-06-04 | 2018-11-16 | 成都天麒科技有限公司 | 一种四旋翼植保无人机飞行平衡调节方法 |
CN113361820A (zh) * | 2021-07-12 | 2021-09-07 | 于伟龙 | 应用于农业喷药的多无人机协同调度方法、控制器及介质 |
CN114326767A (zh) * | 2021-12-14 | 2022-04-12 | 宁波天擎航天科技有限公司 | 飞行器姿态控制方法、飞行器姿态控制***以及飞行器 |
IT202100024602A1 (it) | 2021-09-27 | 2023-03-27 | Securesi Srl | Sistema di spruzzo orizzontale di prodotti liquidi con drone |
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110084162A1 (en) * | 2009-10-09 | 2011-04-14 | Honeywell International Inc. | Autonomous Payload Parsing Management System and Structure for an Unmanned Aerial Vehicle |
CN102591302A (zh) * | 2012-03-05 | 2012-07-18 | 无锡汉和航空技术有限公司 | 一种无人机喷洒农药的作业方法 |
CN103235598A (zh) * | 2013-05-14 | 2013-08-07 | 北京理工大学 | 一种调整推力器方向指向组合体航天器质心的方法 |
WO2014064431A2 (en) * | 2012-10-22 | 2014-05-01 | Bcb International Ltd. | Micro unmanned aerial vehicle and method of control therefor |
CN103984352A (zh) * | 2014-04-27 | 2014-08-13 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种基于运动平台的纵向跑道运动预估及补偿方法 |
CN104875877A (zh) * | 2015-06-11 | 2015-09-02 | 上海优伟斯智能***有限公司 | 一种无人机自动配平*** |
CN105138003A (zh) * | 2015-09-18 | 2015-12-09 | 山东科技大学 | 多操纵面无人机直接升力控制方法 |
CN105259866A (zh) * | 2015-10-10 | 2016-01-20 | 北京精密机电控制设备研究所 | 一种气浮运动模拟器质心调节*** |
CN105353761A (zh) * | 2015-12-02 | 2016-02-24 | 中国商用飞机有限责任公司北京民用飞机技术研究中心 | 一种飞机的速度控制方法及装置 |
CN205168909U (zh) * | 2014-12-03 | 2016-04-20 | 珠海银通农业科技有限公司 | 具有自适应感度的多轴植保飞机 |
CN105843236A (zh) * | 2016-03-17 | 2016-08-10 | 中山飞旋天行航空科技有限公司 | 一种植保无人机喷洒控制***及其喷洒控制方法 |
WO2016164280A1 (en) * | 2015-04-04 | 2016-10-13 | Skylift Global | Multi-rotor vehicle with yaw control and autorotation |
US20160304199A1 (en) * | 2014-12-04 | 2016-10-20 | Elwha Llc | System and method for operation and management of reconfigurable unmanned aircraft |
CN106114822A (zh) * | 2016-08-03 | 2016-11-16 | 安阳全丰航空植保科技股份有限公司 | 油动多旋翼农用植保直升机飞行姿态调控*** |
CN106155088A (zh) * | 2016-08-17 | 2016-11-23 | 浙江经济职业技术学院 | 主副药箱相结合的稳定重心装置和方法、以及无人机 |
CN106462167A (zh) * | 2014-05-30 | 2017-02-22 | 深圳市大疆创新科技有限公司 | 飞行器姿态控制方法 |
CN106647780A (zh) * | 2016-10-19 | 2017-05-10 | 北京京东尚科信息技术有限公司 | 无人机飞行控制方法、装置及无人机 |
US20170267378A1 (en) * | 2016-03-18 | 2017-09-21 | The Boeing Company | Satellite control system using electrically controllable variable reflection glass panels |
-
2017
- 2017-09-25 CN CN201710872384.XA patent/CN107728631B/zh active Active
Patent Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110084162A1 (en) * | 2009-10-09 | 2011-04-14 | Honeywell International Inc. | Autonomous Payload Parsing Management System and Structure for an Unmanned Aerial Vehicle |
CN102591302A (zh) * | 2012-03-05 | 2012-07-18 | 无锡汉和航空技术有限公司 | 一种无人机喷洒农药的作业方法 |
WO2014064431A2 (en) * | 2012-10-22 | 2014-05-01 | Bcb International Ltd. | Micro unmanned aerial vehicle and method of control therefor |
CN103235598A (zh) * | 2013-05-14 | 2013-08-07 | 北京理工大学 | 一种调整推力器方向指向组合体航天器质心的方法 |
CN103984352A (zh) * | 2014-04-27 | 2014-08-13 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种基于运动平台的纵向跑道运动预估及补偿方法 |
CN106462167A (zh) * | 2014-05-30 | 2017-02-22 | 深圳市大疆创新科技有限公司 | 飞行器姿态控制方法 |
CN205168909U (zh) * | 2014-12-03 | 2016-04-20 | 珠海银通农业科技有限公司 | 具有自适应感度的多轴植保飞机 |
US20160304199A1 (en) * | 2014-12-04 | 2016-10-20 | Elwha Llc | System and method for operation and management of reconfigurable unmanned aircraft |
WO2016164280A1 (en) * | 2015-04-04 | 2016-10-13 | Skylift Global | Multi-rotor vehicle with yaw control and autorotation |
CN104875877A (zh) * | 2015-06-11 | 2015-09-02 | 上海优伟斯智能***有限公司 | 一种无人机自动配平*** |
CN105138003A (zh) * | 2015-09-18 | 2015-12-09 | 山东科技大学 | 多操纵面无人机直接升力控制方法 |
CN105259866A (zh) * | 2015-10-10 | 2016-01-20 | 北京精密机电控制设备研究所 | 一种气浮运动模拟器质心调节*** |
CN105353761A (zh) * | 2015-12-02 | 2016-02-24 | 中国商用飞机有限责任公司北京民用飞机技术研究中心 | 一种飞机的速度控制方法及装置 |
CN105843236A (zh) * | 2016-03-17 | 2016-08-10 | 中山飞旋天行航空科技有限公司 | 一种植保无人机喷洒控制***及其喷洒控制方法 |
US20170267378A1 (en) * | 2016-03-18 | 2017-09-21 | The Boeing Company | Satellite control system using electrically controllable variable reflection glass panels |
CN106114822A (zh) * | 2016-08-03 | 2016-11-16 | 安阳全丰航空植保科技股份有限公司 | 油动多旋翼农用植保直升机飞行姿态调控*** |
CN106155088A (zh) * | 2016-08-17 | 2016-11-23 | 浙江经济职业技术学院 | 主副药箱相结合的稳定重心装置和方法、以及无人机 |
CN106647780A (zh) * | 2016-10-19 | 2017-05-10 | 北京京东尚科信息技术有限公司 | 无人机飞行控制方法、装置及无人机 |
Non-Patent Citations (2)
Title |
---|
JANG, JT等: "Computed Torque Control of an Aerospace Craft Using Nonlinear Inverse Model and Rotation Matrix", 《15TH INTERNATIONAL CONFERENCE ON CONTROL, AUTOMATION AND SYSTEMS》 * |
杨晓科: "变重量/重心飞机建模以及姿态控制律设计", 《北京航空航天大学学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108829129A (zh) * | 2018-06-04 | 2018-11-16 | 成都天麒科技有限公司 | 一种四旋翼植保无人机飞行平衡调节方法 |
CN113361820A (zh) * | 2021-07-12 | 2021-09-07 | 于伟龙 | 应用于农业喷药的多无人机协同调度方法、控制器及介质 |
CN113361820B (zh) * | 2021-07-12 | 2022-11-18 | 海南海柠科技有限公司 | 应用于农业喷药的多无人机协同调度方法、控制器及介质 |
IT202100024602A1 (it) | 2021-09-27 | 2023-03-27 | Securesi Srl | Sistema di spruzzo orizzontale di prodotti liquidi con drone |
CN114326767A (zh) * | 2021-12-14 | 2022-04-12 | 宁波天擎航天科技有限公司 | 飞行器姿态控制方法、飞行器姿态控制***以及飞行器 |
Also Published As
Publication number | Publication date |
---|---|
CN107728631B (zh) | 2021-06-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107728631A (zh) | 基于质量测量的植保无人机控制***及方法 | |
KR102297055B1 (ko) | 무인 비행체를 위한 분사 시스템 | |
CN106094860B (zh) | 四旋翼飞行器及其控制方法 | |
Islam et al. | Robust control of four-rotor unmanned aerial vehicle with disturbance uncertainty | |
Choi et al. | Nonlinear control of quadrotor for point tracking: Actual implementation and experimental tests | |
CN102955477B (zh) | 一种四旋翼飞行器姿态控制***及控制方法 | |
Lee et al. | Autonomous swing-angle estimation for stable slung-load flight of multi-rotor UAVs | |
CN109032156B (zh) | 一种基于状态观测的吊挂载荷四旋翼无人机悬停控制方法 | |
CN103885450A (zh) | 无人直升机姿态非线性控制方法及验证平台 | |
CN108132604A (zh) | 基于四元数的四旋翼飞行器鲁棒姿态控制方法、装置及*** | |
Sandino et al. | On the use of tethered configurations for augmenting hovering stability in small-size autonomous helicopters | |
Sandino et al. | Advances in modeling and control of tethered unmanned helicopters to enhance hovering performance | |
Salazar-Cruz et al. | Stabilization and nonlinear control for a novel trirotor mini-aircraft | |
Guenard et al. | Control laws for the tele operation of an unmanned aerial vehicle known as an x4-flyer | |
Meng et al. | Disturbance observer-based output feedback control for uncertain QUAVs with input saturation | |
CN112015192A (zh) | 一种自愈四旋翼无人机抗干扰控制方法与*** | |
CN112541225A (zh) | 一种面向火箭回收大姿态翻转的虚实结合仿真模拟方法 | |
CN109308074A (zh) | 一种无人机重心偏移的补偿方法及*** | |
Gonzalez et al. | Real-time altitude robust controller for a quad-rotor aircraft using sliding-mode control technique | |
Bogdanov et al. | SDRE control with nonlinear feedforward compensation for a small unmanned helicopter | |
Bingbing et al. | A new modeling scheme for powered parafoil unmanned aerial vehicle platforms: Theory and experiments | |
Wang et al. | The attitude control of transmission line fault inspection UAV based on ADRC | |
Huang et al. | Output feedback control of Lorentz-augmented spacecraft rendezvous | |
Qi et al. | Trajectory tracking strategy of quadrotor with output delay | |
Gros et al. | In-flight estimation of the aerodynamic roll damping and trim angle for a tethered aircraft based on multiple-shooting |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |