发明名称 基于甲板运动补偿的舰载机自动着舰引导控制方法
摘要 本发明涉及一种基于甲板运动补偿的舰载机自动着舰引导控制方法,属于舰载机着舰引导与控制技术领域。舰载机自动着舰引导控制系统由装载在舰上的引导子系统和装载在飞机上的控制子系统组成。引导子系统包括跟踪雷达、雷达稳定平台、高速通用计算机、显示平台、数据编码发射机、数据链监控器和飞行轨迹记录仪;控制子系统包括自动驾驶仪、数据链接收机、接收译码器、自动驾驶仪耦合器、自动油门控制器和机上雷达设备。在该系统中引入甲板运动信息,设置甲板运动预估器和甲板运动补偿网络,使舰载机着舰轨迹跟踪舰母甲板运动轨迹,从而减小了由于甲板运动而引起的着舰误差,提高了着舰安全。
申请公布号 CN102393641A 申请公布日期 2012.03.28
申请号 CN201110322181.6 申请日期 2011.10.21
申请人 南京航空航天大学 发明人 江驹;王新华;甄子洋;杨一栋;周鑫;焦鑫
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 南京经纬专利商标代理有限公司 32200 代理人 许方
主权项 1.一种基于甲板运动补偿的舰载机自动着舰引导控制方法,其特征在于,包括设置舰母甲板运动预估器和舰母甲板运动补偿网络,(1)设置舰母甲板运动预估器,用于预估<img file="161230DEST_PATH_IMAGE001.GIF" wi="13" he="14" />时刻后的舰母甲板运动信息,该舰母甲板运动预估器是利用卡尔曼最优滤波理论推导得到的一组递推方程,定义甲板沉浮运动位移<img file="573757DEST_PATH_IMAGE002.GIF" wi="24" he="25" />是舰载机着舰引导控制系统状态向量<img file="414805DEST_PATH_IMAGE003.GIF" wi="20" he="25" />的一个分量,状态向量<img file="658704DEST_PATH_IMAGE003.GIF" wi="20" he="25" />在<img file="425541DEST_PATH_IMAGE004.GIF" wi="14" he="16" />时刻的最优估计值<img file="59784DEST_PATH_IMAGE005.GIF" wi="40" he="28" />为:<img file="688212DEST_PATH_IMAGE006.GIF" wi="222" he="42" />(1)式中,<img file="802930DEST_PATH_IMAGE007.GIF" wi="80" he="22" />为变换矩阵,<i>k</i>为时间,<img file="491400DEST_PATH_IMAGE008.GIF" wi="64" he="25" />,<img file="612940DEST_PATH_IMAGE004.GIF" wi="14" he="16" />为预估时间,T<sub>s</sub>为系统采样时间,<img file="294326DEST_PATH_IMAGE009.GIF" wi="25" he="28" />为最优滤波值,预估<img file="512817DEST_PATH_IMAGE001.GIF" wi="13" he="14" />时刻的舰母甲板运动位置信息<img file="309872DEST_PATH_IMAGE010.GIF" wi="49" he="28" />分两步进行计算:<img file="731757DEST_PATH_IMAGE011.GIF" wi="16" he="21" />利用离散系统卡尔曼滤波方程组,递推计算k时刻舰载机着舰引导系统状态的卡尔曼最优滤波值<img file="701987DEST_PATH_IMAGE009.GIF" wi="25" he="28" />:<img file="24253DEST_PATH_IMAGE012.GIF" wi="254" he="28" />(2)式中,<img file="992209DEST_PATH_IMAGE013.GIF" wi="45" he="26" />为状态矢量x从t<sub>k-1</sub>时刻转移到t<sub>k</sub>时刻的“状态转移矩阵”,<img file="150658DEST_PATH_IMAGE014.GIF" wi="44" he="28" />为上一时刻最优滤波值;<img file="675311DEST_PATH_IMAGE015.GIF" wi="34" he="28" />为最优预测值;z<sub>k</sub>为t<sub>k</sub>时刻的观测矢量,<img file="540499DEST_PATH_IMAGE016.GIF" wi="25" he="25" />为<img file="741673DEST_PATH_IMAGE017.GIF" wi="16" he="25" />时刻的观测矢量<img file="654264DEST_PATH_IMAGE018.GIF" wi="18" he="25" />与状态矢量<img file="231876DEST_PATH_IMAGE003.GIF" wi="20" he="25" />间的观测系数矩阵,<img file="951570DEST_PATH_IMAGE018.GIF" wi="18" he="25" />与<img file="74378DEST_PATH_IMAGE003.GIF" wi="20" he="25" />两个矢量是基于离散形式的卡尔曼滤波理论,建立的甲板沉浮运动的离散数学模型,即<img file="145102DEST_PATH_IMAGE019.GIF" wi="180" he="52" />其中<img file="260826DEST_PATH_IMAGE003.GIF" wi="20" he="25" />为<img file="412190DEST_PATH_IMAGE017.GIF" wi="16" he="25" />时刻状态矢量,<img file="892850DEST_PATH_IMAGE020.GIF" wi="28" he="25" />为上一时刻状态矢量;<img file="513187DEST_PATH_IMAGE021.GIF" wi="40" he="26" />为<img file="917755DEST_PATH_IMAGE022.GIF" wi="25" he="25" />时刻的动态噪声矢量<img file="612042DEST_PATH_IMAGE023.GIF" wi="30" he="25" />对<img file="591499DEST_PATH_IMAGE017.GIF" wi="16" he="25" />时刻状态矢量<img file="682821DEST_PATH_IMAGE003.GIF" wi="20" he="25" />影响的噪声系数矩阵,<img file="78030DEST_PATH_IMAGE023.GIF" wi="30" he="25" />为系统动态噪声,其方差阵为<img file="954719DEST_PATH_IMAGE024.GIF" wi="32" he="25" />;<img file="590231DEST_PATH_IMAGE025.GIF" wi="18" he="25" />为观测噪声,其方差阵为<img file="857264DEST_PATH_IMAGE026.GIF" wi="21" he="25" />;最优增益矩阵<img file="118481DEST_PATH_IMAGE027.GIF" wi="24" he="25" />:<img file="98944DEST_PATH_IMAGE028.GIF" wi="228" he="29" />(3)最优滤波误差协方差阵<img file="92308DEST_PATH_IMAGE029.GIF" wi="25" he="28" />:<img file="908954DEST_PATH_IMAGE030.GIF" wi="152" he="28" />(4)最优预测误差协方差阵<img file="459016DEST_PATH_IMAGE031.GIF" wi="34" he="28" />:<img file="982401DEST_PATH_IMAGE032.GIF" wi="274" he="29" />(5)式中,<img file="474562DEST_PATH_IMAGE033.GIF" wi="44" he="28" />为上一时刻最优滤波误差协方差阵;<img file="33631DEST_PATH_IMAGE034.GIF" wi="30" he="25" />为舰载机引导系统动态噪声<img file="308755DEST_PATH_IMAGE023.GIF" wi="30" he="25" />的方差阵,<img file="14543DEST_PATH_IMAGE026.GIF" wi="21" he="25" />为舰载机引导系统观测噪声<img file="349709DEST_PATH_IMAGE025.GIF" wi="18" he="25" />的方差阵;<img file="891680DEST_PATH_IMAGE035.GIF" wi="118" he="28" />分别表示<img file="32811DEST_PATH_IMAGE016.GIF" wi="25" he="25" />,<img file="842373DEST_PATH_IMAGE013.GIF" wi="45" he="26" />,<img file="614020DEST_PATH_IMAGE021.GIF" wi="40" he="26" />的转置矩阵,其中状态转移矩阵<img file="626976DEST_PATH_IMAGE013.GIF" wi="45" he="26" />,噪声系数矩阵<img file="322530DEST_PATH_IMAGE021.GIF" wi="40" he="26" />及观测系数矩阵<img file="675014DEST_PATH_IMAGE016.GIF" wi="25" he="25" />分别为:<img file="679879DEST_PATH_IMAGE036.GIF" wi="217" he="145" />(6)式中,<img file="429398DEST_PATH_IMAGE037.GIF" wi="18" he="25" />为系统采样周期,<img file="912332DEST_PATH_IMAGE038.GIF" wi="98" he="49" />为甲板运动方程的系统矩阵;<img file="384902DEST_PATH_IMAGE039.GIF" wi="16" he="20" />=0.36;<img file="311401DEST_PATH_IMAGE040.GIF" wi="14" he="16" />=0.06;<img file="298948DEST_PATH_IMAGE041.GIF" wi="100" he="25" />为甲板运动方程的干扰(或控制)矩阵;<img file="834841DEST_PATH_IMAGE042.GIF" wi="16" he="18" />=0.6,<img file="896338DEST_PATH_IMAGE043.GIF" wi="9" he="17" />为时间;<img file="243005DEST_PATH_IMAGE044.GIF" wi="16" he="21" />利用公式(1)计算最优估计值<img file="468581DEST_PATH_IMAGE005.GIF" wi="40" he="28" />变换矩阵<img file="558897DEST_PATH_IMAGE007.GIF" wi="80" he="22" />的计算式为<img file="46205DEST_PATH_IMAGE045.GIF" wi="553" he="46" />(7)式中,<img file="235878DEST_PATH_IMAGE046.GIF" wi="101" he="25" />,本发明的舰母甲板运动预估器仅对<img file="198018DEST_PATH_IMAGE004.GIF" wi="14" he="16" />时刻后的甲板沉浮运动位移信息估计值<img file="764128DEST_PATH_IMAGE047.GIF" wi="49" he="28" />,按照公式(1)展开得到:<img file="878846DEST_PATH_IMAGE048.GIF" wi="493" he="32" />(8)由于参数<img file="301737DEST_PATH_IMAGE049.GIF" wi="14" he="16" />很小,上式近似为<img file="440DEST_PATH_IMAGE050.GIF" wi="361" he="38" />(9)式中,<img file="370242DEST_PATH_IMAGE051.GIF" wi="37" he="28" />为甲板沉浮运动位移的最优滤波值;<img file="323154DEST_PATH_IMAGE052.GIF" wi="38" he="28" />为甲板沉浮运动速度的最优滤波值;(2)设置舰母甲板运动补偿网络并用于着舰引导系统与控制系统舰母甲板运动补偿网络,包括纵向甲板运动补偿网络和侧向甲板运动补偿网络,纵向甲板运动补偿网络被施加于舰上引导子系统的纵向导引律中,侧向甲板运动补偿网络被施加于舰上引导子系统的侧向导引律中;基于纵向甲板运动补偿网络的舰上引导子系统的纵向导引律在航母自动着舰引导子系统中的高速通用计算机的导引律计算子模块中引入舰母甲板运动信息,设置纵向甲板运动补偿网络;引入纵向甲板运动补偿网络的纵向导引律计算表述式:<img file="120209DEST_PATH_IMAGE053.GIF" wi="229" he="44" /><img file="542094DEST_PATH_IMAGE054.GIF" wi="277" he="42" />以此表达式在高速通用计算机的导引律计算子模块中,设置纵向引导补偿网络,式中<img file="777904DEST_PATH_IMAGE055.GIF" wi="30" he="25" />为纵向引导控制律,<img file="788585DEST_PATH_IMAGE056.GIF" wi="22" he="25" />为比例项增益、<img file="68125DEST_PATH_IMAGE057.GIF" wi="20" he="22" />为积分项增益、<img file="164257DEST_PATH_IMAGE058.GIF" wi="22" he="22" />为微分项增益、<img file="938178DEST_PATH_IMAGE059.GIF" wi="26" he="22" />为二次微分项增益,<img file="616415DEST_PATH_IMAGE060.GIF" wi="25" he="21" />为高度偏差指令信号,<img file="755273DEST_PATH_IMAGE061.GIF" wi="23" he="24" />为甲板运动信息经过甲板运动预估器再经过甲板运动补偿网络之后的输出信号,也称为甲板运动补偿指令,H<sub>com</sub>为舰载机参考飞行高度指令信号,H为舰载机实际飞行高度反馈信号,s为复变量,其中系数K<sub>P</sub>、K<sub>i</sub>、K<sub>d</sub>、K<sub>dd</sub>、K<sub>0</sub>通过舰载机飞行的实际高度反馈信号H对舰载机飞行参考高度指令信号H<sub>com</sub>的响应进行寻优获得;Hc为纵向甲板运动补偿信号,它是纵向甲板运动信号经过纵向甲板运动补偿网络后得到的信号,其中纵向甲板运动信号的表达式为<img file="401018DEST_PATH_IMAGE062.GIF" wi="144" he="26" />式中,<img file="650733DEST_PATH_IMAGE063.GIF" wi="20" he="22" />为甲板的垂直起伏运动位移信号,它是通过甲板运动预估器预估获得;<img file="947591DEST_PATH_IMAGE064.GIF" wi="18" he="22" />为甲板的俯仰运动信号,<img file="319667DEST_PATH_IMAGE065.GIF" wi="24" he="22" />为期望降落点到舰尾的距离,纵向甲板运动补偿网络的传递函数表示为<img file="203440DEST_PATH_IMAGE066.GIF" wi="349" he="52" />式中,<img file="256847DEST_PATH_IMAGE067.GIF" wi="34" he="22" />、<img file="158944DEST_PATH_IMAGE068.GIF" wi="32" he="22" />、<img file="957048DEST_PATH_IMAGE069.GIF" wi="34" he="22" />为补偿网络参数,可以通过频率响应法进行设计;基于纵向导引信号的纵向姿态控制律计算表述式为:<img file="311806DEST_PATH_IMAGE070.GIF" wi="193" he="30" />此次表达式在高速通用计算机的导引律计算子模块中,设置纵向姿态补偿网络,式中<img file="168903DEST_PATH_IMAGE071.GIF" wi="33" he="28" />为纵向姿态引导控制律,<img file="676239DEST_PATH_IMAGE072.GIF" wi="24" he="32" />为俯仰角反馈增益,<img file="390117DEST_PATH_IMAGE073.GIF" wi="22" he="32" />为俯仰角速率反馈增益,这两个参数能够通过根轨迹设计方法来寻优获得;<img file="435434DEST_PATH_IMAGE074.GIF" wi="24" he="18" />为舰载机飞行实际俯仰角增量,<img file="142227DEST_PATH_IMAGE075.GIF" wi="24" he="21" />为舰载机飞行实际俯仰角速率增量;基于侧向甲板运动补偿网络的舰上引导子系统的侧向导引律     在航母自动着舰引导子系统中的高速通用计算机的导引律计算子模块中引入舰母侧向甲板运动信息,设置侧向甲板运动补偿网络;舰上引导子系统中的侧向导引律计算表述式为:<img file="753337DEST_PATH_IMAGE076.GIF" wi="253" he="51" />=<img file="654428DEST_PATH_IMAGE077.GIF" wi="220" he="44" />式中,<img file="921462DEST_PATH_IMAGE078.GIF" wi="28" he="29" />为着舰轨迹侧向偏离误差;<img file="182679DEST_PATH_IMAGE079.GIF" wi="33" he="26" />为期望的着舰轨迹侧向偏离;<img file="897563DEST_PATH_IMAGE080.GIF" wi="21" he="26" />为实际的着舰轨迹侧向偏离;<img file="218823DEST_PATH_IMAGE081.GIF" wi="19" he="23" />为复变量;<img file="786201DEST_PATH_IMAGE082.GIF" wi="37" he="31" />为侧向引导控制律,<img file="585530DEST_PATH_IMAGE056.GIF" wi="22" he="25" />为比例项增益、<img file="108915DEST_PATH_IMAGE057.GIF" wi="20" he="22" />为积分项增益、<img file="850344DEST_PATH_IMAGE058.GIF" wi="22" he="22" />为微分项增益,通过舰载机飞行的实际侧向偏离反馈信号<img file="888707DEST_PATH_IMAGE083.GIF" wi="14" he="17" />对舰载机飞行参考侧向偏离指令信号<img file="429410DEST_PATH_IMAGE084.GIF" wi="28" he="22" />的响应进行寻优获得;<img file="885930DEST_PATH_IMAGE085.GIF" wi="33" he="25" />为侧向甲板运动补偿信号,通过下述计算过程获得:<img file="283414DEST_PATH_IMAGE086.GIF" wi="148" he="45" />式中,<img file="12335DEST_PATH_IMAGE042.GIF" wi="16" he="18" />为重力加速度,<img file="420312DEST_PATH_IMAGE087.GIF" wi="14" he="16" />为飞机离航母着舰点的水平距离;<img file="980606DEST_PATH_IMAGE088.GIF" wi="21" he="25" />为雷达测量轴跟踪舰体坐标系水平轴的偏摆角;<img file="299724DEST_PATH_IMAGE089.GIF" wi="14" he="20" />为<img file="515941DEST_PATH_IMAGE087.GIF" wi="14" he="16" />的微分;<img file="772348DEST_PATH_IMAGE090.GIF" wi="21" he="25" />为<img file="198DEST_PATH_IMAGE088.GIF" wi="21" he="25" />的微分,<img file="942746DEST_PATH_IMAGE091.GIF" wi="21" he="25" />为<img file="754582DEST_PATH_IMAGE088.GIF" wi="21" he="25" />的二次微分;基于侧向导引信号的侧向姿态控制律计算表述式为:<img file="50565DEST_PATH_IMAGE092.GIF" wi="177" he="26" /><img file="897036DEST_PATH_IMAGE093.GIF" wi="324" he="47" />式中<img file="807224DEST_PATH_IMAGE094.GIF" wi="30" he="25" />为副翼舵偏角增量;<img file="732454DEST_PATH_IMAGE095.GIF" wi="29" he="25" />为方向舵偏角增量;<img file="769812DEST_PATH_IMAGE096.GIF" wi="25" he="22" />为舰载机飞行滚转角增量;<img file="159205DEST_PATH_IMAGE097.GIF" wi="29" he="25" />为侧向引导控制律;<img file="760999DEST_PATH_IMAGE098.GIF" wi="24" he="22" />为舰载机飞行滚转角速率增量;<img file="235843DEST_PATH_IMAGE099.GIF" wi="22" he="18" />为偏航角速率增量;<img file="811312DEST_PATH_IMAGE100.GIF" wi="26" he="22" />为侧滑角增量;<img file="55211DEST_PATH_IMAGE101.GIF" wi="21" he="25" />为迎角基准值,<img file="822048DEST_PATH_IMAGE102.GIF" wi="42" he="42" />为洗出网络,<img file="721871DEST_PATH_IMAGE103.GIF" wi="14" he="14" />为预估时间,<img file="350298DEST_PATH_IMAGE104.GIF" wi="18" he="26" />、<img file="199437DEST_PATH_IMAGE105.GIF" wi="20" he="26" />、<img file="825590DEST_PATH_IMAGE106.GIF" wi="25" he="25" />、<img file="275026DEST_PATH_IMAGE107.GIF" wi="18" he="25" />、<img file="379248DEST_PATH_IMAGE108.GIF" wi="20" he="26" />为侧向姿态控制参数,可以利用根轨迹设计方法获得。
地址 210016 江苏省南京市白下区御道街29号