用于飞行器大空域飞行的非线性抗饱和高度指令生成方法技术

本发明专利技术公开了用于飞行器大空域飞行的非线性抗饱和高度指令生成方法，高度指令生成器首先根据测量得到的垂向速度信号与高度信号组成滑模面；根据滑模面构造高度抗饱和指令，该指令为有界姿态指令信号，输送给飞行器内回路姿态指令稳定跟踪控制器；由飞行器内回路姿态指令稳定跟踪控制器的内稳定回路给出控制信号输送给舵机；舵机产生舵偏角，控制飞行器的俯仰姿态角跟踪接近俯仰姿态角期望值，最终使飞行器高度跟踪飞行器期望高度，实现高度控制的目标。本发明专利技术的有益效果是与传统PID高度指令生成方法相比，具有跟踪高度范围广的优点，而且具有抗饱和的特点，特别适用于飞行器大空域飞行的高度控制。

【技术实现步骤摘要】

本专利技术属于飞行器飞行控制中俯仰通道质心控制
，尤其涉及用于飞行器大空域飞行的非线性抗饱和高度指令生成方法。
技术介绍
高度控制回路是飞行器控制系统中的质心控制外回路。目前飞行器高度控制回路的设计主要是采用PID控制或者PD控制来实现的。其基本原理是利用飞行器的实际高度与期望高度之间的误差信号组成PID控制器中的P信号，而利用该误差的积分组成PID控制中的I信号，利用误差的微分或者直接利用飞行器的垂向速度，构成PID或者PD控制器中的微分信号。最后，通过误差的PID组合，新成姿态角期望信号，由飞行器内稳定回路(姿态跟踪内回路)完成对姿态期望信号的跟踪，从而实现飞行器对给定高度的控制功能。该方案的优点是PID算法的高度成熟可靠性，通用多年的应用已积累了较多的经验。但缺点在于，该方案在飞行器进行大空域飞行时，设计比较繁琐，需要采用多套控制参数进行不同空域范围的切换控制，同时空域范围越大，所需切换次数也越多，而稳定性所受影响也越大。产生该缺点的主要原因，是飞行器的内稳定回路受物理意义的限制，使得姿态的期望信号必须满足一定范围限制，如对大多数飞行器，姿态角幅值应当小于30度。而当飞行器进行大空域机动飞行时，高度的期望信号变化范围较大，如从1米至20000米高空飞行时，其期望信号变化范围为20000米，那么误差范围变化也较大，最终通过误差信号与PID参数的匹配，得到姿态的期望信号将超出内回路的跟踪能力而饱和，此时单套参数的PID控制就失去了合理性。当然，也可以采用平滑指令来减少误差，但本质上无法回避误差范围变化较大时，PID控制需要多套参数来保证信号的合理性问题。正是由于以上原因，目前高度PID或PD控制方法，在小范围空域的高度控制取得了广泛的应用，如定高平飞等等。但对应需要飞行器实现从低空到高度，甚至多次来回跨越高低空切换的复杂飞行模式时，采用高度PID或PD控制方法，设计将非常不方便，而且多套参数切换也使得系统复杂，可靠性降低。本专利技术正是基于以上原因，提出一种非线性抗饱和的设计方法，从根本上保证了该高度指令不会出现饱和，从而非常方便地实现了飞行器大空域飞行时高度的任意控制。
技术实现思路
本专利技术的目的是提供用于飞行器大空域飞行的非线性抗饱和高度指令生成方法，解决了现有技术中存在的基于高度误差PID控制方案对大空域飞行容易出现高度指令饱和而不利于实现飞行器的复杂高低空轨迹混合飞行控制的问题。本专利技术所采用的技术方案是按照以下步骤进行：步骤1：采用高度表测量飞行器的高度z，采用惯导系统测量飞行器的垂向速度信号步骤2：高度指令生成器首先根据测量得到的垂向速度信号与高度信号z组成滑模面sz(也就是)；步骤3：然后根据滑模面sz构造高度抗饱和指令θd(也就是θd＝kz2sz/(|sz|+ξ))，该指令为有界姿态指令信号，输送给飞行器内回路姿态指令稳定跟踪控制器；步骤4：最后由飞行器内回路姿态指令稳定跟踪控制器的内稳定回路(也简称内回路、也称姿态指令稳定跟踪回路)给出控制信号uc，输送给舵机；步骤5：舵机产生舵偏角δz，控制飞行器的俯仰姿态角θ，从而跟踪接近俯仰姿态角期望值θd(也就是实现θ→θd)，最后使得飞行器高度z跟踪飞行器期望高度zd，实现了高度控制的目标(也就是实现了z→zd)。进一步，所述滑模面构造高度抗饱和指令的方法根据测量的飞行器飞行高度值z与给定的飞行器期望高度zd，形成误差信号ez，其定义为ez＝z-zd；根据误差信号ez与惯导测量的高度微分信号选取正的参数cz，按照如下方式组成滑模面sz，其定义为该期望高度为常值的情况下则因此该信号本质上是微分信号，是高度微分，提供阻尼作用，使高度上升过程更加平稳。根据上述滑模面，选取正的参数ξ与kz2，构造有界的高度抗饱和指令θd＝kz2sz/(|sz|+ξ)作为俯仰姿态角期望值的输入θd；高度抗饱和指令的设计其实就是把高度差信号转换为姿态角的期望值，因此高度抗饱和指令也就是俯仰姿态角期望值。因为飞行器分两个回路，前面一级是高度回路，后面一级为姿态回路，高度回路的输出，就是叫做高度抗饱和指令，同时他又是后面姿态回路的输入，也叫做姿态角期望值。进一步，所述cz取值为0.06。进一步，采用所述内稳定回路的简化模型构建高度仿真程序，内稳定回路的简化模型如下：α·=ωz-a34α-a35δz]]>ω·z=a24α+a22ωz+a25δz]]>θ·=ωz]]>ny=vxbga34α+vxbga35δz]]>其中内稳定回路的目标是设计舵偏δz使得内稳定回路实现飞行器的姿态角θ跟踪θd。其中α和为飞行器攻角，aij为飞行器的飞行力学相关气动参数，其中i、j代表飞行器气动特性的参数。δz为舵机的舵偏角，g为重力加速度，ny为纵向过载，vxb为飞行器飞行速度；θ为飞行器俯仰角度，为θ的导数，也就是角速度，ωz为角速度，为飞行器俯仰角加速度。V·zb=g(ny-1)]]>x·=vxbcosθ+vzbsinθ]]>z·=-vxbsinθ+vzbcosθ]]>其中Vzb为飞行器垂向速度、为其导数，x为飞行器飞行距离、为其导数，z为飞行器飞行高度，为垂向速度。高度回路的目标是设计高度抗饱和指令θd，作为内稳定回路的参考输入信号，待内稳定回路控制律使得飞行器俯仰姿态角信号θ跟踪θd后，飞行器高度z自动跟踪期望信号zd，高度误差ez趋于0。本专利技术的有益效果是：本专利技术提供的高度抗饱和非线性指令生成方法，与传统PID高度指令生成方法相比，具有跟踪高度范围广的优点，而且具有抗饱和的特点，特别适用于飞行器大空域飞行的高度控制。附图说明图1是抗饱和高度非线性指令生成设计系统框图；图2(a)是本专利技术实施例一的垂向速度实施例图；图2(b)是本专利技术实施例一的角速度实施例图；图2(c)是本专利技术实施例一的姿态角实施例图；图2(d)是本专利技术实施例一的水平飞行距离实施例图；图2(e)是本专利技术实施例一的飞行高度实施例图；图2(f)是本专利技术实施例一的俯仰舵偏本文档来自技高网...

【技术保护点】
用于飞行器大空域飞行的非线性抗饱和高度指令生成方法，其特征在于，包括以下步骤：步骤1：采用高度表测量飞行器的高度，采用惯导系统测量飞行器的垂向速度信号；步骤2：高度指令生成器首先根据测量得到的垂向速度信号与高度信号组成滑模面；步骤3：根据滑模面构造高度抗饱和指令，该指令为有界姿态指令信号，输送给飞行器内回路姿态指令稳定跟踪控制器；步骤4：由飞行器内回路姿态指令稳定跟踪控制器的内稳定回路给出控制信号输送给舵机；步骤5：舵机产生舵偏角，控制飞行器的俯仰姿态角跟踪接近俯仰姿态角期望值，最终使飞行器高度跟踪飞行器期望高度，实现高度控制的目标。

【技术特征摘要】
1.用于飞行器大空域飞行的非线性抗饱和高度指令生成方法，
其特征在于，包括以下步骤：
步骤1：采用高度表测量飞行器的高度，采用惯导系统测量飞行
器的垂向速度信号；
步骤2：高度指令生成器首先根据测量得到的垂向速度信号与高
度信号组成滑模面；
步骤3：根据滑模面构造高度抗饱和指令，该指令为有界姿态指
令信号，输送给飞行器内回路姿态指令稳定跟踪控制器；
步骤4：由飞行器内回路姿态指令稳定跟踪控制器的内稳定回路
给出控制信号输送给舵机；
步骤5：舵机产生舵偏角，控制飞行器的俯仰姿态角跟踪接近俯
仰姿态角期望值，最终使飞行器高度跟踪飞行器期望高度，实现高度
控制的目标。
2.按照权利要求1所述用于飞行器大空域飞行的非线性抗饱和
高度指令生成方法，其特征在于：所述滑模面构造高度抗饱和指令的
方法为：根据测量的飞行器飞行高度值z与给定的飞行器期望高度
zd，形成误差信号ez，其定义为ez＝z-zd；根据误差信号ez与惯导测
量的高度微分信号选取正的参数cz，按照如下方式组成滑模面
sz，定义为选取正的参数ξ与kz2，构造有界的高
度抗饱和指令θd＝kz2sz/(|sz|+ξ)作为俯仰姿态角期望值的输入θd。
3.按照权利要求2所述用于飞行器大空域飞行的非线性抗饱和
高度指令生成方法，其特征在于...

【专利技术属性】
技术研发人员：于进勇，雷军委，梁国强，王玲玲，刘迪，吴华丽，
申请(专利权)人：中国人民解放军海军航空工程学院，
类型：发明
国别省市：山东;37