CN112379685B - 一种基于风速风向传感器的旋翼无人机控制系统及方法 - Google Patents
一种基于风速风向传感器的旋翼无人机控制系统及方法 Download PDFInfo
- Publication number
- CN112379685B CN112379685B CN202011377761.0A CN202011377761A CN112379685B CN 112379685 B CN112379685 B CN 112379685B CN 202011377761 A CN202011377761 A CN 202011377761A CN 112379685 B CN112379685 B CN 112379685B
- Authority
- CN
- China
- Prior art keywords
- wind
- speed
- attitude
- information
- expectation
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 230000001133 acceleration Effects 0.000 claims abstract description 147
- 238000004891 communication Methods 0.000 claims abstract description 47
- 238000012360 testing method Methods 0.000 claims description 10
- 238000012545 processing Methods 0.000 claims description 4
- 238000005259 measurement Methods 0.000 abstract description 3
- 230000002708 enhancing effect Effects 0.000 abstract 1
- 230000007613 environmental effect Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 4
- 238000007664 blowing Methods 0.000 description 2
- 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 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 239000000725 suspension Substances 0.000 description 1
Images
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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及旋翼无人机控制领域,具体地说是一种基于风速风向传感器的旋翼无人机控制系统及方法,包括:设置在旋翼无人机上的风扰加速度传感系统和加速度反馈控制系统;其中,风扰加速度传感系统包括:风速风向传感器、滤波器、风扰加速度计算模块、通信模块A;风速风向传感器经滤波器与风扰加速度计算模块连接,风扰加速度计算模块与通信模块A连接,并与加速度反馈控制系统无线通信,风扰加速度计算模块接受加速度反馈控制系统检测的旋翼无人机姿态信息,并得到风扰加速度,并将其经通信模块A发送至加速度反馈控制系统。本发明可实现环境风矢量的测量、风扰加速度解算与反馈,并结合风扰信息进行反馈补偿控制,增强系统的稳定性。
Description
技术领域
本发明涉及旋翼无人机控制领域,具体地说是一种基于风速风向传感器的旋翼无人机控制系统及方法。
背景技术
旋翼无人机能够垂直起降、机动灵活,使用范围不断扩大,除商业消费外,工业环境应用也逐渐增加,因而对其稳定性有着更进一步的要求。但是常规串级控制量由位置环逐层计算并执行,这带来了滞后与不确定性。当外界存在较大风扰动时,这种滞后特性将被串级控制中的积分项进一步放大,需要通过增加抗风扰功能提升其稳定性。
发明内容
针对现有技术的不足,本发明目的是提供一种基于风速风向传感器的旋翼无人机控制系统,可实现环境风矢量的测量、风扰加速度解算与反馈,并结合风扰信息进行反馈补偿控制,增强系统的稳定性。
本发明为实现上述目的所采用的技术方案是:一种基于风速风向传感器的旋翼无人机控制系统,包括:设置在旋翼无人机上的风扰加速度传感系统和加速度反馈控制系统;
其中,所述风扰加速度传感系统包括:风速风向传感器、滤波器、风扰加速度计算模块、通信模块A;
所述风速风向传感器经滤波器与风扰加速度计算模块连接,将检测的风矢量数据经滤波器滤波后发送至风扰加速度计算模块等待处理;
所述风扰加速度计算模块与通信模块A连接,并与加速度反馈控制系统无线通信,所述风扰加速度计算模块接受加速度反馈控制系统检测的旋翼无人机姿态信息,并根据风矢量数据、旋翼无人机姿态信息以及旋翼无人机自身参数,得到风扰加速度,并将得到的风扰加速度经通信模块A发送至加速度反馈控制系统。
所述风速风向传感器为三轴风速计。
所述滤波器为多频滤波器。
所述加速度反馈控制系统,包括:组合导航、PID控制器、动力执行器、补偿控制器以及通信模块B;
所述组合导航,分别与通信模块B和PID控制器连接,用于将姿态信息发送给通信模块B,将获取旋翼无人机当前的位置信息、速度信息、姿态信息与角速度信息发送给PID控制器;
通信模块B与补偿控制器相连,用于将接收到组合导航获取的姿态信息发送通信模块A,并将风扰加速度计算模块解算的风扰加速度信息发送给补偿控制器;
所述补偿控制器,其输入端与通信模块B连接,输出端分别与PID控制器及动力执行器连接,用于接收通信模块B发送的风扰加速度信息,获取当前风扰加速度下的稳态平衡姿态,将此稳态平衡姿态作为补偿控制量发送给PID控制器作为姿态控制前馈;并根据垂直方向风扰加速度计算风扰下的垂向附加受力,得到升力补偿量发送给PID控制器;
PID控制器,与组合导航系统、补偿控制器及动力执行器相连,用于接收组合导航发出的位置信息、速度信息、姿态信息与角速度信息,接收补偿控制器发出的补偿控制量和升力补偿量,发送计算的控制律至动力执行器,实现对旋翼无人机的控制。
所述PID控制器包括位置PID控制器、速度PID控制器、姿态PID控制器以及角速度PID控制器,均与组合导航连接并分别接收位置信息、速度信息、姿态信息与角速度信息;
所述位置PID控制器与速度PID控制器连接,用于生成速度期望发送至速度PID控制器;
所述速度PID控制器与补偿控制器以及动力执行器连接,用于生成原生姿态期望发送至姿态PID控制器,生成原生升力期望发送至动力执行器
所述姿态PID控制器分别与补偿控制器和角速度PID控制器连接,用于接收补偿控制器发送的补偿控制量作为前馈输入,生成角速度期望发送至角速度PID控制器;
所述角速度PID控制器与动力执行器连接,用于生成角加速度期望并发送至动力执行器
一种基于风速风向传感器的旋翼无人机控制方法,包括以下步骤:
1)获取旋翼无人机本体参数,根据组合导航获取的旋翼无人机姿态信息,通过风动试验进行拟合获取测量风速风向与风扰加速度的拟合关系函数,即气动模型;将气动模型储存至风扰加速度计算模块,等待调用;
2)风速风向传感器采集旋翼无人机的风矢量信息,并发送至多频滤波器;
3)多频滤波器接收到风速风向传感器的风矢量信息,对风矢量信息中数据进行滤波,并将滤波后的风矢量信息发送至风扰加速度计算模块;
4)风扰加速度计算模块根据接收到旋翼无人机姿态信息、旋翼无人机参数以及风速风向传感器测得的风矢量信息,通过储存在风扰加速度计算模块的气动模型,获取的风扰加速度信息,并发送至通信模块B,通过通信模块B将风扰加速度信息发送至补偿控制器;
5)补偿控制器接收到风扰加速度信息后进行处理,得到补偿控制量以及升力补偿量,分别发送给姿态PID控制器和动力执行器;
6)旋翼无人机的组合导航将位置信息、速度信息、姿态信息以及角速度信息分别发送至位置PID控制器、速度PID控制器、姿态PID信息以及角速度PID控制器进行处理,得到升力期望和角加速度期望;并发送至动力执行器,
7)动力执行器根据角加速度期望和升力期望,实现对在旋翼无人机受到风扰环境下的控制。
所述步骤5),具体为:
恒定风速风向下使无人机处于稳定状态,根据水平方向上的风扰加速度与姿态的拟合关系得出当前风扰加速度下的旋翼无人机姿态,即稳态平衡姿态,将此稳态平衡姿态作为补偿控制量发送给姿态PID控制器作为姿态控制前馈;
根据垂直方向上风扰加速度,得到风扰下的垂向附加受力大小作为升力补偿量发送给升力PID控制器。
所述步骤6),具体为:
PID控制器采用串级PID形式,位置控制器通过位置期望与当前位置做差获得三维位置偏差矢量,通过位置PID控制器生成速度期望;
速度控制器通过速度期望与当前速度做差获得三维速度偏差矢量,通过速度PID控制器生成原生姿态期望与原生升力期望;其中原生姿态期望通过水平方向速度偏差进行PID控制律运算生成,原生升力期望通过垂直方向速度偏差进行PID控制律运算生成;
将原生升力期望叠加补偿控制器的升力补偿量得到升力期望发送至动力执行器;
将稳态平衡姿态补偿控制量做为前馈输入与原生姿态期望叠加,获得姿态角期望,通过姿态期望与当前姿态进行PID控制律运算生成角速度期望,通过角速度期望与当前角速度进行PID控制律运算生成角加速度期望,并将角加速度期望发送给动力执行器。
所述步骤7),具体为:
通过旋翼无人机转动惯量J与角加速度期望计算旋翼之间的期望拉力差,通过期望升力计算总拉力,得到各旋翼拉力后通过电机、旋翼气动力特性曲线获得转速期望,由转速控制器通过脉宽调制波对旋翼转速进行控制。
本发明具有以下有益效果及优点:
1、本发明能够提升旋翼无人机的抗风能力,通过姿态前馈,能够使无人机快速达到稳定状态,提升飞行稳定性。
2、本发明在动力分配上采用直接补偿的方式,执行速度更快,动力分配更加优化。
附图说明
图1为本发明系统示意图
图2为本发明系统组成结构示意图。
图3为本发明中加速度反馈控制系统控制流程框图。
图4为本发明中风洞测试过程中无人机平台受力特性分析图。
图5为本发明中无人机平台抗风悬停时的受力特性分析图。
其中,1为风扰加速度传感系统,2为无人机平台,3为动力执行系统,4为悬吊固定绳索。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
如图1所示,一种基于风速风向传感器的旋翼无人机控制系统,无人机基础系统平台为工字型四旋翼无人机。
其中,风扰加速度传感系统,测量风矢量信息并转化为风扰加速度信息,发送给加速度反馈控制系统;
加速度反馈控制系统,接收风扰加速度信息进行加速度反馈控制,提升无人机抗风扰能力。
风扰加速度传感系统通过风速风向传感器测量风矢量,将风速大小与风向角度通过多频段组合滤波器后,结合所辨识拟合的气动模型求出无人机所受风扰动大小与风扰加速度信息。
多频段组合滤波器的高频截止频率为无人机旋翼动力振动频率、无人机机体共振频率与无人机动态响应频率三者中的的最小值,低频截止频率为自然风平均频率的0.8倍。
气动模型通过风洞试验拟合获取,将无人机平行于动力平面水平悬挂,进行不同大小与方向的吹风测试,获取姿态信息并进行三轴投影确定无人机姿态与相对风向,将风速、风向与稳态姿态角拟合,结合无人机质量、稳态风矢量与姿态角获取无人机的气动特性。
所述加速度反馈控制系统采用基于加速度反馈的扰动补偿控制器。
所述基于加速度反馈的扰动补偿控制器对原生PID控制器进行期望补偿与执行器补偿。
期望补偿为前馈形式,通过气动辨识参数过程获取风矢量与稳态姿态关系,确定期望姿态,作为姿态控制期望输入给无人机姿态环。
执行器补偿为旋翼动力补偿形式,通过风扰加速度信息,计算风扰力,结合电机与旋翼的气动力特性,调节电机转速,进行动力补偿,抵消风扰。
如图2所示,旋翼无人机抗风扰系统包括风扰加速度传感系统与加速度反馈控制系统,风扰加速度传感系统由风速风向传感器、多频滤波器、气动计算模型、风扰加速度计算单元与IO通信模块1构成;加速度反馈控制系统由通信模块B、组合导航系统、PID控制器、补偿控制器与动力执行器构成。系统中,除加速度反馈控制系统输出PWM控制信号为模拟信号传输外,其他数据通讯均采用UART有线传输。
风扰加速度传感系统构成与执行流程如下:
风速风向传感器为WindMaster三轴风速计,通过超声波测速原理测量传感器三轴X轴,Y轴,Z轴的风速分别Wx,Wy,Wz,进行矢量叠加,则传感器测得的风速值为:
传感器坐标系下的水平风向夹角为:
传感器坐标系下的航向风向夹角为:
则输出风矢量信息为:
Wind=[Wx,Wy,Wz,WindangHsensor,Windangyawsensor]
即风速与风向信息,至多频滤波器,输出频率为20Hz。
多频滤波器接收风速风向传感器信息,并对数据进行滤波,风速信息高频截止频段为5Hz,低频截止频段为0.1Hz;风向信息高频截止频率为1Hz。多频滤波器处理过的数据发送至风扰加速度计算模块。
如图4所示,气动模型通过风洞试验拟合获取,首先将无人机固连悬挂使动力平面水平,进行不同大小与方向的吹风测试,在恒定风速风向下使无人机处于稳定状态,在此,以风向平行于无人机X轴进行风洞测试为例。读取稳态无人机横滚、俯仰、航向姿态信息attUAV=[roll,pitch,yaw]进行风扰加速度计算,该数据可通过组合离线读取导航模块数据获得。通过质量秤对无人机的质量M进行测量,通过力传感器获取悬吊在固定绳索上的无人机向上的拉力FS;
无人机水平受力如下:
以风向平行于无人机X轴进行风洞测试,通过组合导航获取稳态无人机姿态信息attUAV=[roll,pitch,yaw]进行风扰加速度计算;
水平受力如下式:
FwindH=Fssin(pitch),
垂向受力如下式:
FwindV=Fscos(pitch)-G
其中,G=mg为旋翼无人机的重力,FS为无人机向上的拉力;
平行于Y轴时,计算的姿态角为roll,可得:
可获得测量风速风向与风扰加速度的拟合关系函数:
awind=[awindx,awindy,awindz]
其中,awindx,awindy为水平方向的风扰加速度,awindz为垂直方向的风扰加速度;
即气动模型为:
awind=F(Wind,attUAV,M)
该拟合关系函数即为气动模型。该气动模型存储于风扰加速度计算模块中,通过计算拟合函数的方法根据风矢量信息确定风扰加速度。
通信模块A连接通信模块B与风扰加速度计算模块,从通信模块B接收加速度反馈控制系统发出的无人机姿态信息attUAV,发送至风扰加速度计算模块;接收风扰加速度计算模块计算的风扰加速度信息,发送至通信模块B。
风扰加速度计算模块连接多频滤波器与通信模块A,接收多频滤波器发送的滤波后的风速风向信息、通信模块A发送的无人机姿态信息,通过气动模型计算风扰加速度信息并发送至通信模块A。
如图3所示,加速度反馈控制系统构成与执行流程如下:
加速度反馈控制系统的实现平台为一个Pixhawk开源飞行控制模块,集成组合导航系统、通信模块B、PID控制器、补偿控制器与动力执行器。
组合导航系统包括惯性导航系统、定位系统与磁力计,能够解算无人机当前姿态,与通信模块B相连及PID控制器相连,将姿态信息发送给通信模块B,将位置信息、速度信息、姿态信息与角速度信息发送给PID控制器。
通信模块B与组合导航系统及补偿控制器相连,将姿态信息发送给风扰加速度传感系统中的通信模块A,将风扰加速度信息发送给补偿控制器。
补偿控制器与通信模块B、PID控制器及动力执行器相连,接收通信模块B发送的风扰加速度信息,根据水平方向风扰加速度与稳态姿态的拟合关系计算出当前风扰加速度下的稳态平衡姿态,即:
awind=F(Wind,attUAV,M)
将此稳态平衡姿态作为补偿控制量发送给PID控制器作为姿态控制前馈;
根据垂直方向风扰加速度,得到风扰下的垂向附加受力大小为:
FwindV=M*awindz
将升力补偿量FR=-FwindV发送给PID控制器。
PID控制器与组合导航系统、补偿控制器及动力执行器相连,接收组合导航发出的位置信息、速度信息、姿态信息与角速度信息,接收补偿控制器发出的补偿控制量和升力补偿量,发送计算的控制律至动力执行器,实现对旋翼无人机的控制。PID控制器采用串级PID形式,位置控制器通过位置期望与当前位置做差获得三维位置偏差矢量,进行PID控制律运算生成速度期望;速度控制器通过速度期望与当前速度做差获得三维速度偏差矢量进行PID控制律运算生成原生姿态期望与原生升力期望,其中原生姿态期望通过水平方向速度偏差进行PID控制律运算生成,原生升力期望通过垂直方向速度偏差进行PID控制律运算生成。将原生升力期望叠加补偿控制器的升力补偿量得到升力期望发送至动力执行器;将稳态平衡姿态补偿控制量做为前馈输入与原生姿态期望叠加,获得姿态角期望,通过姿态期望与当前姿态进行PID控制律运算生成角速度期望,通过角速度期望与当前角速度进行PID控制律运算生成角加速度期望,并将角加速度期望发送给动力执行器。
原生即PID控制器计算的,PID中包含积分项,当输出量不足的时候回逐渐增加输出,直至稳定,通过补偿的方式可以加快速度,避免积分过程;
旋翼机的姿态和水平加速度挂钩,升力和垂向加速度挂钩。
旋翼机俯仰状态,旋翼的风向斜后侧吹,分解为升力和水平推力,产生加速度。
动力执行器包括转速控制器、电子调速器、电机与旋翼,转速控制器计算并发出脉宽调制波至电子调速器,控制电机、旋翼转速调整拉力大小。
动力执行器与PID控制器连接,接收角加速度期望与升力期望,通过无人机转动惯量J与角加速度期望计算旋翼之间的期望拉力差,通过期望升力计算总拉力,计算各旋翼拉力后通过电机、旋翼气动力特性曲线获得转速期望,由转速控制器通过脉宽调制波对旋翼转速进行控制。
无人机转动惯量J通过摆锤法测量,电机、旋翼气动力特性曲线通过旋翼测试台测试或查表获得,将控制脉宽调制波与旋翼拉力拟合获得关系曲线。
如图5所示,旋翼无人机在外界有风扰的情况下,通过调节自身姿态并进行升力补偿,于水平方向与垂直方向能够实现受力平衡,抵消风扰影响;在加速度反馈控制系统的作用下,结合风扰加速度反馈获取姿态与升力的稳态前馈,能够加快稳态收敛,减少积分项超调,降低风扰对旋翼无人机系统的影响。
Claims (7)
1.一种基于风速风向传感器的旋翼无人机控制系统,其特征在于,包括:设置在旋翼无人机上的风扰加速度传感系统和加速度反馈控制系统;
其中,所述风扰加速度传感系统包括:风速风向传感器、滤波器、风扰加速度计算模块、通信模块A;
所述风速风向传感器经滤波器与风扰加速度计算模块连接,将检测的风矢量数据经滤波器滤波后发送至风扰加速度计算模块等待处理;
所述风扰加速度计算模块与通信模块A连接,并与加速度反馈控制系统无线通信,所述风扰加速度计算模块接受加速度反馈控制系统检测的旋翼无人机姿态信息,并根据风矢量数据、旋翼无人机姿态信息以及旋翼无人机自身参数,得到风扰加速度,并将得到的风扰加速度经通信模块A发送至加速度反馈控制系统;
所述加速度反馈控制系统,包括:组合导航、PID控制器、动力执行器、补偿控制器以及通信模块B;
所述组合导航,分别与通信模块B和PID控制器连接,用于将姿态信息发送给通信模块B,将获取旋翼无人机当前的位置信息、速度信息、姿态信息与角速度信息发送给PID控制器;
通信模块B与补偿控制器相连,用于将接收到组合导航获取的姿态信息发送通信模块A,并将风扰加速度计算模块解算的风扰加速度信息发送给补偿控制器;
所述补偿控制器,其输入端与通信模块B连接,输出端分别与PID控制器及动力执行器连接,用于接收通信模块B发送的风扰加速度信息,获取当前风扰加速度下的稳态平衡姿态,将此稳态平衡姿态作为补偿控制量发送给PID控制器作为姿态控制前馈;并根据垂直方向风扰加速度计算风扰下的垂向附加受力,得到升力补偿量发送给PID控制器;
PID控制器,与组合导航系统、补偿控制器及动力执行器相连,用于接收组合导航发出的位置信息、速度信息、姿态信息与角速度信息,接收补偿控制器发出的补偿控制量和升力补偿量,发送计算的控制律至动力执行器,实现对旋翼无人机的控制;
所述PID控制器包括位置PID控制器、速度PID控制器、姿态PID控制器以及角速度PID控制器,均与组合导航连接并分别接收位置信息、速度信息、姿态信息与角速度信息;
所述位置PID控制器与速度PID控制器连接,用于生成速度期望发送至速度PID控制器;
所述速度PID控制器与补偿控制器以及动力执行器连接,用于生成原生姿态期望发送至姿态PID控制器,生成原生升力期望发送至动力执行器
所述姿态PID控制器分别与补偿控制器和角速度PID控制器连接,用于接收补偿控制器发送的补偿控制量作为前馈输入,生成角速度期望发送至角速度PID控制器;
所述角速度PID控制器与动力执行器连接,用于生成角加速度期望并发送至动力执行器。
2.根据权利要求1所述的一种基于风速风向传感器的旋翼无人机控制系统,其特征在于,所述风速风向传感器为三轴风速计。
3.根据权利要求1所述的一种基于风速风向传感器的旋翼无人机控制系统,其特征在于,所述滤波器为多频滤波器。
4.根据权利要求1所述的一种基于风速风向传感器的旋翼无人机控制系统的控制方法,其特征在于,包括以下步骤:
1)获取旋翼无人机本体参数,根据组合导航获取的旋翼无人机姿态信息,通过风动试验进行拟合获取测量风速风向与风扰加速度的拟合关系函数,即气动模型;将气动模型储存至风扰加速度计算模块,等待调用;
2)风速风向传感器采集旋翼无人机的风矢量信息,并发送至多频滤波器;
3)多频滤波器接收到风速风向传感器的风矢量信息,对风矢量信息中数据进行滤波,并将滤波后的风矢量信息发送至风扰加速度计算模块;
4)风扰加速度计算模块根据接收到旋翼无人机姿态信息、旋翼无人机参数以及风速风向传感器测得的风矢量信息,通过储存在风扰加速度计算模块的气动模型,获取的风扰加速度信息,并发送至通信模块B,通过通信模块B将风扰加速度信息发送至补偿控制器;
5)补偿控制器接收到风扰加速度信息后进行处理,得到补偿控制量以及升力补偿量,分别发送给姿态PID控制器和动力执行器;
6)旋翼无人机的组合导航将位置信息、速度信息、姿态信息以及角速度信息分别发送至位置PID控制器、速度PID控制器、姿态PID信息以及角速度PID控制器进行处理,得到升力期望和角加速度期望;并发送至动力执行器,
7)动力执行器根据角加速度期望和升力期望,实现对在旋翼无人机受到风扰环境下的控制。
5.根据权利要求4所述的一种基于风速风向传感器的旋翼无人机控制系统的控制方法,其特征在于,所述步骤5),具体为:
恒定风速风向下使无人机处于稳定状态,根据水平方向上的风扰加速度与姿态的拟合关系得出当前风扰加速度下的旋翼无人机姿态,即稳态平衡姿态,将此稳态平衡姿态作为补偿控制量发送给姿态PID控制器作为姿态控制前馈;
根据垂直方向上风扰加速度,得到风扰下的垂向附加受力大小作为升力补偿量发送给升力PID控制器。
6.根据权利要求4所述的一种基于风速风向传感器的旋翼无人机控制系统的控制方法,其特征在于,所述步骤6),具体为:
PID控制器采用串级PID形式,位置控制器通过位置期望与当前位置做差获得三维位置偏差矢量,通过位置PID控制器生成速度期望;
速度控制器通过速度期望与当前速度做差获得三维速度偏差矢量,通过速度PID控制器生成原生姿态期望与原生升力期望;其中原生姿态期望通过水平方向速度偏差进行PID控制律运算生成,原生升力期望通过垂直方向速度偏差进行PID控制律运算生成;
将原生升力期望叠加补偿控制器的升力补偿量得到升力期望发送至动力执行器;
将稳态平衡姿态补偿控制量做为前馈输入与原生姿态期望叠加,获得姿态角期望,通过姿态期望与当前姿态进行PID控制律运算生成角速度期望,通过角速度期望与当前角速度进行PID控制律运算生成角加速度期望,并将角加速度期望发送给动力执行器。
7.根据权利要求4所述的一种基于风速风向传感器的旋翼无人机控制系统的控制方法,其特征在于,所述步骤7),具体为:
通过旋翼无人机转动惯量J与角加速度期望计算旋翼之间的期望拉力差,通过期望升力计算总拉力,得到各旋翼拉力后通过电机、旋翼气动力特性曲线获得转速期望,由转速控制器通过脉宽调制波对旋翼转速进行控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011377761.0A CN112379685B (zh) | 2020-11-30 | 2020-11-30 | 一种基于风速风向传感器的旋翼无人机控制系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011377761.0A CN112379685B (zh) | 2020-11-30 | 2020-11-30 | 一种基于风速风向传感器的旋翼无人机控制系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112379685A CN112379685A (zh) | 2021-02-19 |
CN112379685B true CN112379685B (zh) | 2022-02-11 |
Family
ID=74590462
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011377761.0A Active CN112379685B (zh) | 2020-11-30 | 2020-11-30 | 一种基于风速风向传感器的旋翼无人机控制系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112379685B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113504786B (zh) * | 2021-07-08 | 2022-06-14 | 中国南方电网有限责任公司超高压输电公司大理局 | 一种基于风向的无人机飞行调整方法及装置 |
CN113277076B (zh) * | 2021-07-22 | 2021-10-08 | 国网通用航空有限公司 | 垂直起降固定翼无人机螺旋桨减阻装置及其控制方法 |
CN114527776B (zh) * | 2022-01-07 | 2024-06-28 | 鹏城实验室 | 一种无人机抗风扰控制方法、装置、终端及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101468361A (zh) * | 2007-12-28 | 2009-07-01 | 中国科学院沈阳自动化研究所 | 一种用于线材连轧的活套控制方法及装置 |
CN102818911A (zh) * | 2011-06-08 | 2012-12-12 | 深圳市恒辉达电子有限公司 | 一种风速风向测试装置 |
CN109436272A (zh) * | 2018-12-28 | 2019-03-08 | 广州中国科学院沈阳自动化研究所分所 | 一种面向无人船的多动力源系统及其调度方法 |
CN110928201A (zh) * | 2019-12-26 | 2020-03-27 | 上海科梁信息工程股份有限公司 | 一种飞机航电系统半物理试验方法及系统 |
CN111284687A (zh) * | 2020-04-14 | 2020-06-16 | 中国人民解放军32180部队 | 高抗风共轴反桨式系留无人机及其飞行控制方法 |
CN111580494A (zh) * | 2020-04-28 | 2020-08-25 | 东风汽车集团有限公司 | 一种平行驾驶车辆控制参数自适应标定方法及系统 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU382963A1 (ru) * | 1968-09-23 | 1973-05-25 | Магнитомеханический компенсационный газоанализатор | |
FR2425644A2 (fr) * | 1978-05-08 | 1979-12-07 | Equip Navigation Aerienne | Procede et systeme de detection rapide de gradient de vent |
DE3145389C2 (de) * | 1980-11-15 | 1983-10-06 | Deutsche Forschungs- Und Versuchsanstalt Fuer Luft- Und Raumfahrt E.V., 5000 Koeln | Gerät zur Bestimmung des Windgradienten (Scherwind) und Abwindwinkels an Bord eines Fluggerätes |
EP1810099B1 (en) * | 2004-11-08 | 2016-09-07 | Bell Helicopter Textron Inc. | Flight control system having a three control loop design |
FR2891051B1 (fr) * | 2005-09-22 | 2007-10-19 | Airbus France Sas | Procede et dispositif pour realiser au moins un essai en vol sur un aeronef et applications |
CN106525375B (zh) * | 2016-10-21 | 2020-05-12 | 国网山东省电力公司电力科学研究院 | 一种用于无人机抗风能力检测的自适应系统 |
CN110537215B (zh) * | 2017-04-21 | 2021-09-17 | 深圳市大疆创新科技有限公司 | 风速力反馈 |
CN107121928B (zh) * | 2017-05-22 | 2019-08-20 | 华南理工大学 | 一种无人水面艇的扰动补偿控制方法 |
CN109542108A (zh) * | 2017-09-22 | 2019-03-29 | 南京开天眼无人机科技有限公司 | 一种无人机抗风巡飞系统 |
CN109614633B (zh) * | 2018-10-25 | 2023-08-01 | 南京航空航天大学 | 一种复合式旋翼飞行器非线性建模及线性化配平方法 |
CN111983921B (zh) * | 2019-05-23 | 2021-11-30 | 中国科学院沈阳自动化研究所 | 一种基于观测器技术的飞行器制导控制一体化方法 |
CN111413997B (zh) * | 2020-04-14 | 2023-08-22 | 中国人民解放军32180部队 | 高抗风倾转旋翼系留无人机及其飞行控制方法 |
CN111829747A (zh) * | 2020-07-18 | 2020-10-27 | 扬州大学 | 一种基于固定翼无人机的沿海大桥涡激共振风场监控系统 |
-
2020
- 2020-11-30 CN CN202011377761.0A patent/CN112379685B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101468361A (zh) * | 2007-12-28 | 2009-07-01 | 中国科学院沈阳自动化研究所 | 一种用于线材连轧的活套控制方法及装置 |
CN102818911A (zh) * | 2011-06-08 | 2012-12-12 | 深圳市恒辉达电子有限公司 | 一种风速风向测试装置 |
CN109436272A (zh) * | 2018-12-28 | 2019-03-08 | 广州中国科学院沈阳自动化研究所分所 | 一种面向无人船的多动力源系统及其调度方法 |
CN110928201A (zh) * | 2019-12-26 | 2020-03-27 | 上海科梁信息工程股份有限公司 | 一种飞机航电系统半物理试验方法及系统 |
CN111284687A (zh) * | 2020-04-14 | 2020-06-16 | 中国人民解放军32180部队 | 高抗风共轴反桨式系留无人机及其飞行控制方法 |
CN111580494A (zh) * | 2020-04-28 | 2020-08-25 | 东风汽车集团有限公司 | 一种平行驾驶车辆控制参数自适应标定方法及系统 |
Non-Patent Citations (2)
Title |
---|
Controller Design and Flight Experiments for the Dual Tilt Rotor Unmanned Aerial Vehicle in Helicopter Mode;Ruijian Zheng etal .;《2020 International Conference on Unmanned Aircraft Systems (ICUAS)》;20200904;第845-853页 * |
Wind Disturbance Rejection for Unmanned Aerial Vehicle Based on Acceleration Feedback Method;Bo Dai etal.;《2018 IEEE Conference on Decision and Control (CDC) 》;20181231;第4680-4686页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112379685A (zh) | 2021-02-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112379685B (zh) | 一种基于风速风向传感器的旋翼无人机控制系统及方法 | |
CN106249745B (zh) | 四轴无人机的控制方法 | |
CN102955477B (zh) | 一种四旋翼飞行器姿态控制系统及控制方法 | |
CA2651379C (en) | System and process for automatically controlling the flight of power wing airfoils | |
US20150331427A1 (en) | Control Method to Damp Quadrotor Slung Payload Mode | |
CN109606732B (zh) | 一种高效的飞机质量特性测量方法 | |
CN108475069B (zh) | 农业无人飞行器的控制方法、飞行控制器及农业无人机 | |
CN106707754A (zh) | 一种基于切换系统的货物搬运旋翼无人机建模及自适应控制方法 | |
CN107844124B (zh) | 一种四旋翼飞行器携带不平衡负载稳定飞行的控制方法 | |
CN109032156A (zh) | 一种基于状态观测的吊挂载荷四旋翼无人机悬停控制方法 | |
CN109542108A (zh) | 一种无人机抗风巡飞系统 | |
CN111307370A (zh) | 无人机转动惯量的测量方法 | |
US20210271267A1 (en) | System for compensating aerial vehicle attitude disturbances | |
CN111061282A (zh) | 基于能量法的四旋翼无人机吊挂飞行系统控制方法 | |
CN109343551A (zh) | 一种旋翼机协调转弯控制方法及系统 | |
CN114237266A (zh) | 一种基于l1自适应的扑翼飞行姿态控制方法 | |
JP4617990B2 (ja) | 自動飛行制御装置、自動飛行制御方法及び自動飛行制御プログラム | |
CN117452966A (zh) | 一种基于单轴拉力传感器的无人机力协同吊挂搬运方法 | |
Prkačin et al. | State and parameter estimation of suspended load using quadrotor onboard sensors | |
CN202854611U (zh) | 一种四旋翼飞行器姿态控制系统 | |
CN108279562A (zh) | 一种基于滑模pid控制的飞行机械臂 | |
Alcan et al. | Robust hovering control of a quadrotor using acceleration feedback | |
CN116305772A (zh) | 一种多旋翼空速解算方法、设备及计算机可读存储介质 | |
CN112462798B (zh) | 一种无人机及提高无人机航线飞行性能的方法 | |
Cicolani et al. | Modeling and simulation of a helicopter slung load stabilization device |
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 |