第39卷 第9期 V_01.39 No.9 计算机工程 2013年9月 September 2013 Computer Engineering ・人工智能及识别技术・ 文章缩号:1ooo_一3428(2o13)o9__o245.-_o5 文献标识码:A 中圈分类号。V279 动态航迹规划关键技术研究 杨俊 ,朱摘凡 ,张健 ,郝震 (1.空军工程大学工程学院,西安710038;2.中国人民解放军94270部队,济南250117) 要:针对实际作战环境中常遇到的突发威胁、运动威胁、任务改变等情形,提出一种基于战场态势预测的滚动粒子群优化多 步预测规划算法。采用卡尔曼滤波和随机理论分别完成对威胁源指定时刻的状态预测和任务目标的概率对准,改进高效粒子群优 化算法,并将其运用到局部滚动优化过程中,以多步规划、单步执行的形式实时调整航迹。仿真结果表明,该算法对战场威胁态 势具有预测作用,对任务的改变反应灵敏,能较好地满足动态环境下的实时性要求。 关健词:态势预测;运动威胁;滚动粒子群优化;卡尔曼滤波;动态规划 Research 0n Key Technology 0f Dynamic Flight Path Planning YANG Jun ,ZHU Fan ,ZHANG Jian ,HAO Zhen f1.EngineeringInstitute,AirForceEngineeringUniversity,Xi’an 710038,China;2.The 94270Unit ofPLA,Jinan 250117,China) [Abstract|For some cases of new or moving threats and task changing in the practical dynamic circumstance,a new roll Particle Swarm Optimization(PSO)multistep forecasting plnniang algorithm based on battlefield situation prediction is proposed in this paper.By using the Kalman filtering and probability theory,it completes the situation prediction for threat source,and the probability of the target task. Combined the upgrade PSO arihmettic with het roll optimization,it carl adjust het path in real time by multi-step planning nd aone-step executing.Simulation result indicates that this algorithm plays well in dynamic circumstance especially in aspect of prediction the threat state and responding to the task changing. [Key wordsl situation prediction;mobile threat;roll Particle Swarm Optimization(PSO);Kalman ifltering;dynamic plnniang DOI:10.3969 ̄.issn.1000-3428.2013.09.055 1概述 在飞行器智能规划领域中,航迹规划问题受到了相当 的重视。当具备了完整精确的环境信息后,可用一次性的 地面离线规划来得到一条飞行路线。 原理、随机概率理论、正交实验设计等思想引入到该算法 中,用于动态变化着的战场环境。 2 问题描述 给定一个规划区域建立坐标系,其上分布着种类不同 的威胁区,如雷达威胁、防空火力威胁等,每种威胁区的 威胁概率函数不尽相同,但都是关于飞行器与其中心位置 距离的函数,服从柏松分布pJ。为了便于观察最终的规划效 果,将所有威胁的威胁概率函数都视为防空火力威胁概率 模型,禁飞区则视为威胁概率无限大的一片区域,如下: P:e— —但在大多数情况下,战场环境是存在诸多未知因素的, 具体表现在未知威胁出现的突发性、运动威胁参数的不确 定性、未知威胁源数量的不确定性以及任务目标的临时变 动。在此种情况下,若仍旧按照原先的航迹飞行,势必会 给飞行器造成极大的安全隐患,因此,有必要根据动态变 化的环境对航迹进行实时调整。 目前,已有的动态航迹规划方法主要有人工势场法 J、 动态窗VI法 J、矢量场图 、模糊控制算法 等,但这些 方法并没有考虑到无人机运动与威胁环境的耦合关系,往 往只是在战场态势发生变化后被动地做出规避,缺乏预见 Rmax—-t" 威胁源或是任务目标的位置状态模型可以描述成以下 形式: x(k+1)=A・ ( )+q(k) (2) 性,从而未能充分利用实时战场信息,降低了实时航迹的 生成质量,严重时甚至造成规划失败。针对此情况,本文 提出一种基于战场态势预测的改进粒子群优化(Particle Swarm Optimization,PSO)滚动搜索算法,并将卡尔曼预估 作者简介:杨其中,矩阵X=[Xk Y Pk] 分别为笛卡尔坐标系下 威胁源或目标的位置和速度信息;A为状态转移矩阵;矩 阵 为过程噪声。 凡、张健,副教授;郝震,助理工程师 俊(1987一),男,硕士研究生,主研方向:智能控制;朱收稿日期:2012—03-2O ._}回日期:2012-05—21 E-mail:MajorMajor@foxmail.com 计算机工程 2013年9月15日 由于战场实时威胁信息的获取主要以机载雷达为主, 因此要使飞行器具有实时航迹规划能力,其探测距离须长 于威胁半径或是地面信息中心能够在飞行器进入突发威胁 区域之前为其提供相关信息。同时,受基于安全飞行曲面 思想的启发,可以将三维空间规划问题转换为二维规划问 题。动态路径规划示意图如图1所示。其中,D  ̄D 为静止 威胁区;Jl为突发威胁区;J2为移动威胁区;虚线圈为初始 威胁区域;点横线圈 为当前威胁区域。 图1动态路径规划示意图 3基本原理 本文动态航迹规划算法是基于战场态势预测分析的滚 动搜索粒子群优化算法。滚动规划思想是解决未知环境下 规划问题的一种常见办法 J,其具有实时性强、能充分利用 已探测到的局部信息以及计算量小的特点,将其与地面离 线规划中常用的粒子群优化算法相结合,能有效地改善局 部窗口路径搜索的适用性和最优性。通过对战场态势进行 预测分析、多步预规划、单步执行,能够对变化的战场态 势提早做出调整。由于执行的每一步都是当前最优的,因 此保证了整条航迹也是最优的。动态航迹规划求解框架如 图2所示。 图2动态航述规射求解框架 4战场态势预测及分析 将战场态势预测分析引入到实时规划中,可以提高算 法对环境适应的主动性。其分为2个部分:(1)对突发威胁 及运动威胁的态势预测;(2)任务目标的事件触发更新。通 过对威胁源及任务目标的预测分析,以为接下来的滚动规 划做准备。 4.1威胁态势预测 威胁的态势预测是通过预测威胁源的位置走势情况, 以此作为未来一段时间航迹规划的依据。其目的是尽量避 免将来与威胁源“相撞”,因此,需要估算出未来两者可 能相遇的最近时间点te,并将对应的时间段作为每次预测 的时间跨度tL,由于该时刻与无人机运动以及威胁源运动 三者之间存在耦合关系,因此每次更新都应该重新估算出 最近的相遇时刻te,每次预测的时间跨度tL也会有所不同。 有了te就可以反向推算出该时刻威胁源的位置 。规划窗 口每向前滚动一次,就需对当前窗口内的威胁态势更新一 次,更新周期 与滚动周期 一致。威胁态势预测如图3 所示。 图3威胁态势覆 设当前飞行器位置为向量,移动威胁源中心位置为向 量 d,将两者速度在固定坐标系上进行正交分解,可以想 象当飞行器在水平方向或是竖直方向“追上”威胁源运动 时,两者最有可能相遇,即飞行器落入威胁范围以内。由 两者相对运动关系,相遇时刻近似表示如下: (1)水平方向: tC+L,x t=c + + (S - R)c osO1‘3) ) (2)竖直方向: tC+Ly=tC+ (S - R)s in0 1 (‘4) ,式(3)、式(4)分别为按X方向和按Y方向估计出有可能 相遇的时间tc 、tc ,结果取距现在最近的时刻, c 为当前时刻。于是,相遇时刻威胁源中心位置的估计值 便为: I =XdC 3- 。(tc+三一tc) … 【 以= + v・(tc+fJ—tc) 其中, 、 为威胁源中心位置; 、 6 为威胁源 在更新周期内根据多个采样点所计算出来的速度预测值, 在此引入卡尔曼滤波对威胁源速度进行实时预测。 设状态向量 =[Xk Y Yk] 为威胁源中心 的位置和速度信息。由牛顿运动学定律写出以下状态方程 和观测方程: 第39卷第9期 杨俊,朱凡,张健,等:动态航迹规划关键技术研究 247 (1)状态方程: Xk+1= ・ +wk (6) (2)观测方程: Zk=Hk‘X k七yk (7) 状态转移矩阵 为: 1 0 0 0 1 0 : 0 0 1 0 (8) 0 0 0 1 观测矩阵巩为: r1 0 0 o7 1 0 0 f (9) 其中, 为滤波更新周期;估计误差 、观测误差 分 另0为状态方程和量测方程的随机干扰向量。两者均为零均 值正态自噪声序列,可用协方差矩阵 、 表示如下: :E[Wk・ 】 (10) Rk: ・ ] (11) 系统的滤波回路方程为: (1)系统状态预测: +1/k= +1. (1 2) (2)系统滤波估计: +l= +1/k+ +1( +1一 +1 +1/k) (13) 由于威胁的预测周期 与滚动周期 一样,2次更新 之间间隔相对较长,此时,状态转移阵 1若仍视为定 常矩阵将会出现失真。为了充分利用实时观测信息,可以 在一个滤波周期内抽取Ⅳ个采样值,用级数的方法来求取 +1.k : N-1  ̄k+l k J+△ ∑ ( ) (14) i=0 其中, ( )= (tk+iAT),i=0,1,…,N-1。 此外,增益计算回路方程如下: (1)误差协方差预测: = 1 一1 一1+ 1 (15) (2)增益系数: K℃: H Hk H +Rk 1 t16 (3)先验协方差更新: : ~Kk (17) 4.2目标概率对准 整个规划过程是滚动式更新过程,故每次局部路径更 新应设置相应的子目标点。子目标点不仅关系到局部窗口 路径规划的最优性,同时,对全局最优性也有一定影响。 从航迹初始段到末尾段,飞行器不断逼近任务目标,规划 的定向性也随之加强,当规划窗口滚动到最后时,窗口子 目标点也就是任务目标。由此,本文提出一种基于方差可 调的目标概率对准模式。概率对准模式示意图如图4所示。 圈4概率对准模式示意图 如图4所示,子目标的生成区域为以基准点为中心, 标准差为 的线区域段AB内,该区域内任意点被选为子目 标点的概率服从高斯分布。 1 一 f(Y)= e (18) Z兀D 随着飞行器与任务目标的逐渐接近,任务目标对局部 规划的影响逐步增大,因此,要不断减小随机子目标的生 成范围,使之向基准点靠拢。在此,可令目标候选范围 按 以下方式自适应调整: S} D ‘ ax (19) 0 这样在规划初始阶段放宽任务目标对局部规划的约 束,增大了规划灵活性,而在规划后期则加强规划的定向 性,以保证快速抵达目标。 5基于滚动粒子群的实时规划 滚动粒子群算法结合了滚动时域优化思想和粒子群优 化算法 J全局搜索思想,根据态势预测的信息,在滚动窗口 中反复利用改进粒子群优化算法更新搜索局部路径,使得原 本适用于离线规划的粒子群优化算法能用到实时规划中来。 5.1规划策略 整个算法分为窗口的滚动和窗口内局部路径的搜索更 新。从航迹起点到航迹终点,规划窗口滚动式前进,每向 前滚动一步都要根据先前预测的态势信息对窗13内的局部 路径进行搜索。将局部航迹进行编码,便可以将改进后的 粒子群优化算法引入到航迹的寻优过程中。对于每次规划 出的局部航迹,无人机只是执行其中的一部分,也就是所 谓的多步规划,单步执行。这样便保证了生成的航迹既有 一定的预见性,又有灵活调整的余地。 5.2航迹编码及代价函数 选定规划步长S,确定窗口大小三后,便可以得出规划 步数为N=L/s,相应的粒子的维数便为Ⅳ+1。对当前窗口建 立局部坐标系,如图4所示,由于每个航路点只能在对应 的垂线上游走,因此一条局部航迹用一组纵坐标即可表示, 每个粒子表示着一条航迹,编码如下: x=[Yl,Y2,…,YⅣ+1] (20) 每一条航迹的代价可描述为: 248 计算机工程 2013年9月15日 J=Ql。 ∑D(a ,ai+1)+Q2∑I4af,ai+1) i=1 i=1 (21) 5.4防早燕机制 针对粒子群优化算法后期容易出现的早熟停滞【l 情 况,本文提出一种早熟判断机制,一旦算法有早熟的趋势, 就用一个随机值代替当前最优解,以便扰乱粒子的当前搜 索方向,使其跳出局部最优。这样就可大大减少无效迭代 次数,从而实现算法的快速收敛。具体方法为:当得到的 其中,D(a ,af+1)代表2个相邻航路点的总威胁值; I4af,ai+1)代表两相邻航路点的总路程;K为等效系数,用 以解决威胁值与路径长度单位不统一;Q1、Q2为两者权 值。对于每段威胁值的计算,有以下近似: D(ai ,+ai 1):=』 ee‰ ∑— dl 圭冬盟. ・一SA (22) 早熟的趋势,此时,将当前最优解的任一维修改成一个随 最优解在连续K次迭代过程中都无变化时,便认为算法有 0i J l *Xmax ’ 威胁计算示意图如图5所示。 图5成胁计算示意图 有了代价函数便可进行粒子群算法迭代。每个粒子代 表着一条备选航迹,在设定好迭代次数后,当迭代完毕时, 对应的最优粒子即为所求的局部航迹段。算法的速度、位 置、惯性权重迭代方程如下: Pid(尼+1)=w(k)v ( )+qR1(Pia— (Ji}))+ c2R2(g —xia(k)) f23) fd( +1)= (尼)+ fd( +1)(24) W=Wma 一k。Wm /Ⅳ (25) 其中,P ga分别为粒子每一维历史最优位置和全局最优 位置;N为迭代总次数。 5.3正交视始化 初始化对粒子群优化算法的搜索结果有着较大的影 响,在通常情况下,为了使算法达到全局最优或准最优, 会将初始化种群数量选的大一些,但种群数量过大会降低 算法的执行速度,为此,本文提出一种基于正交实验设计 思想【9 的种群初始化方法。 正交实验设计的核心是均衡分布思想,力求用最少的 实验次数来达到最具代表性的实验效果。其基本设计工具 为正交表,它是运用组合数学理论所构造出来的一张表。 设一个实验有Ⅳ个因素,每个因素有Q个水平,那么 一个等水平的正交表可写为LM(g ),M表示不同水平的 组合数。本文将粒子的维数视为实验因素Ⅳ,粒子每一维 可取的纵坐标值视为每个因素的水平数Q,而粒子的种群 数视为 ,那么初始化的种群应均匀的分布在这个Ⅳ维空 间中,通过查表【1o]即可获得初始种群的分布位置,表示为 矩阵形式如下: (Q ):[ai]j Ⅳ ()26 ,其中,每一行代表一个粒子,也即一条航迹,行数则是种 群数。 机值。 Xg=[Yl,Y2,…,Yrk,YN+1](27) 其中,矩阵 为目前找到的全局最优粒子;Yrk为替换后 的随机扰动项,其大小和序号k都是随机产生的,为保证 规划的实时性,需要对算法迭代次数 进行限制,即实际 迭代次数不能超过最大迭代次数 ,m 。 5.5算法流程 算法具体规划步骤如下: (1)飞行器开始执行上一次规划的一个步长,同时,滚 动窗口将下一个航路点设为起点。 (2)根据当前规划周期内的多个量测值,对威胁源态势 进行预测更新。 ・ (3)检测任务目标有无变化,确定局部规划终点。 (4)运用改进粒子群优化算法进行局部规划: 1)设置各个参数。包括最大迭代次数 停滞判别计 数器SK、惯性权重初值%等。 2)正交初始化。根据给定的种群数量查表生成初始 种群。 3)迭代更新。根据代价函数进行算法更新。更新历史最 优解和全局最优解。 4)当前代数加1,对比当前最优解和全局最优解,检查 是否早熟。若有,则对最优解施加扰动。 5)检查是否达到最大迭代次数,若没有,则返回步 骤2),若有则退出本次迭代过程。 (5)更新下一周期航迹,等待飞行器执行。 6仿真结果及分析 在Matlab7.8环境下对算法进行仿真,在300 kmx 200 km的地形区域内,设置8个威胁区域,其中,D ~ D5分别为已知威胁;D6、D7为禁飞区;D8为静态突发威胁; D9为未知动态威胁(由北向南运动);G1为原定目标;G2为 临时修改后的目标。设定规划步长 =3 km,机载雷达探测 范围75 km,飞行速度250 m/s,初始种群数65,最大迭代 次数50次,威胁权重 和航程权重Q2分别为0.9和0.1, 所得的航迹效果图如图6所示,其中,细线圆圈D )7代 表固定威胁区域;粗线圆圈D8代表突发威胁区域;粗线圆 圈D9代表移动威胁作用区域;两粗线圆圈中心的连接线段 代表移动威胁D 区域中心的运动轨迹;标明圆心的为终止 第39卷第9期 吴怡之,刘文轩:基于GA的心电信号稀疏分解MP算法改进 253 1 024x30次内积运算,基于GA的MP改进算法的内积运 Algorithm with Variable Threshold[J].IEEE Trnasactions on 算量较之MP算法已有大幅度提高。而本文算法设信号的 Biomedical Engineering,1988,35(6):489・494. 种群进化代数Ngen=30,染色体个数n=21,每一代都会产 [3]Alesnaco l A,Olmos S,lstepanian R,et a1.A Novel Real Time 生一个最佳原子进入下一代,设每一段能量集中信号的长 Multilead ECG Compression and De—noising Method Based 度为 ,能量稀疏信号的长度为,,信号总长度为: on The Wavelet Transform[C]//Proc.of Computers in ,=∑ +∑,,,i=1,2,…, ;J=1,2,…,m Cardiology.Thessaloniki Chalkidiki,Greece:[S.n.],2003. 2类信号均使用30组原子重构,则内积的运算量为: 【4】Miaou S G,Chao Shu-Nien.Wavelet-based Lossy—to—lossless 30x(21—1)x30xZli+lOx(21一I)x3OxZ/, ECG Compression in a Uniifed Vector Quantization Frame— 可以看出,内积的运算量又降低了1/3,而较原始MP work[J].IEEE Transactions on Biomedical Engineering,2005, 算法的运算量更节省了1 000多倍。 52(3):539—543. [5]Huang Chunguang,Liu Jinjiang,Sun Jixiang.The Com— 表3算法内积运算量比较 pression Algorithm for Electrocardiogram Based on Sparse Decomposition[J].Chinese Journal of Biomedical Engineering, 2008,27(2):224—228. 【6]张静,方辉,王建英,等.基于GA和MP的信号稀疏 分解算法的改进[J].计算机工程与应用,2008,44(29):79—81. 5结束语 [7】 Wu Yanling,Zhang Hongxin,Wang Haiqing,et a1.The Sparse 本文分析心电信号的特征,给出心电信号的窗函数, Decomposition and Compression of ECG and EEG Based on 提出一种基于GA的心电信号稀疏算法的改进算法。实验 Matching Pursuits[C]//Proc.of the 3rd International Con— 结果证明了该算法的有效性。但本文算法性能只在Matlab ference on Biomedical Engineering and Informatics.Yantai, 仿真软件中实现,还未与实际嵌入式设备相结合,这可以 China:[S.n.],2010. 作为下一步的研究方向。 [8]Stephane G M,Zhang Zhifeng.Matching Pursuits with Time——Frequency Dictionaries[J].IEEE Transactions on 参考文献 Signal Process,1993,41(12):3397—3415. [1] Lee Sang-Joon,Kim J M,Myoungho L.A Real・time ECG [9】Davis L.Handbook of Genetic Algorithms[M].[S.1.】:Van Data Compression and Transmission Algorithm for an Nos ̄and Reinhold,1991. e-Health Device[J].IEEE Transactions on Biomedical [1O】孙宝亮,肖 亮,韦志辉.基于Gabor感知多成分字典的图 Engineering,2011,58(9):2448—2455. 像稀疏表示算法研究[J]_自动化学报,2008,34(1 1):173—178. [2】 Borivoje F Alex P An Adaptive Real—time ECG Compression 编辑刘冰 (上接第249页) 参考文献 究[D].长沙:国防科学技术大学,2007. 【1]Huang L.Velocity Planning for a Mobile Robot to Track a 【7] 秦永元,张洪钺,汪叔华.卡尔曼滤波与组合导航原理【M】. Moving Target_A Potential Field Approach[J].Robotics 西安:西北工业大学出版社,2007. and Autonomous Systems,2009,57(1):55—63. [8] Kennedy J,Eberhart R.Particle Swarm Optimization[C]//Proc. [2】Fox D,Burgard W,Thrun S.The Dynamic Window Approach of IEEE International Conference on Neural Networks.Perth. to Collision Avoidance[J].IEEE Robotics&Automation Australia:[S.n.],1995. Magazine,1997,4(1):32-33. [9] 汪荣鑫.数理统计[M】.西安:西安交通大学出版社,2004. [3】Uirich I,Borenstein J.VFH :Local Obstacle Avoidance with [1O] Leung Y W,Wang Yuping.An O ̄hogonal Genetic Algorithm Look-ahead Veriifcation[C]//Proc.of IEEE International with Quantization for Global Numerical Optimization[J]. Conference on Robotics and Automation.San Francisco,USA IEEE Transactions on Evolutionary Computation,2001,5(1): IEEE Press,2000. 41—53. [4】黄渤.对于自主移动机器人路径规划的模糊控制器[J】. Angeline P J.Evolutionary Optimization Versus Particle 计算机信息系统,2007,3(1):1-8. Swarm Optimization[C]//Proc.of the 7th International [55] 胡 昱,高金源.战术飞行轨迹优化方法[J].飞行力学, Conference on Evolutionary Programming VII.London,UK: 1997,1 6(9):7-12. Springer,1998. 【6】霍晓华.对多攻击无人机动态建模与滚动优化方法的研 编辑刘冰