1、第 卷 第期 年月探 测 与 控 制 学 报 收稿日期：作者简介：许一蒙（），男，陕西西安人，硕士研究生。通信作者：霍鹏飞（），男，陕西吴堡人，博士，研究员。基于高斯伪谱法的枪榴弹制导算法许一蒙，霍鹏飞，王超，雷泷杰（西安机电信息技术研究所，陕西 西安 ；机电动态控制重点实验室，陕西 西安 ）摘要：针对目前枪榴弹制导算法稀少，传统中大口径弹药的制导方法不适用于枪榴弹制导等方面的问题，提出基于高斯伪谱法的枪榴弹制导算法。该算法利用高斯伪谱法规划出一条最优弹道作为标准弹道，依据实时弹道和标准弹道的偏差生成制导指令。以修正能量和制导精度为指标，对该算法进行仿真验证，结果表明该算法具有修正能量小、制导
2、精度高的特点，易于在枪榴弹上实现与应用。关键词：枪榴弹；高斯伪谱法；弹道优化；制导与控制中图分类号：文献标志码：文章编号：（），（，；，）：，：；引言近年来，随着局部地区的冲突加剧，维稳和反恐行动的需求不断增加，采用低成本弹药对地面人员精确打击的需求日益增长。枪榴弹尺寸小、重量轻、成本低，特别适用于低成本精确打击人员目标；但传统枪榴弹无制导，精度低，无法满足精确打击的使用需求，因此推动了枪榴弹智能化的发展。通过制导提高枪榴弹的命中精度是枪榴弹智能化设计中的重要环节。文献 采用极大值原理求解弹道修正引信弹道控制中以能量消耗最小为目标的弹道控制优化模型，得到最优法向过载值；但控制优化模型的求解时间
3、比较长，难以直接应用到枪榴弹制导中。文献通过综合协同制导控制和高斯伪谱法弹道规划，实现多弹以最优路径攻击目标；但需要实时测量目标的角度偏差和弹目距离，成本过高。文献 以射程最大为指标，利用高斯伪谱法实现弹道的合理优化，并比较了标准位置跟踪和标准过载跟踪两种实现方法；但由比例导引得到制导指令所需过载较大，枪榴弹难以满足。文献 将标准弹道的某点作为目标点进行轨道计算及最优入轨控制，无需进行虚拟目标点的修正；但对制导方程进行了简化，带来了不小的误差，需要对精度进一步优化。因此，有必要结合枪榴弹的自身和任务特性，研究一种能够满足枪榴弹打击精度，且消耗能量小，解算速度快的制导算法。本文针对上述问题，提出
4、基于高斯伪谱法的枪榴弹制导算法。高斯伪谱法高斯伪谱法无需对微分方程求解，收敛半径大，收敛速率快且精度较高，适用于需要快速解算的枪榴弹弹道。高斯伪谱法的本质就是同时离散控制变量和状态变量的直接法，也被称作配点法或直接配点非线性规 划 （）。高斯伪谱法的解算步骤：首先在一系列的（）点上将状态变量和控制变量进行离散；然后通过离散点为节点，采用全局多项式插值，对控制变量和状态变量进行近似逼近，从而将系统从微分约束转化为代数约束；最后以节点处的状态变量和控制变量作为优化变量，将最优控制问题转化为非线性规划问题而求解。弹道优化问题是复杂的多约束动态优化问题，可将其看作一般的最优控制问题，一般最优控制问题的
5、 形式描述如下：（），（），（），（），（）式（）中，（）为控制变量，（）为状态变量，和为时间的初始值和终端值。系统满足的动力学约束、边界条件约束和路径约束分别为（）（），（），（），（），（），（），。（）求解优化问题应对优化问题参数化，具体流程如下。）一般非线性系统的动力学方程由式（）可知，非线性系统的动力学方程的一般形式为（）（），（），。（）时域变换由于最优控制问题的时间变量，而高斯伪谱法的时间变量，因此，将离散到：。（）近似状态变量与控制变量高斯伪谱法的离散点个数为个，其中包括个 点和点，从而构成个 插值多项式（）（，），以此为基函数，进行状态变量的近似：（）（）（）（），（）其中，
6、（），。（）以 插值多项式?（）（，）为基函数，进行控制变量近似：（）（）?（）（），（）其中，?（），。（）以上问题中对于状态变量是在，）的时间区间内近似的，未对终端状态进行定义，终端状态满足动力学方程约束：（）（）（），（），。（）对终端状态约束条件进行离散并以高斯积分来近似，得到（）（）（），（），。（）动力学方程约束转为代数约束对式（）求导可得状态变量的导数，将动力学方程约束转换为代数约束：（）（）（）（）（）（）。（）探 测 与 控 制 学 报从而可得状态变量在节点处需满足的代数方程约束：（）（）（），（），。（）近似性能指标函数将 形式的性能指标函数中的积分项用高斯积分近似，可得到
7、用于高斯伪谱法中的近似性能指标函数：（，）（），（），。（）经过上述步骤，高斯伪谱法将连续最优控制问题转换为一般非线性规划问题。基于高斯伪谱法的枪榴弹制导算法 制导策略基于高斯伪谱法的枪榴弹制导算法的基本策略：采用指令制导方式，发射前一次性规划，发射后持续修正。发射前，根据目标位置，采用高斯伪谱法规划出一条需用能量最小的最优标准弹道。制导过程中，在发射点处实时测量并解算出实际弹道相对于发射点的高低角和方位角与标准弹道的高低角偏差和方位角偏差，形成制导指令，导引弹丸飞向目标。制导策略的示意图如图所示。图基于高斯伪谱法的枪榴弹制导策略 弹道模型建立本文采用三自由度（）质点弹道模型，将枪榴弹视为理想
8、质点，不考虑弹体绕质心转动的影响，假定攻角为零，空气动力只计阻力。建立描述枪榴弹质心运动的方程组如下：（）（），（）式（）中，为飞行速度；为弹道倾角；为弹道偏角；为射程；为弹道高；为法向位移；、分别为、方向上的过载矢量，可用式表示，为该方向上的控制力。优化模型建立由于 能 量 的 大 小 和 过 载 大 小 正 相 关，由 式（）可以看出，过载矢量大小的主要影响因素是速度、弹道倾角和弹道偏角，因此建立优化问题如下 ：）性能指标：本文以枪榴弹所需修正能量最小为指标，可得（）。（）状态约束：为式（）运动方程组。）边界条件：满足以下边界条件 。（）过载约束：由于枪榴弹所能提供的修正过载有限，因此对其
9、进行约束：。（）优化问题求解流程如图所示。许一蒙等：基于高斯伪谱法的枪榴弹制导算法图弹道优化流程 制导指令计算定义模拟产生发射点处实时测量和解算的高低角和方位角的偏差为，（）式（）中，、为实时弹道高低角和方位角；、为标准弹道高低角和方位角。根据测量得到的高低角和方位角偏差计算制导指令：，（）式（）中，为比例系数。仿真验证本文以 枪榴弹为例，使用 软件进行弹道优化和制导仿真。弹道优化仿真假设枪榴弹发射点坐标（，），目标点坐标（，），发射初速 ，修正过载区间（，），以所需修正能量最小为指标，选取插值点数为，利用 中 工具箱进行基于高斯伪谱法的弹道优化，优化后的弹道如图所示。图优化后的标准弹道 同时
10、，可以得到最优弹道的初始射角为 ，初始偏角为。制导仿真 理想情况仿真不考虑射击诸元误差、气象误差、角度测量误差等，以 节中经过高斯伪谱法优化的最优弹道为标准弹道，采用 节中制导指令的计算方法，以初速度 ，目标点坐标（，），初始射角 ，初始偏角 为初始条件，以射程 为停止条件进行制导仿真，以实际弹 道 和 标 准 弹 道 进 行 对 比，仿 真 结 果 如 图所示。图实际弹道与标准弹道对比 仿真末端位置数据如表所示。探 测 与 控 制 学 报表制导仿真末端数据 以上理想情况下制导仿真数据表明，末端弹道高，横向偏移方向误差小于 ，末端高低角，方位角角度误差小于 ，该制导方法实现了对优化后标准弹道的
11、跟踪。真实情况仿真考虑到枪榴弹射程小、弹道低，忽略气象对弹道的影响，针对初速误差和角度测量误差分析制导精度。取名义初速度 ，初速散布误差均方差取，初始射角均值 ，方差，初始偏角均值，方差，目标点坐标（，），考虑诸多误差因素，随机生成 组数据进行打靶仿真试验，仿真结果如图所示。图 组打靶仿真试验结果 为评估该制导方法的精度，用以上 组打靶仿真试验数据进行 （圆概率误差）计算，公式如下：，（），（），（）式（）中，为末端位置均方差。代入以上生成的 组打靶仿真试验数据，解得该制导方法的 。与其他制导方法对比本文以最小修正能量为性能指标，依据由高斯伪谱法优化 后的 最优弹 道为 标 准 弹 道 进 行
12、 制导，仿真对比该制导方法、传统比例导引法和落点预测制导法的修正结果，仿真中初速度 ，目标点坐标（，），初始射角 ，初始偏角 ，枪榴弹重 ，图为三种制导方法过载对比。图基于高斯伪谱法的制导制算法、比例导引法与落点预测制导法的修正过载对比 ，由图可知，比例导引法所需修正过载较大，约为本文制导算法的 倍；落点预测制导法虽然修正过载较小，但末端过载出现了明显震荡，不利于末端的修正；本文所述制导方法修正过载小且末端无震荡，具有明显优势。依据修正过载计算上述三种制导方法所需的修正能量，再对其余两种制导方法进行同 节所示的 组打靶仿真试验，计算 ，结果见表。许一蒙等：基于高斯伪谱法的枪榴弹制导算法表三种制
13、导方法对比 制导方法能量 对比本文制导方法 能量小、精度高比例导引法 能量大、精度较高落点预测法 能量较小、精度低由表可以看出，本文制导方法所需的能量约为比例导引法的，约为落点预测制导法的；本文制导方法的 约为落点预测制导法的，与比例导引法 大致相同，但从能量角度考虑，比例导引法所需能量更大，对于尺寸小、成本低的枪榴弹要提供比例导引法所需能量的难度更大，成本过高。综上所述，本文所述制导方法的修正能量明显小于比例导引法和落点预测制导法的修正能量，且 优于比例导引法和落点预测制导法。结论本文提出基于高斯伪谱法的枪榴弹制导算法，该算法以最小修正能量为性能指标，利用高斯伪谱法优化出一条最优弹道作为标准
14、弹道，依据实时弹道和标准弹道的偏差生成制导指令。以 枪榴弹为例，与比例导引法和落点预测制导法进行制导性能对比，仿真结果表明，本文制导方法所需修正能量最小，仅为比例导引法的，是落点预测制导法的；本文制导方法的 小，约为比例导引法的，约为落点预测制导法的。因此基于高斯伪谱法的枪榴弹制导算法具有修正能量小，制导精度高的特点，易于在枪榴弹上实现与应用。参 考 文 献：张梦湉 微小型导弹：身材小威力大 太空探索，（）：霍鹏飞，施坤林，苑伟政 基于极大值原理的弹道修正引信弹道优化控制研究兵工学报，（）：刘磊，高文冀，王建超 基于高斯伪谱法的制导火箭弹协同末制 导 分 析 导 弹 与 航 天 运 载 技 术
15、，（）：张洪倩 基于高斯伪谱法的弹道优化设计与实现南京：南京理工大学，王继平，王明海，马丹山，等 基于标准弹道点的最优制导方法 飞行力学，（）：张化光，何希勤模糊自适应控制理论及其应用北京：北京航空航天大学出版社，雍恩米，陈磊，唐国金飞行器轨迹优化数值方法综述宇航学报，（）：，（）：钱杏芳，林瑞雄，赵亚男导弹飞行力学北京：北京理工大学出版社，杨希祥，张为华基于 伪谱法的空空导弹最优中制导 律 设 计 国 防 科 技 大 学 学 报，（）：陈琦，王中原，常思江基于 伪谱法的滑翔弹道快速优化弹道学报，（）：，（）：版 权 声 明凡稿件被本刊录用，即视为作者同意将该论文的复制权、发行权、信息网络传播权、翻译权、汇编权等权利在全世界范围内转让给本刊。本刊已许可中文科技期刊数据库、万方数据数字化期刊群、中国知网（中国学术期刊（光盘版）电子杂志社）和超星域出版系统在其各自的系列数据库产品中以数字化方式复制、汇编、发行及在信息网络传播本刊全文。作者著作权使用费和稿酬一并支付（即包括印刷版、光盘版和网络版各种使用方式的报酬）。如作者对本声明持有异议，请在投稿时说明。本刊编辑部探 测 与 控 制 学 报
