CN109343551A - 一种旋翼机协调转弯控制方法及系统 - Google Patents
一种旋翼机协调转弯控制方法及系统 Download PDFInfo
- Publication number
- CN109343551A CN109343551A CN201811264139.1A CN201811264139A CN109343551A CN 109343551 A CN109343551 A CN 109343551A CN 201811264139 A CN201811264139 A CN 201811264139A CN 109343551 A CN109343551 A CN 109343551A
- Authority
- CN
- China
- Prior art keywords
- value
- difference
- speed
- obtains
- actual
- 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
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000012937 correction Methods 0.000 claims abstract description 99
- 238000005096 rolling process Methods 0.000 claims description 22
- 230000009466 transformation Effects 0.000 claims description 18
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 4
- 241000208340 Araliaceae Species 0.000 description 6
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 6
- 235000003140 Panax quinquefolius Nutrition 0.000 description 6
- 235000008434 ginseng Nutrition 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 230000005484 gravity Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 201000009482 yaws Diseases 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
-
- 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)
- 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
本发明公开了一种旋翼机协调转弯控制方法及系统。该方法包括:获取旋翼机在转弯时的实际飞行参量值和对应的参考参量值;将实际高度值和参考高度值作为高度控制器的输入,采用PID算法,得到速度修正值;将实际速度值、参考速度值和速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力;将实际姿态角值、实际角速度值、参考姿态角值和姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩;将控制力矩和发动机推力作为陆空车辆飞行动力学模型的输入,对旋翼机在转弯时的飞行状态进行控制。采用本发明的方法或系统能够提高旋翼机转弯飞行的平稳性和速度,准确控制航向,减少安全隐患。
Description
技术领域
本发明涉及飞行器控制技术领域,特别是涉及一种旋翼机协调转弯控制方法及系统。
背景技术
转弯飞行是指目标位置不在当前航向,需要对飞行方向进行调整的一种飞行模式,尤其在对地面目标进行盘旋侦察时,更显其必要性。飞行器在转弯飞行过程中,机身产生了滚转倾斜,使得航向的调整对纵向姿态也有影响;另一方面,机身的倾斜产生了侧滑运动,对机身形成了侧向阻力,不利于飞行稳定,故飞行器在转弯飞行过程中一般采用协调转弯飞行方式。
目前,对飞行器转弯飞行的研究,大多集中在对直升机转弯飞行控制的研究,几乎没有对旋翼机转弯飞行控制进行专门研究。随着旋翼机在陆空领域的广泛应用,对其转弯飞行进行控制,以提高转弯飞行的平稳性和速度,准确控制航向,进而减少安全隐患,显得尤其重要。
发明内容
基于此,有必要提供一种旋翼机协调转弯控制方法及系统,以提高旋翼机转弯飞行的平稳性和速度,准确控制航向,减少安全隐患。
为实现上述目的,本发明提供了如下方案:
一种旋翼机协调转弯控制方法,包括:
获取旋翼机在转弯时的实际飞行参量值;所述实际飞行参量值包括实际高度值、实际速度值、实际姿态角值和实际角速度值;
获取所述实际飞行参量值对应的参考参量值;所述参考参量值包括参考高度值、参考速度值和参考姿态角值;
将所述实际高度值和所述参考高度值作为高度控制器的输入,采用PID算法,得到速度修正值;
将所述实际速度值、所述参考速度值和所述速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力;所述姿态角修正值包括滚转角修正值和俯仰角修正值;
将所述实际姿态角值、所述实际角速度值、所述参考姿态角值和所述姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩;所述控制力矩包括滚转力矩、俯仰力矩和偏航力矩;
将所述控制力矩和所述发动机推力作为陆空车辆飞行动力学模型的输入,对所述旋翼机在转弯时的飞行状态进行控制。
可选的,所述将所述实际高度值和所述参考高度值作为高度控制器的输入,采用PID算法,得到速度修正值,具体包括:
将所述实际高度值和所述参考高度值做差,得到第一差值;
将所述第一差值作为高度控制器的输入,采用PID算法,得到速度修正值。
可选的,所述将所述实际速度值、所述参考速度值和所述速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力,具体包括:
将所述实际速度值中x轴方向的实际速度值和所述参考速度值中x轴方向的参考速度值做差,得到第二差值;
将所述实际速度值中y轴方向的实际速度值和所述参考速度值中y轴方向的参考速度值做差,得到第三差值;
将所述实际速度值中z轴方向的实际速度值和所述参考速度值中z轴方向的参考速度值做差,得到第四差值;
将所述第四差值与所述速度修正值做差,得到第五差值;
将所述第二差值、所述第三差值和所述第五差值作为速度控制器的输入,采用PID算法,得到俯仰角修正值、滚转角修正值和发动机推力。
可选的,所述将所述实际姿态角值、所述实际角速度值、所述参考姿态角值和所述姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩,具体包括:
将所述参考姿态角值中的参考滚转角值与所述滚转角修正值做差,得到第六差值;
将所述参考姿态角值中的参考俯仰角值与所述俯仰角修正值做差,得到第七差值;
将所述参考姿态角值中的参考偏航角值进行积分变换,得到参考姿态角变换值;
将所述第六差值、所述第七差值、所述参考姿态角变换值、所述实际姿态角值和所述实际角速度值作为内环姿态控制器的输入,采用鲁棒控制方法,得到滚转力矩、俯仰力矩和偏航力矩。
本发明还提供了一种旋翼机协调转弯控制系统,所述系统包括:
第一获取模块,用于获取旋翼机在转弯时的实际飞行参量值;所述实际飞行参量值包括实际高度值、实际速度值、实际姿态角值和实际角速度值;
第二获取模块,用于获取所述实际飞行参量值对应的参考参量值;所述参考参量值包括参考高度值、参考速度值和参考姿态角值;
修正值获取模块,用于将所述实际高度值和所述参考高度值作为高度控制器的输入,采用PID算法,得到速度修正值;
第三获取模块,用于将所述实际速度值、所述参考速度值和所述速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力;所述姿态角修正值包括滚转角修正值和俯仰角修正值;
力矩获取模块,用于将所述实际姿态角值、所述实际角速度值、所述参考姿态角值和所述姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩;所述控制力矩包括滚转力矩、俯仰力矩和偏航力矩;
飞行控制模块,用于将所述控制力矩和所述发动机推力作为陆空车辆飞行动力学模型的输入,对所述旋翼机在转弯时的飞行状态进行控制。
可选的,所述修正值获取模块,具体包括:
第一差值获取单元,用于将所述实际高度值和所述参考高度值做差,得到第一差值;
速度修正值获取单元,用于将所述第一差值作为高度控制器的输入,采用PID算法,得到速度修正值。
可选的,所述第三获取模块,具体包括:
第二差值获取单元,用于将所述实际速度值中x轴方向的实际速度值和所述参考速度值中x轴方向的参考速度值做差,得到第二差值;
第三差值获取单元,用于将所述实际速度值中y轴方向的实际速度值和所述参考速度值中y轴方向的参考速度值做差,得到第三差值;
第四差值获取单元,用于将所述实际速度值中z轴方向的实际速度值和所述参考速度值中z轴方向的参考速度值做差,得到第四差值;
第五差值获取单元,用于将所述第四差值与所述速度修正值做差,得到第五差值;
第三获取单元,用于将所述第二差值、所述第三差值和所述第五差值作为速度控制器的输入,采用PID算法,得到俯仰角修正值、滚转角修正值和发动机推力。
可选的,所述力矩获取模块,具体包括:
第六差值获取单元,用于将所述参考姿态角值中的参考滚转角值与所述滚转角修正值做差,得到第六差值;
第七差值获取单元,用于将所述参考姿态角值中的参考俯仰角值与所述俯仰角修正值做差,得到第七差值;
变换值获取单元,用于将所述参考姿态角值中的参考偏航角值进行积分变换,得到参考姿态角变换值;
力矩获取单元,用于将所述第六差值、所述第七差值、所述参考姿态角变换值、所述实际姿态角值和所述实际角速度值作为内环姿态控制器的输入,采用鲁棒控制方法,得到滚转力矩、俯仰力矩和偏航力矩。
与现有技术相比,本发明的有益效果是:
本发明提出了一种旋翼机协调转弯控制方法及系统,所述方法包括:获取旋翼机在转弯时的实际飞行参量值和对应的参考参量值;将实际高度值和参考高度值作为高度控制器的输入,采用PID算法,得到速度修正值;将实际速度值、参考速度值和速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力;将实际姿态角值、实际角速度值、参考姿态角值和姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩;将控制力矩和发动机推力作为陆空车辆飞行动力学模型的输入,对旋翼机在转弯时的飞行状态进行控制。本发明能够提高旋翼机转弯飞行的平稳性和速度,准确控制航向,减少安全隐患。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例旋翼机协调转弯控制方法的流程图;
图2为本发明实施例旋翼机协调转弯控制方法的原理图;
图3为旋翼机的受力分析图;
图4为本发明实施例旋翼机协调转弯控制系统的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
旋翼机固定高度盘旋飞行控制包括平面飞行控制和高度飞行控制两个方面,但是这两方面并不是割裂的,而是互相关联的整体,因此应对所有控制回路,包括高度控制回路、速度控制回路和航向控制回路进行综合,将相互之间存在耦合的控制回路合为一个整体。
高度回路由控制系统根据高度传感器测量的高度值与给定高度比较,解算得出控制指令操纵发动机推力和桨盘俯仰,以保持高度稳定;平面控制要求无人旋翼机在固定高度平面内对圆弧航迹能达到较好的跟踪效果,要求旋翼机能够按照给定航向,使机体轴与圆弧切线尽量保持一致;当受到扰动旋翼机偏离航迹时,根据当前实测位置与速度矢量计算修正策略,使旋翼机回到预定航迹。
图1为本发明实施例旋翼机协调转弯控制方法的流程图;图2为本发明实施例旋翼机协调转弯控制方法的原理图。
参见图1-2,实施例的旋翼机协调转弯控制方法,包括:
步骤S1:获取旋翼机在转弯时的实际飞行参量值。
所述实际飞行参量值包括实际高度值h、实际速度值、实际姿态角值和实际角速度值。所述实际飞行参量值是通过参量对应的传感器获得的,例如采用高度传感器测量得到实际高度值h。
步骤S2:获取所述实际飞行参量值对应的参考参量值。
所述参考参量值包括参考高度值href、参考速度值和参考姿态角值。
步骤S3:将所述实际高度值h和所述参考高度值href作为高度控制器的输入,采用PID算法,得到速度修正值。
所述步骤S3具体包括:
将所述实际高度值h和所述参考高度值href做差,得到第一差值;
将所述第一差值作为高度控制器的输入,采用PID算法,得到速度修正值。
步骤S4:将所述实际速度值、所述参考速度值和所述速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力。
所述姿态角修正值包括滚转角修正值和俯仰角修正值。
所述步骤S4具体包括:
将所述实际速度值中x轴方向的实际速度值Vx和所述参考速度值中x轴方向的参考速度值Vx_ref做差,得到第二差值;
将所述实际速度值中y轴方向的实际速度值Vy和所述参考速度值中y轴方向的参考速度值Vy_ref做差,得到第三差值;
将所述实际速度值中z轴方向的实际速度值Vz和所述参考速度值中z轴方向的参考速度值Vz_ref做差,得到第四差值;
将所述第四差值与所述速度修正值做差,得到第五差值;
将所述第二差值、所述第三差值和所述第五差值作为速度控制器的输入,采用PID算法,得到俯仰角修正值、滚转角修正值和发动机推力。
步骤S5:将所述实际姿态角值、所述实际角速度值、所述参考姿态角值和所述姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩。
所述实际姿态角值包括实际滚转角值φ、实际俯仰角值θ和实际偏航角值ψ;所述实际角速度值包括实际滚转角速度值p、实际俯仰角速度值q和实际偏航角速度值r;所述参考姿态角值包括参考滚转角值φref、参考俯仰角值θref和参考偏航角值ψref;所述控制力矩包括滚转力矩、俯仰力矩和偏航力矩。
所述步骤S5具体包括:
将所述参考姿态角值中的参考滚转角值φref与所述滚转角修正值做差,得到第六差值;
将所述参考姿态角值中的参考俯仰角值θref与所述俯仰角修正值做差,得到第七差值;
将所述参考姿态角值中的参考偏航角值ψref进行积分变换,得到参考姿态角变换值;
将所述第六差值、所述第七差值、所述参考姿态角变换值、所述实际姿态角值和所述实际角速度值作为内环姿态控制器的输入,采用鲁棒控制方法,得到滚转力矩、俯仰力矩和偏航力矩。
步骤S6:将所述控制力矩和所述发动机推力作为陆空车辆飞行动力学模型的输入,对所述旋翼机在转弯时的飞行状态进行控制。
所述陆空车辆飞行动力学模型是依据对旋翼机纵向受力分析和对旋翼机横向受力分析建立的。将所述控制力矩和所述发动机推力作为陆空车辆飞行动力学模型的输入,对旋翼机的滚转、俯仰和偏航进行操纵,进而实现对所述旋翼机在转弯时的飞行状态进行控制。
图3为旋翼机的受力分析图,其中图3(a)为旋翼机纵向受力分析图,其中图3(b)为旋翼机横向受力分析图。
参见图3(a),θR为旋翼桨盘与机体轴的夹角,若机身迎角为α,则桨盘迎角为αR=α+θR;旋翼拉力TR垂直于桨盘向上;发动机推力Tρ在机体纵向对称面内与机体轴平行;G为飞机重力;L和D分别为机身所受的气动升力与阻力,其大小取决于飞行速度V。
无人旋翼机在作转弯飞行过程中,偏航角及航迹偏转角是主要控制目标,控制航迹偏转角是为了控制速度方向与规划航迹保持一致,以达到航迹跟踪效果。由物理学匀速率圆周运动知,无人旋翼机实现协调转弯飞行须满足:(1)旋翼拉力在竖直方向上的分力与旋翼机所受重力相等;(2)旋翼拉力在航迹线速度方向上的分力与空气阻力及发动机推力平衡;(3)旋翼拉力在水平方向的分力应指向圆弧航迹的圆心,与飞机转弯受到的离心力相等。
参见图3(b),φ为滚转角,因旋翼拉力大小取决于飞行速度和桨盘迎角,故在盘旋过程中,需稳定飞行速度和桨盘迎角,但旋翼机在盘旋过程中不断改变航向,而且机身相对盘旋圆心有个滚转角,使机体俯仰姿态与航向之间相互影响。针对该情况,在控制律设计中可采用前向通道补偿实现纵横向解耦。由上述分析,无人旋翼机实现固定高度转弯飞行需满足:
其中,m为旋翼机质量;g为重力加速度。
本实施例中,各个差值的计算均是通过差值运算器得到的,偏航角值ψref的积分变换是通过积分器实现的。
本实施例的旋翼机协调转弯控制方法,能够提高旋翼机转弯飞行的平稳性和速度,准确控制航向,减少安全隐患;能够提高旋翼机在转弯时前飞速度跟踪精度,提高对高度的跟踪性能。
本实施例还提供了一种旋翼机协调转弯控制系统,图4为本发明实施例旋翼机协调转弯控制系统的结构示意图。
参见图4,实施例的旋翼机协调转弯控制系统包括:
第一获取模块401,用于获取旋翼机在转弯时的实际飞行参量值;所述实际飞行参量值包括实际高度值、实际速度值、实际姿态角值和实际角速度值。
第二获取模块402,用于获取所述实际飞行参量值对应的参考参量值;所述参考参量值包括参考高度值、参考速度值和参考姿态角值。
修正值获取模块403,用于将所述实际高度值和所述参考高度值作为高度控制器的输入,采用PID算法,得到速度修正值。
所述修正值获取模块403,具体包括:
第一差值获取单元,用于将所述实际高度值和所述参考高度值做差,得到第一差值;
速度修正值获取单元,用于将所述第一差值作为高度控制器的输入,采用PID算法,得到速度修正值。
第三获取模块404,用于将所述实际速度值、所述参考速度值和所述速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力;所述姿态角修正值包括滚转角修正值和俯仰角修正值。
所述第三获取模块404,具体包括:
第二差值获取单元,用于将所述实际速度值中x轴方向的实际速度值和所述参考速度值中x轴方向的参考速度值做差,得到第二差值;
第三差值获取单元,用于将所述实际速度值中y轴方向的实际速度值和所述参考速度值中y轴方向的参考速度值做差,得到第三差值;
第四差值获取单元,用于将所述实际速度值中z轴方向的实际速度值和所述参考速度值中z轴方向的参考速度值做差,得到第四差值;
第五差值获取单元,用于将所述第四差值与所述速度修正值做差,得到第五差值;
第三获取单元,用于将所述第二差值、所述第三差值和所述第五差值作为速度控制器的输入,采用PID算法,得到俯仰角修正值、滚转角修正值和发动机推力。
力矩获取模块405,用于将所述实际姿态角值、所述实际角速度值、所述参考姿态角值和所述姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩;所述控制力矩包括滚转力矩、俯仰力矩和偏航力矩。
所述力矩获取模块405,具体包括:
第六差值获取单元,用于将所述参考姿态角值中的参考滚转角值与所述滚转角修正值做差,得到第六差值;
第七差值获取单元,用于将所述参考姿态角值中的参考俯仰角值与所述俯仰角修正值做差,得到第七差值;
变换值获取单元,用于将所述参考姿态角值中的参考偏航角值进行积分变换,得到参考姿态角变换值;
力矩获取单元,用于将所述第六差值、所述第七差值、所述参考姿态角变换值、所述实际姿态角值和所述实际角速度值作为内环姿态控制器的输入,采用鲁棒控制方法,得到滚转力矩、俯仰力矩和偏航力矩。
飞行控制模块406,用于将所述控制力矩和所述发动机推力作为陆空车辆飞行动力学模型的输入,对所述旋翼机在转弯时的飞行状态进行控制。
本实施例的旋翼机协调转弯控制系统,能够提高旋翼机转弯飞行的平稳性和速度,准确控制航向,减少安全隐患。
本说明书中对于实施例公开的系统而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。
Claims (8)
1.一种旋翼机协调转弯控制方法,其特征在于,包括:
获取旋翼机在转弯时的实际飞行参量值;所述实际飞行参量值包括实际高度值、实际速度值、实际姿态角值和实际角速度值;
获取所述实际飞行参量值对应的参考参量值;所述参考参量值包括参考高度值、参考速度值和参考姿态角值;
将所述实际高度值和所述参考高度值作为高度控制器的输入,采用PID算法,得到速度修正值;
将所述实际速度值、所述参考速度值和所述速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力;所述姿态角修正值包括滚转角修正值和俯仰角修正值;
将所述实际姿态角值、所述实际角速度值、所述参考姿态角值和所述姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩;所述控制力矩包括滚转力矩、俯仰力矩和偏航力矩;
将所述控制力矩和所述发动机推力作为陆空车辆飞行动力学模型的输入,对所述旋翼机在转弯时的飞行状态进行控制。
2.根据权利要求1所述的一种旋翼机协调转弯控制方法,其特征在于,所述将所述实际高度值和所述参考高度值作为高度控制器的输入,采用PID算法,得到速度修正值,具体包括:
将所述实际高度值和所述参考高度值做差,得到第一差值;
将所述第一差值作为高度控制器的输入,采用PID算法,得到速度修正值。
3.根据权利要求1所述的一种旋翼机协调转弯控制方法,其特征在于,所述将所述实际速度值、所述参考速度值和所述速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力,具体包括:
将所述实际速度值中x轴方向的实际速度值和所述参考速度值中x轴方向的参考速度值做差,得到第二差值;
将所述实际速度值中y轴方向的实际速度值和所述参考速度值中y轴方向的参考速度值做差,得到第三差值;
将所述实际速度值中z轴方向的实际速度值和所述参考速度值中z轴方向的参考速度值做差,得到第四差值;
将所述第四差值与所述速度修正值做差,得到第五差值;
将所述第二差值、所述第三差值和所述第五差值作为速度控制器的输入,采用PID算法,得到俯仰角修正值、滚转角修正值和发动机推力。
4.根据权利要求1所述的一种旋翼机协调转弯控制方法,其特征在于,所述将所述实际姿态角值、所述实际角速度值、所述参考姿态角值和所述姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩,具体包括:
将所述参考姿态角值中的参考滚转角值与所述滚转角修正值做差,得到第六差值;
将所述参考姿态角值中的参考俯仰角值与所述俯仰角修正值做差,得到第七差值;
将所述参考姿态角值中的参考偏航角值进行积分变换,得到参考姿态角变换值;
将所述第六差值、所述第七差值、所述参考姿态角变换值、所述实际姿态角值和所述实际角速度值作为内环姿态控制器的输入,采用鲁棒控制方法,得到滚转力矩、俯仰力矩和偏航力矩。
5.一种旋翼机协调转弯控制系统,其特征在于,包括:
第一获取模块,用于获取旋翼机在转弯时的实际飞行参量值;所述实际飞行参量值包括实际高度值、实际速度值、实际姿态角值和实际角速度值;
第二获取模块,用于获取所述实际飞行参量值对应的参考参量值;所述参考参量值包括参考高度值、参考速度值和参考姿态角值;
修正值获取模块,用于将所述实际高度值和所述参考高度值作为高度控制器的输入,采用PID算法,得到速度修正值;
第三获取模块,用于将所述实际速度值、所述参考速度值和所述速度修正值作为速度控制器的输入,采用PID算法,得到姿态角修正值和发动机推力;所述姿态角修正值包括滚转角修正值和俯仰角修正值;
力矩获取模块,用于将所述实际姿态角值、所述实际角速度值、所述参考姿态角值和所述姿态角修正值作为内环姿态控制器的输入,采用鲁棒控制方法,得到控制力矩;所述控制力矩包括滚转力矩、俯仰力矩和偏航力矩;
飞行控制模块,用于将所述控制力矩和所述发动机推力作为陆空车辆飞行动力学模型的输入,对所述旋翼机在转弯时的飞行状态进行控制。
6.根据权利要求5所述的一种旋翼机协调转弯控制系统,其特征在于,所述修正值获取模块,具体包括:
第一差值获取单元,用于将所述实际高度值和所述参考高度值做差,得到第一差值;
速度修正值获取单元,用于将所述第一差值作为高度控制器的输入,采用PID算法,得到速度修正值。
7.根据权利要求5所述的一种旋翼机协调转弯控制系统,其特征在于,所述第三获取模块,具体包括:
第二差值获取单元,用于将所述实际速度值中x轴方向的实际速度值和所述参考速度值中x轴方向的参考速度值做差,得到第二差值;
第三差值获取单元,用于将所述实际速度值中y轴方向的实际速度值和所述参考速度值中y轴方向的参考速度值做差,得到第三差值;
第四差值获取单元,用于将所述实际速度值中z轴方向的实际速度值和所述参考速度值中z轴方向的参考速度值做差,得到第四差值;
第五差值获取单元,用于将所述第四差值与所述速度修正值做差,得到第五差值;
第三获取单元,用于将所述第二差值、所述第三差值和所述第五差值作为速度控制器的输入,采用PID算法,得到俯仰角修正值、滚转角修正值和发动机推力。
8.根据权利要求5所述的一种旋翼机协调转弯控制系统,其特征在于,所述力矩获取模块,具体包括:
第六差值获取单元,用于将所述参考姿态角值中的参考滚转角值与所述滚转角修正值做差,得到第六差值;
第七差值获取单元,用于将所述参考姿态角值中的参考俯仰角值与所述俯仰角修正值做差,得到第七差值;
变换值获取单元,用于将所述参考姿态角值中的参考偏航角值进行积分变换,得到参考姿态角变换值;
力矩获取单元,用于将所述第六差值、所述第七差值、所述参考姿态角变换值、所述实际姿态角值和所述实际角速度值作为内环姿态控制器的输入,采用鲁棒控制方法,得到滚转力矩、俯仰力矩和偏航力矩。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811264139.1A CN109343551A (zh) | 2018-10-29 | 2018-10-29 | 一种旋翼机协调转弯控制方法及系统 |
PCT/CN2019/104397 WO2020088094A1 (zh) | 2018-10-29 | 2019-09-04 | 一种旋翼机协调转弯控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811264139.1A CN109343551A (zh) | 2018-10-29 | 2018-10-29 | 一种旋翼机协调转弯控制方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109343551A true CN109343551A (zh) | 2019-02-15 |
Family
ID=65310921
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811264139.1A Pending CN109343551A (zh) | 2018-10-29 | 2018-10-29 | 一种旋翼机协调转弯控制方法及系统 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN109343551A (zh) |
WO (1) | WO2020088094A1 (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020088094A1 (zh) * | 2018-10-29 | 2020-05-07 | 北京理工大学 | 一种旋翼机协调转弯控制方法及系统 |
CN112306078A (zh) * | 2020-11-16 | 2021-02-02 | 广东电网有限责任公司肇庆供电局 | 一种无人机自动避障导线的方法及系统 |
CN112904871A (zh) * | 2021-01-22 | 2021-06-04 | 北京电子工程总体研究所 | 一种基于螺旋桨和俯仰缆绳复合控制的囊体高度控制系统 |
CN113031641A (zh) * | 2021-05-21 | 2021-06-25 | 北京三快在线科技有限公司 | 无人机控制方法、装置、存储介质及无人机 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8235324B1 (en) * | 2009-03-03 | 2012-08-07 | Orbital Research Inc. | Rotorcraft with electrically driven blade control |
CN104699108A (zh) * | 2013-12-10 | 2015-06-10 | 中国航空工业第六一八研究所 | 一种多旋翼飞行器的控制分配方法 |
CN104898429A (zh) * | 2015-05-27 | 2015-09-09 | 北京工业大学 | 一种基于自抗扰控制的三旋翼姿态控制方法 |
US20160138523A1 (en) * | 2014-11-14 | 2016-05-19 | United Technologies Corporation | Optimal Thrust Control of an Aircraft Engine |
CN108502153A (zh) * | 2017-02-27 | 2018-09-07 | 贝尔直升机德事隆公司 | Fbw飞行控制系统、方法及旋翼飞行器 |
CN108594840A (zh) * | 2018-05-29 | 2018-09-28 | 中山星图航空航天技术有限公司 | 倾转控制装置及其控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104298109B (zh) * | 2014-09-23 | 2017-04-19 | 南京航空航天大学 | 基于多控制器融合的无尾飞行器协调转弯控制方法 |
US10093415B1 (en) * | 2017-03-20 | 2018-10-09 | Bell Helicopter Textron Inc. | System and method for rotorcraft heading control |
CN109343551A (zh) * | 2018-10-29 | 2019-02-15 | 北京理工大学 | 一种旋翼机协调转弯控制方法及系统 |
-
2018
- 2018-10-29 CN CN201811264139.1A patent/CN109343551A/zh active Pending
-
2019
- 2019-09-04 WO PCT/CN2019/104397 patent/WO2020088094A1/zh active Application Filing
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8235324B1 (en) * | 2009-03-03 | 2012-08-07 | Orbital Research Inc. | Rotorcraft with electrically driven blade control |
CN104699108A (zh) * | 2013-12-10 | 2015-06-10 | 中国航空工业第六一八研究所 | 一种多旋翼飞行器的控制分配方法 |
US20160138523A1 (en) * | 2014-11-14 | 2016-05-19 | United Technologies Corporation | Optimal Thrust Control of an Aircraft Engine |
CN104898429A (zh) * | 2015-05-27 | 2015-09-09 | 北京工业大学 | 一种基于自抗扰控制的三旋翼姿态控制方法 |
CN108502153A (zh) * | 2017-02-27 | 2018-09-07 | 贝尔直升机德事隆公司 | Fbw飞行控制系统、方法及旋翼飞行器 |
CN108594840A (zh) * | 2018-05-29 | 2018-09-28 | 中山星图航空航天技术有限公司 | 倾转控制装置及其控制方法 |
Non-Patent Citations (2)
Title |
---|
YANG WANG.ETL: "Modeling and Hovering Attitude Control of a Prototype Tandem Ducted Fan Vehicle", 《JOURNAL OF INTELLIGENT & ROBOTIC SYSTEMS》 * |
黄楠: "陆空车辆飞行包线研究", 《中国优秀硕士学位论文全文数据库(电子期刊)》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020088094A1 (zh) * | 2018-10-29 | 2020-05-07 | 北京理工大学 | 一种旋翼机协调转弯控制方法及系统 |
CN112306078A (zh) * | 2020-11-16 | 2021-02-02 | 广东电网有限责任公司肇庆供电局 | 一种无人机自动避障导线的方法及系统 |
CN112306078B (zh) * | 2020-11-16 | 2024-01-23 | 广东电网有限责任公司肇庆供电局 | 一种无人机自动避障导线的方法及系统 |
CN112904871A (zh) * | 2021-01-22 | 2021-06-04 | 北京电子工程总体研究所 | 一种基于螺旋桨和俯仰缆绳复合控制的囊体高度控制系统 |
CN112904871B (zh) * | 2021-01-22 | 2023-02-28 | 北京电子工程总体研究所 | 一种基于螺旋桨和俯仰缆绳复合控制的囊体高度控制系统 |
CN113031641A (zh) * | 2021-05-21 | 2021-06-25 | 北京三快在线科技有限公司 | 无人机控制方法、装置、存储介质及无人机 |
CN113031641B (zh) * | 2021-05-21 | 2021-08-27 | 北京三快在线科技有限公司 | 无人机控制方法、装置、存储介质及无人机 |
Also Published As
Publication number | Publication date |
---|---|
WO2020088094A1 (zh) | 2020-05-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109343551A (zh) | 一种旋翼机协调转弯控制方法及系统 | |
CN104898429B (zh) | 一种基于自抗扰控制的三旋翼姿态控制方法 | |
Fagiano et al. | Automatic crosswind flight of tethered wings for airborne wind energy: Modeling, control design, and experimental results | |
CN102163059B (zh) | 推力变向无人机的姿态控制系统及控制方法 | |
CN105159305B (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN104590557B (zh) | 一种多旋翼和固定翼复合飞行器的飞行控制方法及装置 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN105425812B (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
CN103955224B (zh) | 一种用于相对运动视线跟踪的姿态控制方法 | |
CN106871742A (zh) | 一种设置在弹体上的控制系统 | |
CN109062042A (zh) | 一种旋翼飞行器的有限时间航迹跟踪控制方法 | |
CN103955223A (zh) | 一种深空探测软着陆过程的姿轨耦合控制方法 | |
CN108873929A (zh) | 一种固定翼飞机自主着舰方法及系统 | |
CN106200665A (zh) | 携带不确定负载的四轴飞行器的建模与自适应控制方法 | |
CN103307938A (zh) | 一种旋转弹气动参数获取方法 | |
CN112198885B (zh) | 一种满足机动平台自主降落需求的无人机控制方法 | |
CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
CN109649691A (zh) | 一种偏置动量卫星单飞轮与磁联合控制方法和系统 | |
CN109582039A (zh) | 一种采用相对导航信息的j2摄动下最优队形重构方法 | |
CN110673623A (zh) | 一种基于双环pd控制算法控制的四旋翼无人机着陆方法 | |
CN109407688A (zh) | 一种垂直起降火箭在线轨迹规划的质心运动解耦方法 | |
Karásek et al. | Free flight force estimation of a 23.5 g flapping wing MAV using an on-board IMU | |
Zhang et al. | Quadrotor aircraft control without velocity measurements | |
CN106292297B (zh) | 基于pid控制器和l1自适应控制器的姿态控制方法 | |
CN117008626A (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: 20190215 |