CN105159311B - 一种用于捷联导引头的自动驾驶仪的设计方法 - Google Patents
一种用于捷联导引头的自动驾驶仪的设计方法 Download PDFInfo
- Publication number
- CN105159311B CN105159311B CN201510582670.3A CN201510582670A CN105159311B CN 105159311 B CN105159311 B CN 105159311B CN 201510582670 A CN201510582670 A CN 201510582670A CN 105159311 B CN105159311 B CN 105159311B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtr
- mtd
- msup
- 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
Landscapes
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种用于捷联导引头的自动驾驶仪的设计方法。在控制结构上采用传统成熟的带伪姿态角的三回路过载跟踪模式,使自动驾驶仪的三个主导极点重合于实轴上,且重合位置在保证系统稳定裕度以及反向超调极小的基础上,尽量远离虚轴,以提高快速响应的能力;该设计方法在当前控制系统的基础上尽量提升自动驾驶仪的快速响应能力,且同时避免出现任何正向超调,以实现过载指令的平滑跟踪,大大地减小了自动驾驶仪对捷联导引头目标识别算法的不利影响,极大地提升了最终的命中精度;此外,该方法还具有算法简单,易于工程实现的优点。
Description
技术领域
本发明属于飞行器控制技术领域,更具体地,涉及一种用于捷联导引头的自动驾驶仪的设计方法。
背景技术
自动驾驶仪的设计形式各异,应根据不同的应用领域、不同的型号和不同的设计需求,采用相适应的设计方法。通用性较强的自动驾驶仪的设计方法为了适应较广的应用范围,需要考虑各种不同领域的通用性,然而,根据木桶长短板效应,势必将造成资源浪费,提高型号研制成本,降低市场竞争力。目前,快速响应的捷联导引头系统导弹自动驾驶仪通常采用通用的设计方法,为满足快速响应的需求,该方法对舵系统的要求较高,不但减少了有效载荷,而且增加了研制成本,不利于市场推广;具有针对性的设计方法较少,且通常较复杂,不易于工程实现。
发明内容
针对现有技术的以上缺陷或改进需求,本发明针对某些正常式布局的捷联导引头系统导弹,提供了一种用于捷联导引头的自动驾驶仪的设计方法,该方法设计思路简洁,工程实现简单,相比较传统的设计方法,响应速度明显提升。
为实现上述目的,本发明提供了一种用于捷联导引头的自动驾驶仪的设计方法,其特征在于,包括如下步骤:
(1)建立数学模型:将弹道倾角速率指令值放大倍后,进行三环反馈控制,得到实际弹道倾角速率并输出;
其中,内环前向通道传递函数为内环反馈系数为Kw;中环前向通道传递函数为中环反馈系数为Kiw;外环前向通道传递函数为外环反馈系数为1;Gdj(s)是舵系统的传递函数,是舵偏角到弹体角速率的传递函数,是弹体角速率到弹道倾角速率的传递函数,Φ1(s)是内环闭环传递函数,Φ2(s)是中环闭环传递函数,表示积分运算,Kniw为外环前向增益;
(2)根据上述数学模型的延时特性零点确定主导极点Sn的位置;
(3)计算得到上述数学模型的整个闭环回路的特征多项式为:
由该特征多项式得到f(s)=g(s),其中,f(s)为每项均包含Kw、Kiw或Kniw的多项式;将上述主导极点Sn分别带入f(s)=g(s)、f′(s)=g′(s)和f″(s)=g″(s)计算得到内环反馈系数Kw、中环反馈系数Kiw和外环前向增益Kniw的值。
优选地,舵系统的传递函数Gdj(s)、舵偏角到弹体角速率的传递函数和弹体角速率到弹道倾角速率的传递函数分别为:
和
其中,ε为阻尼比,d为舵机带宽,b1为阻尼动力系数,b2为静稳定动力系数,b3为舵效动力系数,c1为舵身升力动力系数,c3为舵面升力动力系数。
优选地,将的分子为零时的负根z作为延时特性零点,确定主导极点Sn为Sn=0.75z。
优选地,内环反馈系数Kw、中环反馈系数Kiw和外环前向增益Kniw为:
其中,A-1为A的逆矩阵,P0=g(s)|s=0.75z,P1=g′(s)|s=0.75z,P2=g″(s)|s=0.75z。
总体而言,通过本发明所构思的以上技术方案与现有技术相比,具有以下有益效果:在控制结构上采用传统成熟的带伪姿态角的三回路过载跟踪模式,使自动驾驶仪的三个主导极点重合于实轴上,且重合位置在保证系统稳定裕度以及反向超调极小的基础上,尽量远离虚轴,以提高快速响应的能力;该设计方法在当前控制系统的基础上尽量提升自动驾驶仪的快速响应能力,且同时避免出现任何正向超调,以实现过载指令的平滑跟踪,大大地减小了自动驾驶仪对捷联导引头目标识别算法的不利影响,极大地提升了最终的命中精度;此外,该方法还具有算法简单,易于工程实现的优点。
附图说明
图1是本发明设计的自动驾驶仪的控制原理图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明实施例的用于捷联导引头的自动驾驶仪的设计方法包括如下步骤:
(1)建立数学模型:将弹道倾角速率指令值放大倍后,进行带伪姿态角的三环过载跟踪模式的反馈控制,得到实际弹道倾角速率并输出。
如图1所示,内环前向通道传递函数为内环反馈系数为Kw;中环前向通道传递函数为中环反馈系数为Kiw;外环前向通道传递函数为外环反馈系数为1。
其中,Gdj(s)是舵系统的传递函数,是舵偏角到弹体角速率的传递函数,是弹体角速率到弹道倾角速率的传递函数,Φ1(s)是内环闭环传递函数,Φ2(s)是中环闭环传递函数,表示积分运算,Kniw为外环前向增益。
具体地,Gdj(s)、和分别为:
其中,ε为阻尼比,d为舵机带宽,b1为阻尼动力系数,b2为静稳定动力系数,b3为舵效动力系数,c1为舵身升力动力系数,c3为舵面升力动力系数。
内环反馈系数为Kw、中环反馈系数为Kiw和外环前向增益Kniw三个控制参数为待设计值。
(2)设定主导极点:根据过载回路的延时特性零点确定主导极点的位置。
延时特性零点就是的分子为零时的根,即计算关于自变量s的多项式c3s2+c3b1s+c3b2-b3c1=0时的根。正常式布局的导弹均是一正一负两个根,这里取其负根z(z<0)。为了削弱此延时特性零点带来的反向超调的影响,同时保证自动驾驶仪具有相当的快速性,将主导极点Sn设定为Sn=0.75z。
该步骤在保证自动驾驶仪快速性的同时,还有效减小了过载回路的反向超调。
(3)计算控制参数:通过整理约束条件解线性方程组,从而得到三个控制参数。
通过控制理论反馈回路计算方法,得到上述数学模型的整个闭环回路的特征多项式:
进而得到:
当设计完控制参数Kw、Kiw和Kniw后,此多项式解算得到的五个根就是整个闭环回路的极点。其中的三个根重合在相平面实轴上,即是本发明的三个主导极点。
由上述特征多项式得到:
上式中,除了控制参数待定以外,其他系数均是已知量。令:
将主导极点Sn=0.75z代入g(s),将结果记为:
P0=g(s)|s=0.75z
对g(s)求关于自变量s的导数g′(s),然后将主导极点Sn=0.75z代入g′(s),将结果记为:
P1=g′(s)|s=0.75z
对g(s)求关于自变量s的二阶导数g″(s),然后将主导极点Sn=0.75z代入g″(s),将结果记为:
P2=g″(s)|s=0.75z
将主导极点Sn=0.75z分别代入等式f(s)=g(s)、f′(s)=g′(s)和f″(s)=g″(s),最终得到线性方程组:
其中,矩阵:
于是得到控制参数:
其中,A-1为A的逆矩阵。
至此,一种用于捷联导引头的快速响应自动驾驶仪设计过程已全部完成。
假设导弹动力学系数为:b1=0.1、b2=100、b3=100、c1=0.5、c3=0.1,舵系统带宽d=90。根据上述步骤可计算得到主导极点Sn=-15.0375,内环反馈系数Kw=0.308,中环反馈系数Kiw=2.506,外环前向增益Kniw=38.647。外环所有的闭环极点为:
S1=-40.7437+47.5511i;
S2=-40.7437-47.5511i;
S3=-15.0375;
S4=-15.0375;
S5=-15.0375。
从上面事例可以看到,其中五个闭环极点中,最小的三个极点是完全一样的,均是主导极点Sn=-15.0375,表明了此方法的正确性和可操作性。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (3)
1.一种用于捷联导引头的自动驾驶仪的设计方法,其特征在于,包括如下步骤:
(1)建立数学模型:将弹道倾角速率指令值放大倍后,进行三环反馈控制,得到实际弹道倾角速率并输出;
其中,内环前向通道传递函数为内环反馈系数为Kw;中环前向通道传递函数为中环反馈系数为Kiw;外环前向通道传递函数为外环反馈系数为1;Gdj(s)是舵系统的传递函数,是舵偏角到弹体角速率的传递函数,是弹体角速率到弹道倾角速率的传递函数,Φ1(s)是内环闭环传递函数,Φ2(s)是中环闭环传递函数,表示积分运算,Kniw为外环前向增益;
(2)根据上述数学模型的延时特性零点确定主导极点Sn的位置;
(3)计算得到上述数学模型的整个闭环回路的特征多项式为:
<mrow>
<mfrac>
<mi>s</mi>
<mrow>
<msubsup>
<mi>G</mi>
<mi>&omega;</mi>
<mi>&delta;</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>*</mo>
<msub>
<mi>G</mi>
<mrow>
<mi>d</mi>
<mi>j</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mi>K</mi>
<mi>w</mi>
<mo>*</mo>
<mi>s</mi>
<mo>+</mo>
<mi>K</mi>
<mi>i</mi>
<mi>w</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>K</mi>
<mi>n</mi>
<mi>i</mi>
<mi>w</mi>
<mo>*</mo>
<msubsup>
<mi>G</mi>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>&omega;</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>S</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mn>0</mn>
<mo>,</mo>
</mrow>
由该特征多项式得到f(s)=g(s),其中,f(s)为每项均包含Kw、Kiw或Kniw的多项式;将上述主导极点Sn分别带入f(s)=g(s)、f′(s)=g′(s)和f″(s)=g″(s)计算得到内环反馈系数Kw、中环反馈系数Kiw和外环前向增益Kniw的值;
舵系统的传递函数Gdj(s)、舵偏角到弹体角速率的传递函数和弹体角速率到弹道倾角速率的传递函数分别为:
<mrow>
<msub>
<mi>G</mi>
<mrow>
<mi>d</mi>
<mi>j</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mfrac>
<msup>
<mi>s</mi>
<mn>2</mn>
</msup>
<msup>
<mi>d</mi>
<mn>2</mn>
</msup>
</mfrac>
<mo>+</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>&epsiv;</mi>
<mi>s</mi>
</mrow>
<mi>d</mi>
</mfrac>
<mo>+</mo>
<mn>1</mn>
</mrow>
</mfrac>
<mo>,</mo>
</mrow>
和
<mrow>
<msubsup>
<mi>G</mi>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>&omega;</mi>
</msubsup>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>c</mi>
<mn>3</mn>
</msub>
<msup>
<mi>s</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<msub>
<mi>c</mi>
<mn>3</mn>
</msub>
<msub>
<mi>b</mi>
<mn>1</mn>
</msub>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>c</mi>
<mn>3</mn>
</msub>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>b</mi>
<mn>3</mn>
</msub>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
</mrow>
<mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>b</mi>
<mn>3</mn>
</msub>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>b</mi>
<mn>3</mn>
</msub>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>b</mi>
<mn>2</mn>
</msub>
<msub>
<mi>c</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>,</mo>
</mrow>
其中,ε为阻尼比,d为舵机带宽,b1为阻尼动力系数,b2为静稳定动力系数,b3为舵效动力系数,c1为舵身升力动力系数,c3为舵面升力动力系数。
2.如权利要求1所述的用于捷联导引头的自动驾驶仪的设计方法,其特征在于,将的分子为零时的负根z作为延时特性零点,确定主导极点Sn为Sn=0.75z。
3.如权利要求2所述的用于捷联导引头的自动驾驶仪的设计方法,其特征在于,内环反馈系数Kw、中环反馈系数Kiw和外环前向增益Kniw为:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>K</mi>
<mi>n</mi>
<mi>i</mi>
<mi>w</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>K</mi>
<mi>i</mi>
<mi>w</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>K</mi>
<mi>w</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msup>
<mi>A</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>P</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<mo>*</mo>
<mrow>
<mo>(</mo>
<mn>0.75</mn>
<mi>z</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>P</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<mo>/</mo>
<mn>2</mn>
<mo>*</mo>
<msup>
<mrow>
<mo>(</mo>
<mn>0.75</mn>
<mi>z</mi>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>-</mo>
<mo>&lsqb;</mo>
<msub>
<mi>P</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<mo>*</mo>
<mrow>
<mo>(</mo>
<mn>0.75</mn>
<mi>z</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>*</mo>
<mrow>
<mo>(</mo>
<mn>0.75</mn>
<mi>z</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
其中,A-1为A的逆矩阵,P0=g(s)|s=0.75z,P1=g′(s)|s=0.75z,P2=g″(s)|s=0.75z。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510582670.3A CN105159311B (zh) | 2015-09-14 | 2015-09-14 | 一种用于捷联导引头的自动驾驶仪的设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510582670.3A CN105159311B (zh) | 2015-09-14 | 2015-09-14 | 一种用于捷联导引头的自动驾驶仪的设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105159311A CN105159311A (zh) | 2015-12-16 |
CN105159311B true CN105159311B (zh) | 2018-01-05 |
Family
ID=54800196
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510582670.3A Active CN105159311B (zh) | 2015-09-14 | 2015-09-14 | 一种用于捷联导引头的自动驾驶仪的设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105159311B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106383523B (zh) * | 2016-09-30 | 2019-03-08 | 湖北航天技术研究院总体设计所 | 一种飞行器非线性姿态控制系统稳定性分析方法 |
CN109407690A (zh) * | 2018-12-27 | 2019-03-01 | 湖北航天飞行器研究所 | 一种飞行器稳定控制方法 |
CN110716541B (zh) * | 2019-10-08 | 2023-03-10 | 西北工业大学 | 一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法 |
CN110716426B (zh) * | 2019-10-08 | 2022-11-25 | 西北工业大学 | 一种基于虚拟光轴的捷联导引头系统综合新方法 |
CN111399385A (zh) * | 2020-04-28 | 2020-07-10 | 福州大学 | 一种建立无人车自动转向模型的方法和系统 |
CN112099532B (zh) * | 2020-07-08 | 2022-05-20 | 北京理工大学 | 一种图像制导飞行器延时补偿方法及系统 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103076806A (zh) * | 2011-10-26 | 2013-05-01 | 北京航天长征飞行器研究所 | 三回路自动驾驶仪控制参数一体化解析整定方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3028888B2 (ja) * | 1992-11-17 | 2000-04-04 | 三菱電機株式会社 | オートパイロット装置 |
KR20130111044A (ko) * | 2012-03-30 | 2013-10-10 | 세종대학교산학협력단 | 쿨롱마찰을 보상하는 무인항공기용 영상 안정화 시스템 및 쿨롱마찰 보상방법 |
-
2015
- 2015-09-14 CN CN201510582670.3A patent/CN105159311B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103076806A (zh) * | 2011-10-26 | 2013-05-01 | 北京航天长征飞行器研究所 | 三回路自动驾驶仪控制参数一体化解析整定方法 |
Non-Patent Citations (2)
Title |
---|
增益调度自动驾驶仪结构特点与变轨迹飞行控制;张跃等;《光学精密工程》;20120731;第20卷(第7期);全文 * |
大攻角导弹法向过载控制的变结构设计;梁雪超等;《计算机与现代化》;20141231(第1期);期刊第47-49页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105159311A (zh) | 2015-12-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105159311B (zh) | 一种用于捷联导引头的自动驾驶仪的设计方法 | |
CN111306989B (zh) | 一种基于平稳滑翔弹道解析解的高超声速再入制导方法 | |
Chen et al. | Optimal control based guidance law to control both impact time and impact angle | |
CN104252133A (zh) | 一种无人机纵向控制律平滑切换方法 | |
CN108803648A (zh) | 无人飞行器鲁棒姿态控制方法、装置及电子设备 | |
CN109508027A (zh) | 基于鲁棒控制理论的“角速率加融合爬升角补偿”的火箭助推发射的控制方法 | |
CN107422733A (zh) | 一种基于两轮差速机器人的运动控制方法 | |
CN110138293A (zh) | 一种基于双馈风电系统的bp神经网络优化混沌控制方法 | |
CN105563483A (zh) | 一种用于蛇形仿生机器人转弯运动的组合控制方法 | |
Liu et al. | Field-of-view and impact angle constrained guidance law for missiles with time-varying velocities | |
CN113359819B (zh) | 一种带有碰撞角约束和加速度限制的最优制导律 | |
Dhabale et al. | Impact angle constraint guidance law using cubic splines for intercepting stationary targets | |
He et al. | Sliding mode-based continuous guidance law with terminal angle constraint | |
Gutman | Superiority of canards in homing missiles | |
CN106527120A (zh) | 具有指定精度的pid控制系统稳定裕度配置方法 | |
CN106292700B (zh) | 一种大落地倾角条件下应用的侧向导引方法 | |
Xing et al. | Segmented optimal guidance with constraints on terminal angle of attack and impact angle | |
CN111679687B (zh) | 一种带有落角约束的导引控制一体化方法 | |
CN108170055A (zh) | 一种导引头位标器控制系统 | |
Yang et al. | Autopilot design of bank-to-turn missiles using state-space disturbance observers | |
Xi et al. | Field-of-View Limited Guidance with Constrained Impact via Line-of-Sight Shaping Approach | |
CN107479373A (zh) | 利用角速度反馈的模糊控制算法控制机器鱼c形转弯的方法 | |
CN107390718A (zh) | 一种高速飞行强适应性180度翻转控制方法 | |
Gutman | Nose jet guidance and control for exoatmospheric kill-vehicle | |
CN117250854B (zh) | 控制参数设计引入积分系数的飞行姿态控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |