CN110716541A - 一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法 - Google Patents

一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法 Download PDF

Info

Publication number
CN110716541A
CN110716541A CN201910950491.9A CN201910950491A CN110716541A CN 110716541 A CN110716541 A CN 110716541A CN 201910950491 A CN201910950491 A CN 201910950491A CN 110716541 A CN110716541 A CN 110716541A
Authority
CN
China
Prior art keywords
angle
sight
lambda
value
theta
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.)
Granted
Application number
CN201910950491.9A
Other languages
English (en)
Other versions
CN110716541B (zh
Inventor
杨军
朱学平
袁博
朱苏朋
李玥
杨婷
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hefei Weidao Electronic Technology Co Ltd
Northwest University of Technology
Original Assignee
Hefei Weidao Electronic Technology Co Ltd
Northwest University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hefei Weidao Electronic Technology Co Ltd, Northwest University of Technology filed Critical Hefei Weidao Electronic Technology Co Ltd
Priority to CN201910950491.9A priority Critical patent/CN110716541B/zh
Publication of CN110716541A publication Critical patent/CN110716541A/zh
Application granted granted Critical
Publication of CN110716541B publication Critical patent/CN110716541B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • 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/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • 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/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • 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/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)

Abstract

本发明涉及一种于虚拟光轴的捷联导引头自抗扰非线性控制方法，通过引入虚拟光轴的新概念，实现了惯性空间目标视线角速度的重构，此外，釆用非线性PID控制有效减小了噪声对跟踪回路性能的影响。

Description

一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法
技术领域
本发明属于航空航天技术领域，涉及一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法。
背景技术
相比于传统动力陀螺式和框架式导引头，捷联式导引头的探测器直接刚性地与弹体固联，取消了活动机构，结构简单，可以有效地对整弹进行小型化设计，并降低制造成本，提高可靠性。然而，捷联式导引头不能直接输出视线角速率，需要探测器和惯性器件合成得到视线角速率。对于捷联导引头来说，在制导律设计时需要先完成视线角速率的估计，进而使用适用于捷联制导体制的制导律。
对于捷联式导引头，理论上可以通过下面两种方法来获得惯性视线角速率：
(1)将弹体姿态信息反馈到导引头输出端的去耦方法，即将弹体姿态角或角速率信息同导引头的输出信息相结合，具体可以通过弹体姿态角和捷联导引头输出视线角相加后微分，或者将捷联导引头输出视线角微分后与弹体角速率信号相加来得到惯性视线角速率；
(2)将弹体姿态信息反馈到导引头角跟踪回路的去耦方法，即将弹体姿态角或其角速率信息反馈到导引头的角跟踪系统来稳定导引头视轴，从而实现弹体姿态扰动的去耦，得到相对于惯性空间的视线角速率。
然而，将弹体姿态信息反馈到导引头输出端的去耦方法对于某些寻的导弹的典型参数而言，制导回路是不稳定的，若要使制导回路稳定，必须将导引头角跟踪系统的带宽增加到足够大，这样便意味着导引头的跟踪带宽会远大于跟踪预计的机动目标需要的带宽，从而会使系统对噪声更敏感而降低信噪比；将弹体姿态信息反馈到导引头角跟踪回路的去耦方法对于寻的导弹的典型参数而言，制导回路是稳定的，但其中仍然采用了微分网络，采用微分网络使得放大系统噪声对跟踪回路性能产生影响。
发明内容
本发明解决的技术问题是：为了减小噪声对导引头跟踪回路性能的影响，实现惯性空间中目标视线角速度的重构，本发明设计一种基于虚拟光轴的捷联导引头系统综合新方法。
本发明的技术方案是：一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法，包括以下步骤：
步骤一：，捷联导引头视线角q除去弹体姿态角θ后，两者相减得到λ，计算公式为λ＝q-θ，通过滤波估计与差补计算模块JS1，得到失调角测量值λm；
λm＝JS1·(q-θ)＝q-θ
同时，弹上惯导系统实时测量弹体姿态角通过一阶保持器后得到测量值θm；
θm＝JS2·θ＝θ
实际惯性空间视线角q减去弹体弹体姿态角θ后，通过滤波估计与差补计算模块JS1，得到失调角测量值λm(即捷联导引头测量出的弹体视线角)，这里描述的是捷联导引头测量弹体视线角的原理，在测量过程中是不用知道实际惯性空间视线角q和弹体弹体姿态角θ的具体数值的；
步骤二：对系统输出
Figure BDA0002225636190000021
进行积分，经过采样和一阶保持器后，得到qt；
Figure BDA0002225636190000022
Figure BDA0002225636190000023
初始值是未知的，系统输出需要经过一系列计算才能得到；
qt的初始值设为0，在制导过程中，利用误差信号e1、e2、e0不断修正误差，使得能无差跟踪实际惯性空间视线角速率
Figure BDA0002225636190000024
步骤三：qt减去步骤一得到的弹体姿态角测量值θm，通过匹配滤波计算模块JS4得到虚拟失调角λt；
λt＝JS4·(qt-θm)＝qt-θm
步骤四：虚拟失调角λt通过跟踪微分器得到其跟踪值z1及其微分信号z2；失调角λm通过另一个跟踪微分器得到其跟踪值v1及其微分信号v2，取误差信号e1、e2、e0；
v1＝λm,
Figure BDA0002225636190000025
z1＝λt,
Figure BDA0002225636190000031
e1＝JS5·(v1-z1)＝v1-z1，e2＝v2-z2，
Figure BDA0002225636190000032
步骤五：通过步骤四得到的误差信号的非线性组合得到控制信号
u＝f(e0，e1，e2)
从而得到惯性空间目标视线角速重构值
Figure BDA0002225636190000033
即跟踪回路控制指令即为惯性空间目标视线角速度的测量值。
发明效果
本发明的技术效果在于：本发明通过引入虚拟光轴的新概念，实现了惯性空间目标视线角速度的重构，此外，釆用非线性PID控制有效减小了噪声对跟踪回路性能的影响。
附图说明
图1导引头系统结构图
图2导引头系统简化结构图
图3基本流程图
具体实施方式
参见图1—图3，该发明以捷联图像导引头信息和惯导信息为基础，采用类似于常平架式图像导引头的工作原理，在惯性空间中定义一个虚拟光轴，通过稳定回路和跟踪回路的作用，使其跟踪目标视线方向，而跟踪回路控制指令即为惯性空间目标视线角速度的测量值。很显然，跟踪回路控制算法的优劣，直接影响制导信息提取的质量。
由于捷联导引头图像跟踪器捷联在弹体上，导弹飞行过程中弹体剧烈摆动的影响需要电子稳像算法处理。通常情况下在捷联导引头测量信息中包含有比活动跟踪导引头更大的检波噪声和CCD量化噪声，直接采用PID控制面临着噪声放大的风险。本发明在这里提出了釆用非线性PID控制用于跟踪回路控制器的设计方法。
图1中，JS1:弹体坐标系目标视线角测量，滤波估计和差补计算模块；(惯性测角元件)
JS2:弹体姿态角测量，滤波估计计算模块；(惯性测角元件)
JS3:虚拟光轴惯性空间指向角计算模块；
JS4:虚拟光轴弹体系指向角重构及匹配滤波计算模块；(惯性测角元件)
JS5:虚拟失调角计算模块；(惯性测角元件)
q：视线角
Figure BDA0002225636190000041
虚拟光轴惯性空间目标视线角速度重构值；
qt：虚拟光轴惯性空间目标视线角重构值；
θ：弹体姿态角
θm：弹体姿态角测量值
λ：失调角；
λm：失调角测量值；
λt：虚拟失调角；
Δq：误差角。
v1，v2：测量的弹体系指向角及其微分信号；
z1，z2：虚拟光轴弹体系指向角重构值及其微分信号；
e1＝v1-z1，e2＝v2-z2，
Figure BDA0002225636190000042
为误差信号；
JS1＝1；JS2＝1；JS3＝1/s；JS4＝1；JS5＝1为各个计算模块的近似传递函数。
图2中，JS6表示非线性PID控制器。
本发明提出的一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法，图3为这种方法的基本流程图，包括以下步骤：
步骤一：，捷联导引头视线角q除去弹体姿态角θ后，通过滤波估计与差补计算模块JS1，得到失调角测量值λm；
λm＝JS1·(q-θ)＝q-θ
同时，弹上惯导系统实时测量弹体姿态角通过一阶保持器后得到测量值θm；
θm＝JS2·θ＝θ
实际惯性空间视线角q减去弹体弹体姿态角θ后，通过滤波估计与差补计算模块JS1，得到失调角测量值λm(即捷联导引头测量出的弹体视线角)，这里描述的是捷联导引头测量弹体视线角的原理，在测量过程中是不用知道实际惯性空间视线角q和弹体弹体姿态角θ的具体数值的；
步骤二：对系统输出
Figure BDA0002225636190000051
进行积分，经过采样和一阶保持器后，得到qt；
Figure BDA0002225636190000052
Figure BDA0002225636190000053
初始值是未知的，系统输出需要经过一系列计算才能得到；
qt的初始值设为0，在制导过程中，利用误差信号e1、e2、e0不断修正误差，使得
Figure BDA00022256361900000510
能无差跟踪实际惯性空间视线角速率
Figure BDA0002225636190000054
步骤三：qt减去步骤一得到的弹体姿态角测量值θm，通过匹配滤波计算模块JS4得到虚拟失调角λt；
λt＝JS4·(qt-θm)＝qt-θm
步骤四：虚拟失调角λt通过跟踪微分器得到其跟踪值z1及其微分信号z2；失调角λm通过另一个跟踪微分器得到其跟踪值v1及其微分信号v2，取误差信号e1、e2、e0；
v1＝λm，
Figure BDA0002225636190000055
z1＝λt，
Figure BDA0002225636190000056
e1＝JS5·(v1-z1)＝v1-z1，e2＝v2-z2，
Figure BDA0002225636190000057
步骤五：通过步骤四得到的误差信号的非线性组合得到控制信号
u＝f(e0，e1，e2)
从而得到惯性空间目标视线角速重构值
Figure BDA0002225636190000058
即跟踪回路控制指令即为惯性空间目标视线角速度的测量值。
以下为非线性控制器的算法说明，用于步骤五中计算惯性空间目标视线角速重构值
Figure BDA0002225636190000064
。
设非线性PID控制器的描述函数为N(A)，由图2可以得到
Figure BDA0002225636190000061
故当N(A)中误差e1的系数较大时，惯性空间目标视线角速重构值
Figure BDA0002225636190000064
能够很快地跟踪目标视线惯性空间角速度
Figure BDA0002225636190000065
的动态特性。
控制器的整个算法可以整理成
Figure BDA0002225636190000062
其中，c，r2，h2是可调节参数，fhan(x1，x2，r，h)表示
其中，h是采样步长，k是当前时刻。

Claims (1)

1.一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法，其特征在于，包括以下步骤：
步骤一：，捷联导引头视线角q除去弹体姿态角θ后，两者相减得到λ，计算公式为λ＝q-θ，通过滤波估计与差补计算模块JS1，得到失调角测量值λm；
λm＝JS1·(q-θ)＝q-θ
同时，弹上惯导系统实时测量弹体姿态角通过一阶保持器后得到测量值θm；
θm＝JS2·θ＝θ
实际惯性空间视线角q减去弹体弹体姿态角θ后，通过滤波估计与差补计算模块JS1，得到失调角测量值λm(即捷联导引头测量出的弹体视线角)，这里描述的是捷联导引头测量弹体视线角的原理，在测量过程中是不用知道实际惯性空间视线角q和弹体弹体姿态角θ的具体数值的；
步骤二：对系统输出进行积分，经过采样和一阶保持器后，得到qt；
Figure FDA0002225636180000013
初始值是未知的，系统输出需要经过一系列计算才能得到；
qt的初始值设为0，在制导过程中，利用误差信号e1、e2、e0不断修正误差，使得
Figure FDA0002225636180000014
能无差跟踪实际惯性空间视线角速率
Figure FDA0002225636180000015
步骤三：qt减去步骤一得到的弹体姿态角测量值θm，通过匹配滤波计算模块JS4得到虚拟失调角λt；
λt＝JS4·(qt-θm)＝qt-θm
步骤四：虚拟失调角λt通过跟踪微分器得到其跟踪值z1及其微分信号z2；失调角λm通过另一个跟踪微分器得到其跟踪值v1及其微分信号v2，取误差信号e1、e2、e0；
v1＝λm,
Figure FDA0002225636180000016
z1＝λt,
Figure FDA0002225636180000021
e1＝JS5·(v1-z1)＝v1-z1，e2＝v2-z2,
Figure FDA0002225636180000022
步骤五：通过步骤四得到的误差信号的非线性组合得到控制信号
u=f(e0，e1，e2)从而得到惯性空间目标视线角速重构值即跟踪回路控制指令即为惯性空间目标视线角速度的测量值。
CN201910950491.9A 2019-10-08 2019-10-08 一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法 Active CN110716541B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910950491.9A CN110716541B (zh) 2019-10-08 2019-10-08 一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910950491.9A CN110716541B (zh) 2019-10-08 2019-10-08 一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法

Publications (2)

Publication Number Publication Date
CN110716541A true CN110716541A (zh) 2020-01-21
CN110716541B CN110716541B (zh) 2023-03-10

Family

ID=69212275

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910950491.9A Active CN110716541B (zh) 2019-10-08 2019-10-08 一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法

Country Status (1)

Country Link
CN (1) CN110716541B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114397902A (zh) * 2021-12-01 2022-04-26 北京理工大学 微小型捷联导引头信息处理与控制系统一体化设计方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105159311A (zh) * 2015-09-14 2015-12-16 湖北航天技术研究院总体设计所 一种用于捷联导引头的自动驾驶仪的设计方法
CN106681348A (zh) * 2017-01-13 2017-05-17 西北工业大学 考虑全捷联导引头视场约束的制导控制一体化设计方法
CN107255924A (zh) * 2017-06-14 2017-10-17 哈尔滨工业大学 基于扩维模型的容积卡尔曼滤波提取捷联导引头制导信息的方法
US20180112985A1 (en) * 2016-10-26 2018-04-26 The Charles Stark Draper Laboratory, Inc. Vision-Inertial Navigation with Variable Contrast Tracking Residual
CN109254594A (zh) * 2018-09-21 2019-01-22 北京大翔航空科技有限公司 一种用于无人机的全捷联末制导方法
CN109976380A (zh) * 2019-03-29 2019-07-05 北京理工大学 基于卡尔曼滤波估计的隔离度辨识校正方法及系统

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105159311A (zh) * 2015-09-14 2015-12-16 湖北航天技术研究院总体设计所 一种用于捷联导引头的自动驾驶仪的设计方法
US20180112985A1 (en) * 2016-10-26 2018-04-26 The Charles Stark Draper Laboratory, Inc. Vision-Inertial Navigation with Variable Contrast Tracking Residual
CN106681348A (zh) * 2017-01-13 2017-05-17 西北工业大学 考虑全捷联导引头视场约束的制导控制一体化设计方法
CN107255924A (zh) * 2017-06-14 2017-10-17 哈尔滨工业大学 基于扩维模型的容积卡尔曼滤波提取捷联导引头制导信息的方法
CN109254594A (zh) * 2018-09-21 2019-01-22 北京大翔航空科技有限公司 一种用于无人机的全捷联末制导方法
CN109976380A (zh) * 2019-03-29 2019-07-05 北京理工大学 基于卡尔曼滤波估计的隔离度辨识校正方法及系统

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
朱学平等: "基于机动目标跟踪的相控阵雷达导引头", 《西北工业大学学报》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114397902A (zh) * 2021-12-01 2022-04-26 北京理工大学 微小型捷联导引头信息处理与控制系统一体化设计方法
CN114397902B (zh) * 2021-12-01 2024-04-16 北京理工大学 微小型捷联导引头信息处理与控制系统一体化设计方法

Also Published As

Publication number Publication date
CN110716541B (zh) 2023-03-10

Similar Documents

Publication Publication Date Title
ES2835199T3 (es) Procedimiento de seguimiento de un blanco aéreo y radar que implementa tal procedimiento
CN107255924B (zh) 基于扩维模型的容积卡尔曼滤波提取捷联导引头制导信息的方法
CN106647257B (zh) 一种基于正交最小二乘的前馈控制方法
CN108761512A (zh) 一种弹载bds/sins深组合自适应ckf滤波方法
EP2865175B1 (en) Non-causal attitude estimation for real-time motion compensation of sensed images on a moving platform
CN105021092A (zh) 一种捷联寻的导引头的制导信息提取方法
CN112945236B (zh) 一种滚仰式导引头视线角及角速度快速获取方法
CN110824453A (zh) 一种基于图像跟踪与激光测距的无人机目标运动估计方法
CN110716541B (zh) 一种基于虚拟光轴的捷联导引头自抗扰非线性控制方法
CN110672103B (zh) 一种多传感器目标跟踪滤波方法及系统
CN110727195B (zh) 一种基于虚拟光轴的捷联导引头自抗扰双速率控制方法
CN101403593B (zh) 基于横滚/偏摆结构的两轴捷联平台光轴超半球稳定方法
CN110658839B (zh) 一种基于虚拟光轴的捷联导引头制导信息提取方法
DE60019251T2 (de) Hochgenauer weitreichender optisch gestützter inertial gelenkter flugkörper
CN110716426B (zh) 一种基于虚拟光轴的捷联导引头系统综合新方法
US11037018B2 (en) Navigation augmentation system and method
CN116860011A (zh) 一种实现光电搜索跟踪系统高精度记忆跟踪的方法
Bai et al. The study of guidance performance of a phased array seeker with platform
Yingchao et al. Line-of-sight rate estimation based on attitude dynamics for strap-down seeker
Babu et al. Two variable-structure homing guidance schemes with and without target maneuver estimation
Hutchins et al. Filtering and control of an autonomous underwater vehicle for both target intercept and docking
TWI422825B (zh) 高精度速度估測方法及其裝置
Xu et al. A Novel LOS Rate Estimation Method Based on Images for Strap-down Inertial Guidance
RU2172919C1 (ru) Система теленаведения
CN116203988A (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
GR01 Patent grant
GR01 Patent grant