完全考虑弹体动态特性的最佳导引规律课件

现代控制理论在战术导弹上的应用§1自动导引(寻的制导)导弹的最佳导引规律§2卡尔曼滤波器在寻的制导系统中的应用现代控制理论在战术导弹上的应用§1自动导引(寻的制导)导弹1§1自动导引(寻的制导)导弹的最佳导引规律§1.1建立导弹和目标运动的数学模型§1.2导弹运动状态方程的建立§1.3线性二次型问题的解法§1.4不考虑弹体惯性的最佳导引规律§1.5完全考虑弹体动态特性的最佳导引规律§1自动导引(寻的制导)导弹的最佳导引规律§1.12

在这一节应用最佳控制理论来研究自动导引的空-空或地-空导弹的最佳导引规律问题，首先建立导弹和目标运动的数学模型在现有的自动导引（寻的制导）的空-空或地-空导弹中，大都采用比例导引法。

§1.1建立导弹和目标运动的数学模型美“麻雀”远距空空导弹

地|空导弹在这一节应用最佳控制理论来研究自动导引的空-空或地3

比例导引法：

导弹和目标在同一平面内运动，如图11-1。D为导弹，M为目标，为导弹运动速度，为目标运动速度，R为导弹至目标的距离，DH为一基准方向。DT为目求视线，q为DM与DH之间的夹角，称为目标视线角。完全考虑弹体动态特性的最佳导引规律课件4

按比例导引法导引时，在弹上装有红外线或无线电导引头，用来测量目标视线角q的角速度。无线电导引头红外线导引头按比例导引法导引时，在弹上装有红外线或无线5导引头的输出信号与成比例，将此信号输给导弹自动驾驶仪，经过放大变换后，控制舵面偏转，导弹产生横向控制力，改变导弹速度向量的方向。导弹自动驾驶仪自动驾驶仪导引头的输出信号与成比例，将此信号输给导6比例导引：就是使导弹的速度向量的旋转角速度正比于目标视线DM的旋转角速度，即N为比例系数，称为导航比。对一般的导弹来说N=3~6。比例导引的实质是使导弹向这减少的方向运动，抑制视线DM旋转，也就是导弹的相对速度对准目标，保证导弹向着前置碰撞点飞行。比例导引的优点：1.实现起来方便2.弹道比较平直，导弹的过载比较小比例导引：就是使导弹的速度向量的旋转角速度正7§1.2导弹运动状态方程的建立

导弹与目标的运动关系是非线性的，应把导弹与目标的运动方程相对于理想弹道线性化，得出导弹运动的状态方程。设导弹和目标在同一平面内运动，如图11-2。

§1.2导弹运动状态方程的建立导弹与目标8

在平面内任选oxy固定坐标，导弹的速度向量与oy轴成角，目标速度向量与oy轴成，导弹与目标的连线DM与oy轴成q角，设，，q都比较小。并且假定导弹和目标都是等速飞行，即都是不变值。用相对坐标变量比较方便。

9

设x为导弹与目标在ox轴方向上的距离偏差，y为导弹与目标在oy轴方向上的距离偏差，即：（11-2）（11-3）（11-4）（11-5）由于设和很小，因此，则（11-6）（11-7）设x为导弹与目标在ox轴方向上的距离偏差，y为导弹与目10

以表示x，则

式中表示目标的横向加速度，表示导弹的横向加速度，分别以表示，则

导弹的横向加速度为一控制量。控制信号加给舵机，舵面偏转后弹体产生攻角，而后产生横向过载。以表示x，则式中表示目标11

如果忽略舵机及弹体的惯性，设控制量的单位与加速度的单位相同，则可用控制量ｕ来表示－即令与是式(11-10)变成可得导弹运动的状态方程如果忽略舵机及弹体的惯性，设控制量的单位与加速度的单位相同12写成矩阵形式，可得式中给出时刻，的初值可把导弹的运动状态方程用图来表示，如图11-3。

导弹运动学方框图写成矩阵形式，可得式中给出时刻，13如果不考虑目标机动，则为零，式（11-4）变少考虑式（11-7），该式可写成

为导弹对目标的接近速度，设为导弹与目标的遭遇时刻，则在某一瞬间t导弹与目标的距离y可用下式表示如果不考虑目标机动，则为零，式（11-4）变少考虑式（14对导弹控制来说，最根本的要求是脱靶量越小越好，因此应选择最佳的控制u，使得下列指标函数为最小。然而，当要求一个反馈形式的控制时，按上式列出的问题往往很难解。所以我们以时的值作为脱靶量，要求时刻x值越小越好。另外舵偏角受到限制，导弹结构能承受的最大过载也受到限制，所以控制信号u应该受到限制，因此，选择下列形式的二次型指标函数对导弹控制来说，最根本的要求是脱靶量越小越好，因15即应有最佳控制理论，可求出使J为最小的U式中即应有最佳控制理论，可求出使J为最小的U式中16不考虑舵机惯性，但考虑导弹二次振荡环节时，导弹运动转台方程的列写问题，如以舵偏角作为导弹的输入，作弹体的输出，则弹体的传递函数为式中不考虑舵机惯性，但考虑导弹二次振荡环节时，导弹运17如把式（11-10）中前的负号移至控制信号u中，假定舵偏角等于控制信号u，则考虑了弹体环节之后的导弹运动方框图可用图11-4来表示如把式（11-10）中前的负号移至控18其方程为式中，如写成矩阵形式其方程为式中，如写成矩阵形式19则给出时刻，的初值，的初值可取零值。如不考虑目标机动，则指标函数与前面一样，即则给出时刻，的初值20式中下面将要讨论不考虑弹体惯性和考虑弹体惯性的最佳导引规律。由于系统是线性的，指数函数是二次型的，因此球最佳控制规律是一个求解线性二次型的问题。下一节将介绍线性二次型问题的解法。式中下面将要讨论不考虑弹体惯性和考虑弹体惯性的21§1.3线性二次型问题的解法设线性系统状态方程为式中X-n维状态向量，u-m维控制向量没，A-矩阵，B-矩阵，指标函数为§1.3线性二次型问题的解法设线性系统状态方程为22C和Q为非负矩阵，R为正定矩阵。给定初始条件，求最佳控制u，使J为最小。对于线性二次型问题，可用变分法、极大值原理、动态规划或其它方法求得最佳控制式中P满足下列黎卡提矩阵微分方程P的终端条件为C和Q为非负矩阵，R为正定矩阵。给定初始条件23因此求解线性二次型问题的关键是求黎卡提矩阵微分方程，黎卡提矩阵微分方程使一个非线性微分方程，但它是一个很特殊的非线性矩阵微分方程，可以把它分解成两个线性矩阵微分方程。如果设W和Y的终端条件为为n阶单位矩阵，C如（11-2）式所示。因此求解线性二次型问题的关键是求黎卡提矩阵微分方程，24

则黎卡提矩阵微分方程的解为可以证明确实满足方程（11-27）以乘（11-30）式等号两边，可得对上式求t的导数得则黎卡提矩阵微分方程的解为可以证明25把（11-28）和（11-29）式代入（11-31）式得由于对所有都是非奇异的，所以必须即把（11-28）和（11-29）式代入（11-31）26因此W和Y满足黎卡提方程（11-27）。下面再看看是否满足终端条件的问题。因而终端条件也满足的下面求W和Y。将（11-28）和（11-29）写成则因此W和Y满足黎卡提方程（11-27）。下面再看27而

根据W和Y的终端条件，可得则而根据W和Y的终端条件，可得则28如果F为常数矩阵，则式中的拉氏变换

的拉氏反变换。将（11-35）式代入（11-33）式，可得W（t）和Y（t）。把W和Y代入（11-30）式代入（11-26）式，可得最佳控制如果F为常数矩阵，则式中29§1.4、不考虑弹体惯性的最佳导引规律当不考虑弹体惯性，而且假定目标不机动，导弹运动的状态方程为指标函数式中§1.4、不考虑弹体惯性的最佳导引规律当不考虑30给出时刻，的初值，用极大值原理来求最佳控制。由于A、B和Q都为常数矩阵，故用拉氏变换法求，其中。先算矩阵F：给出时刻，的初值31的拉氏反变换式中因，则

32所以所以33的拉氏反变换下面计算W和Y的拉氏反变34因此因此35下面求把和代入的式子中，可得最佳控制下面求把和代入36如在指标函数中，不考虑导弹的相对运动速度项，则可令

变成以除上式得分子和分母如在指标函数中，不考虑导弹的相对运动速度项，则可令37为了使脱靶量为最小，应选取，则根据图11-2可得当q比较小时，则为了使脱靶量为最小，应选取，则根38将上式代入（11-48），可得在（11-51）中，u的单位是加速度的单位米/秒平方，把u与导弹速度向量的旋转角速度联系起来，则将上式代入（11-48），可得在（11-51）中，u的单位是39从（11-51）和（11-52）式可看出，不考虑弹体惯性时，最佳导引规律是比例导引，其导航比为，这也证明比例导引是一钟很好的导引方法，最佳导引规律的形成可用图（11-5）来表示。图（11-5）最佳导引规律方框图从（11-51）和（11-52）式可看出，不考虑弹体惯40§1.5完全考虑弹体动态特性的最佳导引规律完全考虑弹体二阶振荡环节时，假定目标不机动师，导弹运动的状态方程为式中U为舵偏角§1.5完全考虑弹体动态特性的最佳导引规律41给出时刻，的初值。一般导弹在发射后很短时间内是不控制的，因此可假定的初值为零，即的初值为零指标函数为在指标函数中不考虑导弹的相对速度项，也不考虑项，则同时给出时刻，的初值42用极大值原理来求最佳控制，由于A、B和Q都为常数矩阵，故用拉氏变换法计算其中，先计算矩阵F用极大值原理来求最佳控制，由于A、B和Q都为常数矩阵，故用拉43完全考虑弹体动态特性的最佳导引规律课件44求的拉氏反变换是很麻烦的，在此略去推导过程。在推导过程中，假定导弹的阻尼系数求的拉氏反变换是很麻烦的，在此略去推导45这样使推导工作得到一些简化，一般弹体的自然阻尼系数小于0.1，这样的弹体是很难控制的，所以比较合理的方案是在弹上设置人工阻尼装置。因此，一般导弹上都有阻尼回路，以增大导弹的有效阻尼系数，弹体是二阶振荡环节，最好的阻尼系数应等于，所以弹上加了阻尼回路后，应尽量设法使其有效阻尼系数等于或接近该值。据推导结果，可得最佳控制这样使推导工作得到一些简化，一般弹体的自然阻尼系数小于0.146把上式得分子乘以，除以，分子和分母同乘以3，则可得在上式中同时考虑到则把上式得分子乘以，除以47从上式可看出，考虑到弹体的二阶振荡环节动态特性后，最佳导引规律的主项是变系数比例导引，另外加上航迹角角速度和角加速度的反馈。一般导引头都有盲区距离，当导引头接近目标100~200米时，导引头停止工作。没有信号输出，导弹按无控飞行。导引头也不是一下子就停止工作，使逐步地从正常工作过度到完全停止工作，导引头从逐步开始停止工作到遭遇目标的时间大约为0.5秒左右，所以在导弹整个控制飞行阶段，可按（11-57）式计算最佳控制信号，把（11-57）改写成下列形式从上式可看出，考虑到弹体的二阶振荡环节动态特性后，最48在前面我们列写状态方程时，规定是舵偏角，因此在前面我们列写状态方程时，规定是舵偏角49图11-6表示考虑导弹动态特性后的最佳导引方框图图11-6表示考虑导弹动态特性后的最佳导引方框图50下面以例说明反馈系数的变化趋势。设米/秒，米/秒，。这些系数的计算结果如图11-7所示，越来越大。下面以例说明反馈系数的变化51因此在最佳控制从图中可以看出，当导弹离目标较远时，这些系数的变化比较缓慢，当导弹接近目标时，这些系数中，虽然导弹的运动方程是常系数方程，但最佳控制中的状态反馈系数都是的函数。是导弹从t时刻开始遭遇目标时还需要继续飞行的时间，也可叫剩余飞行时间，因此弹上应有雷达和计算机，用雷达测出导弹至目标的相对距离R和接近速度。计算机根据R和算出剩余飞行时间并进一步算出所以实现最佳控制的设备比较复杂。

因此在最佳控制从图中可以看出，当导弹离目标较远52在不考虑弹体惯性时，得到的最佳导引规律与目前采用的比例导引法一致，因此，从现代控制理论的观点来看，比例导引是一种比较好的导引方法。考虑到导弹的二节振荡环节的特性后，最佳导引规律的主要项是，这是变系数比例导引。当导弹距离目标较远时，

基本上不随时间而变，因此这一段看作常系数比例导引。当导弹接近目标时，随时间变化比较剧烈，因此这一段完全是变系数比例导引。在导引规律中，另外二项是和和随时间变化的趋势与相似。前面已提过，导弹和目标的运动关系是非线性的，导弹上还有许多非线性元件，导弹的速度是随时间而变的，因此在设计导弹控制系统时还应当考虑到上述各因素。在不考虑弹体惯性时，得到的最佳导引规律与目前采用53§2卡尔曼滤波器在寻的制导系统中的应用§2.1卡尔曼滤波器的功能§2.2在寻的制导系统中引入卡尔曼滤波器的方法§2.3广义卡尔曼滤波器方程的推导§2.4卡尔曼滤波器初始条件的选取§2.5应用实例§2.6观测噪声数学模型的健模方法§2卡尔曼滤波器在寻的制导系统中的应用§2.1卡54§2.1卡尔曼滤波器的功能

自卡尔曼滤波器问世以来，在科学和工程上的到了广泛应用，它的本质优点在于：1.可以用少数几个观测量来获得所有状态变量的最佳估计值及它们的估值方差；2.在采用自适应滤波器后，可以根据战术导弹的不同工作条件自动改变滤波器参数，使其性能最佳。古典的维纳滤波器本质上只适用于定常线性系统；§2.1卡尔曼滤波器的功能自卡尔曼滤波器553.卡尔曼滤波器以明确形式把系统的动力学特性引入了滤波器的数学模型，因而充分利用了所论对象的验前知识，从而提高了估值准确度；4.采用递推算法，减少了对计算机存储量的要求，便于实现在线实时滤波。

70年代以来，随着电子计算机的发展，特别是微处理和微计算机技术的发展，卡尔曼滤波器已在控制工程、生产过程自动化、通讯、导航以及航空、航天技术等方面得到了广泛的应用，成为一种较为满意的估值方法。3.卡尔曼滤波器以明确形式把系统的动力学特性引入了滤波器的数56§2.2在寻的制导系统中引入卡尔曼滤波器的方法就战术导弹的设计而言，卡尔曼滤波器主要应用在以下三方面：1.导引头信号处理和参数估计；2.制导指令的形成；3.适应式自动驾驶仪中弹体气动力特性的估计与回路增益的计算；§2.2在寻的制导系统中引入卡尔曼滤波器的方法57以雷达半主动寻的制导系统而论，由于雷达目标的运动具有随机性，雷达半主动导引头输出的，代表导弹——目标视线角速度的电信号上，一般都混杂有测量噪声。这是，制导系统设计者的任务是：一、设法测取和分析这些噪声的统计特性，并且用适当的数学方法描述它；二、设法抑制这些噪声，求取有用信号的最佳估计（最佳滤波估值），以消弱它对导弹精度的影响；三、对最佳控制问题和最佳估值问题加以综合考虑，分析主要的非线性因素对滤波和控制的影响。以雷达半主动寻的制导系统而论，由于雷达目标的运58§2.3

广义卡尔曼滤波器方程的推导推导卡尔曼滤波器方程的原始依据是被滤波系统的状态方程和观测方程。所谓系统的状态方程，是由描写被滤波系统状态变量演化过程的一组微分方程和差分方程构成。系统的观测方程，则表示系统中的观测量和系统状态变量间的关系。§2.3广义卡尔曼滤波器方程的推导推导卡59战术导弹制导系统方程，一般都是高阶的变系数方程。在制导装置的部件中，在弹体动力学方程中，在相对运动学方程中，都含有非线性环节。因此系统的状态方程都是复杂的非线性方程，用它们来导出卡尔曼滤波器方程是很困难的。对于制导系统的设计者而言，如果要解决的问题是简单的信号过滤问题，则可用一种较简单的办法，即多项式动力学的方法。完全考虑弹体动态特性的最佳导引规律课件60多项式动力学这一术语，意思是说，若忽略模型（即系统的动力学模型）的不准确性，则制导系统中每个信号，都可用泰勒级数展开的方法写成t的（m-1）次多项式每个的所需的微分阶数，可以通过对该量的变化规律的分析得到。一般而言，m应该尽可能低一些，以使卡尔曼滤波器简单一些；同时，又必须足够高，以便能跟踪该两的主要变化规律。例如，对雷达半主动导引头构成的寻的制导系统，一般都采用比例导引律，用导弹——目标视线角速度信号，形成制导指令，理论和实验都表明，在绝大部分攻击飞行时间内，此信号为一缓变信号，故可用足够的精确度假设多项式动力学这一术语，意思是说，若忽略模型（即61式中，代表导弹——目标视线旋转角速度。为了将（64）改写为状态方程的形式，假设，这样，有：令状态矢量为则上述方程组可写为（64）（65）式中，代表导弹——目标视线旋转角速度。为了将（64）改62式中和方程（65）相对应的状态转移矩阵为由于当时故得所以，我们可以把方程（65）离散化，得到状态差分方程式中和方程（65）相对应的状态转移矩阵为由于当63考虑到原设（64）的不准确性，可在方程（65）的右端加上一个误差修正项，用表示，一般称为模型噪声，此时，可将状态方程写成为：式中状态变量中仅有，即可观测，故观测方程为：式中，而表示观测量中的噪声分量，可用一阶或二阶差分方程表示，方程（66）及（67）即构成了被滤波系统的状态方程组。（66）（67）考虑到原设（64）的不准确性，可在方程（65）的右端加上一个64对跟踪空中目标的战术导弹而言，正如我们后面将要讨论的那样，可用下述非常来表示导引头的输出噪声：或式中下标“k”活“k-1”表示时间序号，为常系数，而则表示零均值高斯白噪声在k时刻的取值，还假设：对跟踪空中目标的战术导弹而言，正如我们后面将要讨论的那样，可65式中E(.)代表对某量求数学期望运算.而则代表对某量求方差的运算(下同),上标“T”代表对矩阵或矢量求转置的运算，利用以上假设条件，我们即可导出所需的卡尔曼滤波器方程，以后我们将会看到，和方程（11-68a)对应的卡尔曼滤波器方程，只是我们所导出的方程在时的一个特殊情况。在一般文献中，卡尔曼滤波器方程都是针对观测噪声为白噪声的情况导出的。对与观测噪声为有色噪声的情况，推导卡尔曼滤波器方程的方法有两种：扩大状态变量的维数；此时，将有色噪声的表达式也写入到状态变量方程组中去，从而使观测方程中除状态变量之外的观测噪声等效为白噪声，这样就可利用观测噪声为白噪声时的推导方法。式中E(.)代表对某量求数学期望运算.而则代662.量测求差法即改变观测矢量，此时，引入一个新的观测量，使得对此新观测量列写的新的观测方程中，等效的观测早声仍未白噪声。由于扩大状态变量维数的结果，将会使状态转移矩阵的阶数增大，这不仅会增大计算量，而且会使计算卡尔曼滤波器增益矩阵遇到求异成为不可能，所以是不希望的。工程上应用量测求差法较为方便。对噪声模型为（11-68b）的情况，引入新观测量如下：式中即为方程（11-68b）中之系数，利用方程（11-66）可以求得2.量测求差法式中即为方程（11-68b）中之67将此式和方程（11-68b）一起代入新观测量的表达式，整理可得其中方程（11-69）即为新的观测方程，而为等效的观测噪声，它的方差为其中将此式和方程（11-68b）一起代入新观测量的表达式，整理可68此时观测噪声和模型噪声是相关的，其相关局矩阵为

参照观测噪声为白噪声时导出的卡尔曼滤波器方程，可以假设最佳估计值由下述方程给出：式中上标”^”表示取得最佳估值，而“”则表示用时刻及其以前的观测值对时刻所作的预报估值。上式在形式上是用序列对所作的预报估值，但实际上是用序列

对所作的滤波估值，因而可将视为此时观测噪声和模型噪声是相关的，其相关局矩阵69为了求出估值方差，需先求出因而，由定义可得若设则得记为了求出估值方差，需先求出因而，由定义可得若设则得70并将增益矩阵之下标“k-1”改为“k”，则有这便是观测噪声为二阶模型（11-68b）时的卡尔曼滤波器方程组，将三个方程联立求解，即可由观测序列{}求出状态矢量的最佳估计值。式（11-70）表示，最佳估值由预报估值加上新息修正项组成，其中代表新息序列。即为卡尔曼滤波器的增益矩阵，由（11-70）式算出。并将增益矩阵之下标“k-1”改为“k”，则有这便71（11-71）代表估值误差协方差矩阵的算法，其中第一项表示上一时刻的协方差矩阵至当前时刻的传播，第二项则为模型噪声所附加上的方差分量，它在求取最佳估值的过程中始终是存在的。第三项则表示由于对估值实行最佳化处理使估值误差协方差阵减小的部分，它代表了最佳化处理带来的好处.在观测噪声为（11-68a）时，即，则有式中（11-71）代表估值误差协方差矩阵的算法，其中第一项72它和文献中给出的观测噪声为一阶马尔柯夫过程时的滤波器方程是一致的，对于定常线性系统而言，在这组方程中的参数称为信噪比，它对滤波器性能有重要影响，因而在设计滤波器时应仔细加以考虑。它和文献中给出的观测噪声为一阶马尔柯夫过程时的滤波器方程是一73§2.4卡尔曼滤波器初始条件的选取为了保证最佳估值的无偏性，要求初始条件用下式选取：并应给出所需的观测量的验前估计值。在观测噪声取为一阶模型（11-68b）时，应给出；而在使用二阶模型（11-68b）时，则应给出及两者。卡尔曼滤波器接入制导系统时，它的初始条件的计算和制导系统开始工作时，载机和目标的相对运动状态有关。对于我们的问题，因为§2.4卡尔曼滤波器初始条件的选取为了保证最佳估值的无偏74而及皆和导弹捕获并且开始跟踪目标之后，载机相对于目标的相对运动状态有关，即和此时目标的机动情况，载机对目标瞄准的误差有关。目标的初始机动和载机的初始瞄准误差都是随机量（离散的或连续的），因而一般来说，将和这些随机量的数学期望有关，而则和它们的方差或协方差有关。而及皆和导弹捕获并且开始跟踪目标之后，载机相75对飞行目标而言，目标初始机动的分布率一般都取图（11-8）的形状，图中纵坐标为目标机动出现的概率，横坐标为该概率所对应的目标初始机动加速度，此曲线可用数学函数形式表示如下：图11-8空中目标初始机动的典型概率对飞行目标而言，目标初始机动的分布率一般都取图（11-8）的76一般来说，对定常线性系统而言，初始条件的选取对滤波的稳态状况没有影响，只影响滤波的过渡过程，但在空对空导弹的制导系统中，由于飞行时间不长（10~25秒），因而滤波过渡过程可能要占整个制导飞行时间的相当大的一部分，对飞行的初始阶段将有直接影响，也将会影响飞行中段的制导过程。这样，就有必要对它加适当考虑，具体的设置方法，可通过载机的火力控制系统来对导弹设置适当的初始条件。一般来说，对定常线性系统而言，初始条件的选取对77§2.5

应用实例（一）空对空导弹寻的制导系统的方框图寻的制导的空对空导弹的制导系统的一般方框图如（11-9）所示。§2.5应用实例（一）空对空导弹寻的制导系统的方78

对寻的制导系统而言，一般都采用比例导引规律形成制导指令，所以，寻的导引头主要用于测量导弹——目标视线角速度信号，信号处理电路可以是相敏检波器、比较器、乘法器或其他低频电路，用以形成制导指令。执行机构可以使液压或气压舵机，亦可用电动伺服机构。弹体环节由导弹空气动力学方程构成，它是系统的控制对象，在用铰链力矩反馈的舵机中，应有角反馈。角反馈信号代表了导引头的位标器部分和弹体运动的耦合，而导弹轨迹角则是导弹——目标相对运动学方程的输入量。对寻的制导系统而言，一般都采用比例导引规律形成制79对于雷达半主动寻的制导系统而言，其导引头输出的、代表导弹——目标视线角速度的电信号上，一般都混有噪声。这种噪声来源有：1.来自外部的噪声主要是由目标反射回来的雷达回波中，由于目标的随机角运动，使此回波信号在幅度上随机起伏，并引起等效的目标反射中心的随机飘移，因而使导引头测得的角信号产生闪烁对于雷达半主动寻的制导系统而言，其导引头输出的802.来自制导装置内部的噪声主要是电子器件的热噪声，伺服机构噪声等。由于这些噪声的存在，使雷达型导引头测得的视线角速度信号上带有随机误差，并最终影响导引准确度。因此，必须抑制这些噪声，提高导引准确度，减少终点脱靶量。完全考虑弹体动态特性的最佳导引规律课件81（二）卡尔曼滤波器的设计方法设计卡尔曼滤波器的大致步骤如下：建立观测噪声的数学模型，即用方程来表示雷达导引头输出信号中的噪声成分；导出卡尔曼滤波器方程，并给出相应的初始条件算法；进行卡尔曼滤波计算，选取最佳参数；将卡尔曼滤波器接入制导系统，通过全系统联试来修改卡尔曼滤波器及制导系统两者的参数，使整个系统的导引准确度最高。（二）卡尔曼滤波器的设计方法设计卡尔曼滤波器的大致步骤如下：82在雷达导引头已初步研制完成的情况下，获得雷达导引头输出噪声模型的直接方法，就是利用此雷达导引头，对真实的空中目标进行空中或地面跟踪试验。在试验过程中记录雷达导引头输出的视线角速度信号，此信号为有用信号和噪声信号的迭加，即实验信号Y（t）为为了建立V（t）的数学模型，首先要设法剔除其中的非随机成分，这可以根据具体情况，选择适当的方法去做。譬如，在试验中若基本保持常值，则易于导出此式之左端正好是我们建立卡尔曼滤波器观测噪声数学模型时所需的零均值噪声。在雷达导引头已初步研制完成的情况下，获得雷达导引83试验与计算表明，雷达导引头输出的噪声信号，一般为一阶或二阶平稳自回归模型，典型的自相关函数和偏自相关函数随k的变化规律，分别如图（11-10）及（11-11）所示。试验与计算表明，雷达导引头输出的噪声信号，一般84由曲线可看出随k的增大而减少，但呈振荡状，总不会恒保持在某一数值范围内，我们称这种曲线“呈拖尾状”。相反，对偏自相关函数而言，在k=3时，某值骤减到极小的数值，而且此后各值总保持在某一个很小的数值范围内，我们称此曲线在k=3处“截尾”。根据下段所述准则，可判定它为二阶平稳自回归模型AR（2）。对于这种噪声模型，所导出的卡尔曼滤波器方程和方程（11-70）、（11-71）及（11-72）相同。在一个实例中，用实测的导引头噪声作为卡尔曼滤波器的输入信号，对滤波器的滤波效果进行了计算。由曲线可看出随k的增大而减少，但呈振荡状85计算所使用的程序框图如图11-12所示。计算所使用的程序框图如图11-12所示。86在信噪比为0.1时，典型的滤波曲线如图11-13所示，计算表明，滤波器输出信号的方差和观测信号的方差相比，减少了71.2%在信噪比为0.1时，典型的滤波曲线如图11-187将这个滤波器接入图（11-10）所示的制导系统时，需将原有的RC滤波器去掉。

但是，由于最佳估值问题和最佳控制问题是相互关联的，因而必须从最佳随机控制的观点，重新考虑整个寻的制导系统的结构和参数的选取。将这个滤波器接入图（11-10）所示的制导系统时88

按照随机最佳控制理论，在下述条件下，最佳估值器和最佳控制器的设计（即卡尔曼滤波器和最佳导引规律的设计）无相互关联，可独立进行设计：1.所考虑的系统是线性系统；2.作用于系统上的随机输入量符合正态的或高斯的分布滤；3.最佳指标选为二次型性能指标，形如完全考虑弹体动态特性的最佳导引规律课件89式中——系统工作开始计终结时刻；X——状态矢量；U——作用于系统控制对象上的控制信号或控制函数：S，Q——非负定矩阵；R——正定矩阵；所求得的最佳控制函数U，应能使J达到最小。除了有时第二个条件可放宽以外，这些条件都是必备的。式中——系统工作开始90对于我们所考虑的系统，显然不是线性系统，因为在放大器和舵机中存在着饱和非线性特性，在相对运动学环节中存在着正弦和余弦函数等。另外，作用在系统上的有些随机输入量，也不符合正态分布规律。例如，雷达目标回波信号中的振幅噪声已知为瑞利分布，而目标机动的典型概率分布为图11-8所示的曲线，也不是高斯分布。因而，原则上不能将最佳估值问题和最佳控制问题分割开。这样，我们单独设计的卡尔曼滤波器，就不能原封不动地搬到制导系统中去，必须对滤波器本身及导引规律两者都作适当的协调和改动，否则将不能有效地提高制导系统的导引准确度。对于我们所考虑的系统，显然不是线性系统，因为在91但是从纯理论的角度去处理这一问题的话，将会遇到很大的困难。因为我们面临的是一个高阶的非线性协调。工程上较实用的方法是试验方法，即用制导系统的仿真试验来对最佳估值器和最佳控制规律进行试验设计。但是从纯理论的角度去处理这一问题的话，将会遇到92由于原有的系统是模拟式制导系统，而卡尔曼滤波器是一个数学部件，故在将卡尔曼滤波器接入制导系统之后，即形成一个数字——模拟混合系统。在进行仿真试验时，现有的模拟式部件都在模拟式电子计算机上用排题的方法实现，而卡尔曼滤波器本身则在数字计算机上用软件实现。在模拟式计算机和数字计算机之间还要加上适当的数字/模拟及模拟/数字转换装置及相应的接口程序，以实现模拟式计算机和数字计算机之间的信息交换和运行控制。由于原有的系统是模拟式制导系统，而卡尔曼滤波器是93

对于此混合式制导系统进行统计模拟，也使用蒙特-卡罗（Monte-Carlo）方法，即使用足够多的随机输入量样本，在某些初始条件和参数下进行足够多次的运算，求取状态变量的统计平均值。这样一来，如果原来测取的噪声样本不够长，就应根据已建立起来的噪声的数学模型，产生足够长的噪声样本。对于此混合式制导系统进行统计模拟，也使用蒙94其具体方法如下：1.用某种方法，例如乘同余法。产生在区间[0，1]上均匀分布的随机数R（i）；2.用下述方法，利用已得的均匀分布随机数，产生的正态分布随机数样本：式中S为和有关的常系数。3.用代入已建立的噪声的数学模型中，产生所需的AR（2）时间序列：这即是方程（11-68b）的代换式。其具体方法如下：95对于我们的例子，用上述方法进行了混合仿真试验。在适当地选取系统的结构和参数之后，得到了较满意的结果。由噪声分量产生的脱靶距离，和具有RC滤波器的模拟式制导系统的蒙特-卡罗模拟结果相比，大约可减少一半，典型的制导系统混合仿真试验曲线如图11-14所示。

对于我们的例子，用上述方法进行了混合仿真试验。在96由图可以看出，用卡尔曼滤波器所得到的视线角速度的最佳估值，比采用RC滤波器的模拟器的模拟式系统得到的视线角速度的变化规律，更靠近于确定性制导系统，即只有初始条件作为唯一输入量的原模拟式制导系统，而确定性系统的动态仿真结果说明，它的终点脱靶量近视为零。为了进一步改善滤波器的性能，一般可采用适应式卡尔曼滤波器。在这种滤波器中，要用某种方法在线、实时地对噪声的统计特性的变化加以预测和估计，据此修改噪声模型，并相应地改变滤波器及导引规律诸参数。由图可以看出，用卡尔曼滤波器所得到的视线角速度97§2.6观测噪声数学模型的建模方法建立观测噪声数学模型所用的方法，即是一般的线性随机时间序列的分析方法，亦即近年来出现的建立ARMA模型的方法。它的基本思想和基本方法如下。对于很广泛一类平稳随机时间序列若其数学期望或统计平均值为零（在它不为零时，可取原序列与它的数学期望之差作为序列），总可以用下述三个差分方程之一来描述：§2.6观测噪声数学模型的建模方法建立观测98其中及为的算子多项式。称为后移算子，即n为正整数。这样，上述算子多项式可写为

其中p和q为正整数，称为模型的阶数。规定为零均值高斯白噪声。方程（11-79）称为自回归模型。若的最高幂次为p，则称为p阶自回归模型。其中及为的算99若方程的全部根都位于复平面z上的单位圆内，则由方程（11-79）所得到的随机序列，一定是平稳随机序列。这时，我们称方程（11-79）所代表的模型为p阶平稳自回归模型，简记为AR（P）模型。方程（11-80）称为滑动平均模型。若中的最高幂次为q，则称它为q阶滑动平均模型。若在方程中，其全部根都的全部根都在复平面z上的单位圆内，则称此方程所代表的模型为可逆滑动平均模型。若方程100因为在满足这个条件时，方程（11-80）存在可逆解为一个的无穷多项式，而在满足上述条件时，这个无穷多项式可写成有理分式的形式。此模型简记为MA（q）。同理，称方程（11-81)代表的模型为自回归与滑动平均混合模型。若这个方程左右两边的算子多项式所构成的方程：分别满足上述条件，即它们的根全部在复平面ｚ上的单位圆内，且阶数分别为ｐ和ｑ，则称方程（11-81）所代表的模型为p阶平稳自回归与q阶可逆滑动平均混合模型，简记为ARMA（p，q)。因为在满足这个条件时，方程（11-80）存在可逆解101问题在于：记录到一个随机序列的样本之后，究竟是不是平稳序列？如果是平稳随机序列，它属于上述三类中的哪一类？P和q如何确定？诸系数及和的方差（数学期望已知为零）如何求出？这些问题即是建立噪声的数学模型时需要解决的主要问题。（一）平稳性判别和预处理：一般来说，一个物理随机过程，如果它赖以发生的物理系统的环境条件和参数在系统的全部工作时间内保持不变，则可把该过程视为平稳随即过程。但是这种看法并不严格。在实际问题中，还必须根据测量数据的统计分析计算，从数值上检验它的平稳性。问题在于：记录到一个随机序列的样本之后，究竟是不是平稳序列？102

检验的具体方法是：选取一个长样本序列中足够长的几段，计算各段的均、方差及相关函数，看这些量是否相等或近视相等。如果它们近视相等，则可认为这个随机序列在所检验的时间区间上是平稳的。在确认了随机序列的平稳性之后，还应对该序列进行预处理，即剔出这个随机序列中所包含的非随机量，使它仅包含随机噪声。然后，还需去掉此噪声的常值数学期望。检验的具体方法是：选取一个长样本序列中足够长的103（二）计算随机序列的自协方差函数、自相关函数及偏相关函数：对零均值随机序列定义为此序列的自协方差函数的一个估值，m一般可取为序列长度n的1/4~1/10。由平稳序列的性质可知定义（二）计算随机序列的自协方差函数、自相关函数104为该序列的自相关函数的一个估值。易于看出如果要用序列中某时刻t之前的k个值的线性组合来逼近t时刻之值，形如：并且存在一组系数