CN108628342A - 无人飞行器的自动飞行控制***及方法 - Google Patents
无人飞行器的自动飞行控制***及方法 Download PDFInfo
- Publication number
- CN108628342A CN108628342A CN201810399081.5A CN201810399081A CN108628342A CN 108628342 A CN108628342 A CN 108628342A CN 201810399081 A CN201810399081 A CN 201810399081A CN 108628342 A CN108628342 A CN 108628342A
- Authority
- CN
- China
- Prior art keywords
- instruction
- rudder
- data
- controlled volume
- module
- 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
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 title claims abstract description 36
- 238000000034 method Methods 0.000 title claims abstract description 34
- 230000008859 change Effects 0.000 claims abstract description 30
- 238000012544 monitoring process Methods 0.000 claims abstract description 19
- 238000012545 processing Methods 0.000 claims abstract description 16
- 230000008569 process Effects 0.000 claims abstract description 11
- 238000004364 calculation method Methods 0.000 claims abstract description 8
- 238000001914 filtration Methods 0.000 claims description 11
- 235000013399 edible fruits Nutrition 0.000 claims description 4
- 238000009499 grossing Methods 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 4
- TVEXGJYMHHTVKP-UHFFFAOYSA-N 6-oxabicyclo[3.2.1]oct-3-en-7-one Chemical compound C1C2C(=O)OC1C=CC2 TVEXGJYMHHTVKP-UHFFFAOYSA-N 0.000 claims description 3
- 241000208340 Araliaceae Species 0.000 claims description 3
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 claims description 3
- 235000003140 Panax quinquefolius Nutrition 0.000 claims description 3
- 235000008434 ginseng Nutrition 0.000 claims description 3
- 230000001360 synchronised effect Effects 0.000 claims description 2
- 230000002159 abnormal effect Effects 0.000 description 4
- 230000007423 decrease Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 210000004556 brain Anatomy 0.000 description 1
- 230000009194 climbing Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000035939 shock Effects 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/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
无人飞行器的自动飞行控制***及方法,涉及无人飞行器控制领域,解决现有飞行控制***在使用过程中存在稳性差且安全***低等问题,包括数据同步模块、数据处理模块、指令变化率限幅模块、被控量偏差限幅模块、舵指令运算模块、舵指令处理模块和飞行状态监测模块;根据飞行器的实际性能,确定指令变化速率极限参数,可根据飞行器所处的实际状态调整,以此为依据对飞行控制***实际输入的控制指令进行变化率限制。需要进行变化率限幅的指令数据包括姿态角指令、空速指令、高度指令和航向指令。根据飞行器的实际性能,确定被控量偏差值参数,这些参数可根据飞行器所处的实际状态进行动态调整,以此为依据对被控量指令值与实际值的偏差进行幅值限制。
Description
技术领域
本发明涉及无人飞行器控制领域,具体涉及一种无人飞行器的自动控制***及方法。
背景技术
随着无人飞行器技术的迅猛发展,无人飞行器产品及其相关服务市场空前繁荣。以无人飞行器为平台,搭载不同的载荷就可以提供相应的服务。目前在环境监测、农业植保、航空拍摄、遥感测绘等领域,无人飞行器以其高效性、精准性等优势取得了广泛的应用。
飞行控制***作为无人飞行器的“大脑”,其性能的优劣在很大程度上决定着无人飞行器的服务效果和机身以及载荷的安全。以航空拍摄型无人飞行器为例,即使目前的工业级相机已有防抖算法或装置,但是在拍照过程中由震动带来的噪声对照片效果影响依然很大,因此,在设计这种飞行器的控制***时飞行姿态的稳定性是首要保证的指标。另外,由于这种无人飞行器搭载的精密光学载荷往往价格昂贵,所以要求飞行器能够应对空中的异常情况,设置一定的应急保障机制,在最大限度上保证机身以及载荷的安全。
发明内容
本发明为解决现有飞行控制***在使用过程中存在稳性差且安全***低等问题,提供一种无人飞行器的自动飞行控制***及方法。
无人飞行器的自动飞行控制***,包括数据同步模块、数据处理模块、指令变化率限幅模块、被控量偏差限幅模块、舵指令运算模块、舵指令处理模块和飞行状态监测模块;
所述数据同步模块,用于获取控制***输入数据,包括来自地面站的控制指令数据和来自传感器的飞行器实际状态数据,对所述数据进行同步后发送到数据处理模块;
所述数据处理模块,用于对数据同步模块输入的控制指令数据和飞行器实际状态数据进行处理,对控制指令主要进行幅值限制;对飞行器实际状态数据进行滤波,去除噪声,使数据平滑;
所述指令变化率限幅模块,用于对控制指令的变化率进行限制;
所述被控量偏差限幅模块,用于对控制指令值与飞行器实际状态值的偏差进行幅值限制,确定被控量偏差值;
舵指令运算模块,用于根据被控量偏差限幅模块计算的被控量偏差值生成舵指令;
所述舵指令处理模块,用于将舵指令运算模块生成的舵指令进行幅值限制和滤波;
所述飞行状态监测模块,用于监测飞行器实际状态数据,计算当前被控制量偏差值与预设的偏差参数进行比较获得监测结果,并将获得的监测结果返回地面站,作为进一步决策依据,实现无人飞行器的自动飞行控制。
无人飞行器的自动飞行控制方法,该方法由以下步骤实现:
步骤一、***初始化;
步骤二、根据飞行器的实际状态设定当前的控制参数类别;每个类别的控制参数内容均包括控制指令极限参数、控制指令变化率极限参数和被控量偏差极限参数;
步骤三、自动飞行控制***中的数据同步模块接收地面站控制指令与飞行器实际状态数据,并进行数据更新;
步骤四、对控制指令与飞行器实际状态数据进行处理,具体处理过程为:
步骤四一、首先将接收到的飞行器实际状态数据进行分类滤波;
步骤四二、判断当前帧控制指令是否超过当前类控制参数中的指令极限参数,如果是,执行步骤四三,如果否,执行步骤四四;
步骤四三、则将当前类控制参数中的指令极限参数赋给当前帧控制指令;
步骤四四、判断当前帧控制指令变化率是否超过预设的控制指令变化率极限参数,如果是,执行步骤四五,如果否,执行步骤四六;
步骤四五、采用最高变化率修改当前帧控制指令;
步骤四六、输出当前帧控制指令值;
步骤五、计算被控量偏差,具体过程为:
步骤五一、采用被控量偏差限幅模块计算当前帧控制指令值与飞行器实际状态值的偏差,获得当前帧被控量偏差;
步骤五二、判断当前帧被控量偏差是否超过当前类控制参数中的被控量偏差极限参数,如果是,执行步骤五三,如果否,执行步骤五四;
步骤五三、将当前类控制参数中的被控量偏差极限参数值赋给当前帧被控量偏差;
步骤五四、输出当前帧被控量偏差;
步骤六、根据当前帧被控量偏差生成舵指令,并对生成的舵指令进行处理,具体处理过程为:
步骤六一、首先判断飞行器飞行状态是否有切换,如果是,执行步骤六二;如果否,执行步骤六三;
步骤六二、通过一阶低通滤波器对舵指令进行滤波;
步骤六三、判断当前帧舵指令是否超过当前类舵指令极限参数,如果是,执行步骤六四;如果否,执行步骤六五;
步骤六四、将当前类舵指令极限参数值赋给当前舵指令;
步骤六五、输出当前舵指令;
步骤七、飞行状态监测与反馈;具体步骤为:
步骤七一、计算被控量偏差值以及所述被控量偏差值绝对值的变化率;
步骤七二、判断被控量偏差值是否在预设的偏差参数范围内,如果是,向地面站发送任务完成;如果否,执行步骤七三;
步骤七三、判断被控量偏差值绝对值是否呈收敛趋势,且变化率最终值接近0,如果是,向地面站发送任务完成但未成完成;如果否,向地面站发送任务异常。
本发明的有益效果:与一般的飞行控制***比较,本发明可明显提高无人飞行器飞行平稳性,特别是在飞行模式切换过程中飞机姿态角变化平缓。在航空拍摄型无人机的应用上,明显提高了拍照质量。同时在飞机遭遇到异常情况时能够充分保障机身及载荷安全。
在实现控制无人飞行器自动飞行的基础上提高飞行过程平稳性和安全性,降低飞行模式切换过程中飞机姿态的震荡幅度。
附图说明
图1为无人飞行器自动飞行控制***模块示意图;
图2为自动飞行控制***运行流程示意图;
图3为无人飞行器自动飞行控制方法中步骤四的具体流程图;
图4为无人飞行器自动飞行控制方法中步骤五的具体流程图;
图5为无人飞行器自动飞行控制方法中步骤六的具体流程图;
图6为无人飞行器自动飞行控制方法中步骤七的具体流程图。
具体实施方式
具体实施方式一、结合图1和图2说明本实施方式,无人飞行器的自动飞行控制***,本实施方式采用固定翼型无人飞行器,该飞行器巡航速度28m/s,飞行高度600m,主要功能是进行航空拍摄。该自动飞行控制***包括:
数据同步模块S1,由于飞行器的指令及状态数据是通过外部硬件设备获取的,数据的频率、获取时间不尽相同,所以需要对各类数据进行时间对其,即所谓的“同步”。数据同步完成后将被以结构体的形式整体发送到数据处理模块S2。即:用于获取控制***输入数据,包括来自地面站的控制指令数据和来自传感器的飞行器实际状态数据,对所述数据进行同步后发送到数据处理模块;
数据处理模块S2,用于对输入的控制指令进行限幅,包括姿态角指令、空速指令、高度指令和航向指令等,限幅极限参数是控制参数的一部分,由飞行器所处的状态决定;该模块还用于对飞行器实际状态数据进行滤波,去除噪声,使数据平滑包括俯仰角、滚转角、偏航角、俯仰角速度、滚转角速度、偏航角速度、地速、空速、高度等。
指令变化率限幅模块S3,用于对控制指令的变化幅度进行限制,相当于对指令进行平滑处理,避免飞行器产生过大机动而造成的姿态震荡。限幅极限参数是控制参数的一部分,由飞行器所处的状态决定。
被控量偏差限幅模块S4,用于对控制指令值与实际值的偏差进行幅值限制,避免因被控量偏差过大而运算产生舵指令异常值,影响飞行器姿态稳定性。限幅极限参数是控制参数的一部分,由飞行器所处的状态决定。
舵指令运算模块S5,用于根据被控量偏差计算生成舵指令,包括油门指令、升降舵指令、方向舵指令和副翼指令。
舵指令处理模块S6,用于对舵指令进行幅值限制和滤波。保证舵指令平滑。
飞行状态监测模块S7,用于监测飞行器实际状态信息,计算当前位置姿态与目标位置姿态的偏差,与预设的偏差值进行比较分析后得出监测结果,并将结果返回地面站,作为进一步决策依据,以确保飞行器的安全性。
具体实施方式二、结合图3至图6说明本实施方式,无人飞行器的自动飞行控制方法,该方法由以下步骤实现:
步骤一、***初始化;
***初始化包括飞行控制单元、硬件***上电等过程。
步骤二、根据飞行器的实际状态设定当前的控制参数类别;
对飞行器在空中飞行过程中的状态进行归纳,得出6个状态类别,分别是平飞、直线爬升、直线下降、定高盘旋、盘旋爬升和盘旋下降。因此,为每个飞行状态设置一套控制参数即平飞类、直线爬升类、直线下降类、定高盘旋类、盘旋爬升类和盘旋下降类。飞行控制***初始化默认为平飞状态,在飞行过程中飞行控制***会自动判别飞机所处的状态,并发出状态字更改指令,从而实现控制参数类别的变化。
前述每套控制参数的内容包括均包括控制指令极限参数、控制指令变化率极限参数、被控量偏差极限参数。
步骤三、接收地面站控制指令与飞行器实际状态数据,并进行数据更新;
飞行控制***的采样周期为0.02s,即按照50Hz的频率接收来自地面站的控制指令和飞行器实际状态数据。控制指令的主要内容是姿态角指令、空速指令、高度指令和航向指令等,控制指令是按照某种通信协议发送给飞行控制***的。
步骤四、对控制指令与飞行器实际状态数据进行处理,该步骤流程如图3所示;
步骤四一、首先将接收到的飞行器实际状态数据进行分类滤波。其中北向速度、东向速度、地向速度数据选用窗口长度为3的中值滤波器和窗口长度为20的均值滤波器;俯仰角、滚转角、偏航角数据选用窗口长度为3中值滤波器和采样频率50Hz、截止频率10Hz的二阶巴特沃斯滤波器;俯仰角速度、滚转角速度、偏航角速度数据选用窗口长度为3的中值滤波器和采样频率50Hz、截止频率10Hz的二阶巴特沃斯滤波器;空速数据选用采样频率50Hz、截止频率10Hz的二阶巴特沃斯滤波器。
步骤四二、将所有的控制指令值与当前类控制参数中的指令极限参数比较,判断其是否超过当前类控制参数中的指令极限参数。如果判断结果为“是”,执行步骤四三,如果为否,执行步骤四四
步骤四三、则将相应的极限值赋给当前帧控制指令。
步骤四四、将当前帧控制指令与前帧进行比较,判断其变化率超过当前类控制参数中的控制指令变化率极限参数;如果是,执行步骤四五;如果否,执行步骤四六;
步骤四五、则认为当前帧指令无效,立即按照允许的最高变化率缓修改当前帧控制指令。
步骤四六、输出当前帧控制指令。
步骤五、计算被控量偏差并对其进行限幅,该步骤流程如图4所示;
步骤五一、将最终有效的控制指令与相应的飞行器实际状态数据做差,得出被控量偏差;
步骤五二、将当前帧被控量偏差与当前类控制参数中的被控量偏差极限参数进行比较,判断其是否超过当前类控制参数中的被控量偏差极限参数。如果判断结果为“是”,执行步骤五三;如果否,执行步骤五四;
步骤五三、则将相应的极限参数值赋给当前帧被控量偏差;
步骤五四、输出当前帧被控量偏差。
步骤六、根据被控量指令值与实际值偏差计算生成舵指令,并对生成的舵指令进行处理;
根据步骤五最终确定的被控量偏差,采用由比例(P)、积分(I)、微分(D)环节构成的控制器计算生成油门指令、升降舵指令、方向舵指令和副翼指令。
步骤六一、首先判断飞行器飞行状态是否有切换,飞行状态即前述归纳的六类。如果是,执行步骤六二,如果否,则进入步骤六三。
步骤六二、则认为飞行器处于状态切换的过渡阶段,此时对油门指令、升降舵指令、方向舵指令和副翼指令进行滤波,选用的滤波器为一阶低通滤波器。滤波器启动后开始计时,持续50周期认为过渡阶段结束,关闭滤波器;
步骤六三、将当前帧舵指令与舵指令极限参数进行比较,判断其是否超过当前类舵指令极限参数,如果是,执行步骤六四;
步骤六四、则将相应的极限参数值赋给当前帧舵指令;如果否,则进入步骤六五。
步骤六五、输出当前舵指令。
步骤七、飞行状态监测与反馈;
步骤七一、计算飞行器实际状态与控制指令的偏差值并计算飞行器实际状态与控制指令偏差值绝对值的变化率。
步骤七二、判断飞行器实际状态与控制指令的偏差是否在预先设定的偏差参数范围内,如果是,执行步骤七六;如果否,执行步骤七三;
步骤七三、判断飞行器实际状态与控制指令的偏差值绝对值是否呈收敛趋势,且变化率最终值接近0,如果是,执行步骤七五;如果否,执行步骤七四;
步骤七四、则向地面站发送“任务异常”,标志着本次飞行遇到了异常情况,请求地面站采取应急措施。
步骤七五、则向地面站发送“任务正常但未完成”,标志着本次飞行情况正常,但是并未达到当前的控制指令,可继续等待。
步骤七六、则向地面站发送“任务完成”,标志着本次飞行正常且已经达到当前的控制指令,可向飞行器继续发送指令。
本实施方式中,对输入控制指令进行幅值限制,幅值限制采取的上下限数值可根据飞行器所处的实际状态进行动态调整。
在飞行器实际状态数据滤波过程中,应该根据各类数据的特性,采取合适的滤波器。其中高度数据选用滑动均值滤波器,地速(北向速度、东向速度、地向速度)数据选用中值滤波器和均值滤波器,姿态角(俯仰角、滚转角、偏航角)数据选用中值滤波器和二阶巴特沃斯滤波器,姿态角速度(俯仰角速度、滚转角速度、偏航角速度)数据选用中值滤波器和二阶巴特沃斯滤波器,空速数据选用二阶巴特沃斯滤波器。
根据飞行器的实际性能,确定指令变化速率极限参数,这些参数可根据飞行器所处的实际状态调整,以此为依据对飞行控制***实际输入的控制指令进行变化率限制。需要进行变化率限幅的指令数据包括姿态角指令、空速指令、高度指令和航向指令。
根据飞行器的实际性能,确定被控量偏差极限参数,这些参数可根据飞行器所处的实际状态进行动态调整,以此为依据对被控量指令值与实际值的偏差进行幅值限制。需要进行变化率限幅的指令数据包括姿态角偏差、空速偏差、高度偏差和航向偏差。
采用由比例(P)、积分(I)、微分(D)环节构成的控制器计算生成舵指令。
舵指令处理过程主要包括舵指令幅值限制和滤波,舵指令限制极限参数由飞行器控制执行机构的实际行程决定;舵指令滤波主要针对飞行器飞行状态发生切换的过渡阶段,而且只持续有限个控制周期,选用的滤波器为一阶低通滤波器。
飞行控制***每个控制周期结束前应当对飞行器的状态进行监测,监测的内容包括当前飞行器实际状态与控制指令的偏差程度和变化趋势。如果飞行器实际状态与控制指令偏差满足要求,且变化趋势正确则向地面站发送“任务完成”标志;如果飞行器实际状态与控制指令偏差未满足要求,且变化趋势正确则向地面站发送“任务正常但未完成”标志;如果飞行器实际状态与控制指令偏差未满足要求,且变化趋势不正确则向地面站发送“任务异常”标志。
为适应飞行器在不同状态下的控制要求,飞行控制***提供了多套控制参数,控制参数包括前述控制指令极限参数、控制指令变化率极限参数、被控量偏差极限参数。在飞行过程中,根据飞行器所处状态的不同设置与之相匹配的控制参数,从而确保飞行状态切换过程中各项指标变化平稳。
Claims (6)
1.无人飞行器的自动飞行控制***,包括数据同步模块、数据处理模块、指令变化率限幅模块、被控量偏差限幅模块、舵指令运算模块、舵指令处理模块和飞行状态监测模块;其特征是,
所述数据同步模块,用于获取控制***输入数据,包括来自地面站的控制指令数据和来自传感器的飞行器实际状态数据,对所述数据进行同步后发送到数据处理模块;
所述数据处理模块,用于对数据同步模块输入的控制指令数据和飞行器实际状态数据进行处理,对控制指令主要进行幅值限制;对飞行器实际状态数据进行滤波,去除噪声,使数据平滑;
所述指令变化率限幅模块,用于对控制指令的变化率进行限制;
所述被控量偏差限幅模块,用于对控制指令值与飞行器实际状态值的偏差进行幅值限制,确定被控量偏差值;
舵指令运算模块,用于根据被控量偏差限幅模块计算的被控量偏差值生成舵指令;
所述舵指令处理模块,用于将舵指令运算模块生成的舵指令进行幅值限制和滤波;
所述飞行状态监测模块,用于监测飞行器实际状态数据,计算当前被控制量偏差值与预设的偏差参数进行比较获得监测结果,并将获得的监测结果返回地面站,作为进一步决策依据,实现无人飞行器的自动飞行控制。
2.根据权利要求1所述的无人飞行器的自动飞行控制***,其特征在于,在飞行器实际状态数据进行滤波过程中,根据各类数据的特性,采取相应的滤波器;其中高度数据选用滑动均值滤波器,地速数据选用中值滤波器和均值滤波器,姿态角数据选用中值滤波器和二阶巴特沃斯滤波器,姿态角速度数据选用中值滤波器和二阶巴特沃斯滤波器,空速数据选用二阶巴特沃斯滤波器。
3.根据权利要求2所述的无人飞行器的自动飞行控制***,其特征在于,所述地速数据采用窗口长度为3的中值滤波器和窗口长度为20的均值滤波器;姿态角数据采用窗口长度为3中值滤波器和采样频率50Hz、截止频率10Hz的二阶巴特沃斯滤波器;姿态角速度数据采用窗口长度为3的中值滤波器和采样频率50Hz、截止频率10Hz的二阶巴特沃斯滤波器;空速数据选用采样频率50Hz、截止频率10Hz的二阶巴特沃斯滤波器。
4.根据权利要求1所述的无人飞行器的自动飞行控制***的控制方法,其特征是,该方法由以下步骤实现:
步骤一、***初始化;
步骤二、根据飞行器的实际状态设定当前的控制参数类别;每个类别的控制参数内容均包括控制指令极限参数、控制指令变化率极限参数和被控量偏差极限参数;
步骤三、自动飞行控制***中的数据同步模块接收地面站控制指令与飞行器实际状态数据,并进行数据更新;
步骤四、对控制指令与飞行器实际状态数据进行处理,具体处理过程为:
步骤四一、首先将接收到的飞行器实际状态数据进行分类滤波;
步骤四二、判断当前帧控制指令是否超过当前类控制参数中的指令极限参数,如果是,执行步骤四三,如果否,执行步骤四四;
步骤四三、则将当前类控制参数中的指令极限参数赋给当前帧控制指令;
步骤四四、判断当前帧控制指令变化率是否超过预设的控制指令变化率极限参数,如果是,执行步骤四五,如果否,执行步骤四六;
步骤四五、采用最高变化率修改当前帧控制指令;
步骤四六、输出当前帧控制指令值;
步骤五、计算被控量偏差,具体过程为:
步骤五一、采用被控量偏差限幅模块计算当前帧控制指令值与飞行器实际状态值的偏差,获得当前帧被控量偏差;
步骤五二、判断当前帧被控量偏差是否超过当前类控制参数中的被控量偏差极限参数,如果是,执行步骤五三,如果否,执行步骤五四;
步骤五三、将当前类控制参数中的被控量偏差极限参数值赋给当前帧被控量偏差;
步骤五四、输出当前帧被控量偏差;
步骤六、根据当前帧被控量偏差生成舵指令,并对生成的舵指令进行处理,具体处理过程为:
步骤六一、首先判断飞行器飞行状态是否有切换,如果是,执行步骤六二;如果否,执行步骤六三;
步骤六二、通过一阶低通滤波器对舵指令进行滤波;
步骤六三、判断当前帧舵指令是否超过当前类舵指令极限参数,如果是,执行步骤六四;如果否,执行步骤六五;
步骤六四、将当前类舵指令极限参数值赋给当前舵指令;
步骤六五、输出当前舵指令;
步骤七、飞行状态监测与反馈;具体步骤为:
步骤七一、计算被控量偏差值以及所述被控量偏差值绝对值的变化率;
步骤七二、判断被控量偏差值是否在预设的偏差参数范围内,如果是,向地面站发送任务完成;如果否,执行步骤七三;
步骤七三、判断被控量偏差值绝对值是否呈收敛趋势,且变化率最终值接近0,如果是,向地面站发送任务完成但未成完成;如果否,向地面站发送任务异常。
5.根据权利要求4所述的控制方法,其特征在于,舵指令处理过程主要包括舵指令幅值限制和滤波,舵指令限制极限参数由飞行器控制执行机构的实际行程决定;舵指令滤波主要针对飞行器飞行状态发生切换的过渡阶段,且只持续有限个控制周期,选用的滤波器为一阶低通滤波器。
6.根据权利要求4所述的控制方法,其特征在于,采用由比例(P)、积分(I)、微分(D)环节构成的控制器计算生成舵指令。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810399081.5A CN108628342A (zh) | 2018-04-28 | 2018-04-28 | 无人飞行器的自动飞行控制***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810399081.5A CN108628342A (zh) | 2018-04-28 | 2018-04-28 | 无人飞行器的自动飞行控制***及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108628342A true CN108628342A (zh) | 2018-10-09 |
Family
ID=63694905
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810399081.5A Pending CN108628342A (zh) | 2018-04-28 | 2018-04-28 | 无人飞行器的自动飞行控制***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108628342A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110083172A (zh) * | 2019-05-21 | 2019-08-02 | 郭远芳 | 一种无人飞行器操控*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2040874A1 (fr) * | 1990-04-24 | 1991-10-25 | Jacques Farineau | Systeme pour le pilotage d'un avion en tangage |
CN104691742A (zh) * | 2013-12-10 | 2015-06-10 | 中国航空工业第六一八研究所 | 一种飞翼布局无人飞机应用阻力方向舵的控制方法 |
CN105676674A (zh) * | 2016-04-20 | 2016-06-15 | 北京航空航天大学 | 基于指令滤波器的无人机前轮转向控制方法 |
CN106094840A (zh) * | 2016-07-20 | 2016-11-09 | 深圳洲际通航投资控股有限公司 | 飞行控制***及方法 |
-
2018
- 2018-04-28 CN CN201810399081.5A patent/CN108628342A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA2040874A1 (fr) * | 1990-04-24 | 1991-10-25 | Jacques Farineau | Systeme pour le pilotage d'un avion en tangage |
CN104691742A (zh) * | 2013-12-10 | 2015-06-10 | 中国航空工业第六一八研究所 | 一种飞翼布局无人飞机应用阻力方向舵的控制方法 |
CN105676674A (zh) * | 2016-04-20 | 2016-06-15 | 北京航空航天大学 | 基于指令滤波器的无人机前轮转向控制方法 |
CN106094840A (zh) * | 2016-07-20 | 2016-11-09 | 深圳洲际通航投资控股有限公司 | 飞行控制***及方法 |
Non-Patent Citations (3)
Title |
---|
李博,等: "四旋翼机动动作最优控制模型设计", 《电光与控制》 * |
温全,等: "基于STM32和OV2640的自主循迹四旋翼飞行器设计", 《微型机与应用》 * |
翟彬: "小型无人机飞控***实时仿真技术研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110083172A (zh) * | 2019-05-21 | 2019-08-02 | 郭远芳 | 一种无人飞行器操控*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106774409B (zh) | 一种无人机的半自主仿地飞行***及其控制方法 | |
CN106681344B (zh) | 一种用于飞行器的高度控制方法及控制*** | |
Li et al. | Visual model‐predictive localization for computationally efficient autonomous racing of a 72‐g drone | |
CN110609569B (zh) | 一种应用于电力杆塔的自主控制无人机精准巡检***和方法 | |
CN106227226A (zh) | 一种一体化无人机飞行的控制装置和方法 | |
JP6390013B2 (ja) | 小型無人飛行機の制御方法 | |
CN108919830A (zh) | 一种无人机精准降落的飞行控制方法 | |
CN106155090B (zh) | 基于体感的可穿戴无人机控制设备 | |
CN103914065B (zh) | 飞行器状态实时修正的方法和装置 | |
CN103389732B (zh) | 飞行器驾驶控制方法 | |
US20220326720A1 (en) | Method and system for hovering control of unmanned aerial vehicle in tunnel | |
CN105404308A (zh) | 一种翼伞无人机飞行控制器 | |
CN107908197A (zh) | 基于红外信标及视觉的无人机精准降落***和方法 | |
CN107765708A (zh) | 一种六旋翼无人机飞行控制***及控制方法 | |
CN106774374B (zh) | 一种无人机自动巡检方法及*** | |
CN110673623B (zh) | 一种基于双环pd控制算法控制的四旋翼无人机着陆方法 | |
CN109445449A (zh) | 一种高亚音速无人机超低空飞行控制***及方法 | |
US20180155056A1 (en) | Flight Landing Sequence of an Unmanned Aerial Vehicle into the Hand of the Operator | |
CN107783421A (zh) | 一种无人机自适应质量补偿控制方法和*** | |
WO2016048437A1 (en) | Initial rotor state compensation for a rotorcraft | |
CN113050427A (zh) | 一种执行器故障下非线性***快速终端滑模容错控制方法 | |
CN105912002A (zh) | 一种改变飞机飞行高度的控制方法 | |
CN204883371U (zh) | 一种定维飞行的多旋翼飞行器及其控制器 | |
CN108628342A (zh) | 无人飞行器的自动飞行控制***及方法 | |
CN111895998B (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20181009 |
|
WD01 | Invention patent application deemed withdrawn after publication |