一种改进的EKPF算法在固定单站无源定位中的应用
单站无源定位系统中EKF with u的应用
单站无源定位系统中EKF with u的应用作者:谢磊任海洋文剑澜来源:《电子技术与软件工程》2017年第15期摘要单站无源定位技术有着重要的军事应用价值。
而辐射源方位的获取技术(比如干涉仪、比幅)相对成熟、可靠、实现成本较低,所以基于纯方位的无源定位技术得到了广泛研究及应用。
本文采用带输入控制的卡尔曼滤波方法(EKF with u)对该定位系统进行了建模,初步探讨了系统估计和控制之间的交联问题。
【关键词】单站无源定位纯方位无源定位卡尔曼滤波1 引言电子支援措施(ESM)作为电子战的一部分,是利用敌方电磁辐射而采取的军事支援行动,包括对电磁信号的搜索、截获、识别、定位等,从而为其它军事行动提供依据。
在专用电子战侦察机、无人机等领域,对辐射源的无源定位得到广泛应用。
常见的无源定位分为单站定位和多站定位。
较之多站定位需要“多站之问同步时序、互传侦收结果”,单站定位的工程实现相对容易,因此备受关注。
纯方位定位是单站定位的基础,因其“设备简单、成本低”而应用广泛。
对纯方位定位系统的估计方法,大致分为:以最大似然估计方法(MLE)、最小二乘估计方法(LS)为主的非递归的批处理方法;以扩展卡尔曼滤波(EKF)为基础的递归方法。
2 EKF算法原理EKF算法具有”忽略历史数据”的优点,使得数据储存要求变低,非常适合工程应用。
而研究表明,观测平台的机动状态对系统估计有很大的影响,带有控制输入的扩展卡尔曼滤波(EKF with u)正好适合分析该影响。
考虑带有控制输入的离散时问非线性时变系统,将观测方程做一阶的泰勒式展开,可得近似线性时变方程,使用雅可比矩阵作为观测方程的系数矩阵,将非线性方程转化为线性方程。
3 Matlab仿真分析基于上述原理,构建系统仿真场景,见图1。
观测在不同速度(控制输入)下,定位收敛的情况:辐射源定位误差随观测更新次数k的变化如图2。
根据仿真可知,控制输入对系统估计的收敛速度、精度都有较大影响。
一种改进的EKPF算法在固定单站无源定位中的应用
一种改进的EKPF算法在固定单站无源定位中的应用申正义;王晴晴;王洪林;郭锐【摘要】本文针对EKPF算法在固定单站无源定位目标跟踪的应用中运算量大、实时性差的问题,通过对部分粒子进行EKF采样,将EKPF算法进行改进,改进的EKPF算法不仅有效降低了运算量,同时增加了粒子的多样性,使粒子集更能体现概率密度函数的真实分布.Matlab仿真表明,与传统的EKPF算法相比,改进算法在保证滤波性能基本不变的前提下,算法运算量大幅下降.【期刊名称】《火控雷达技术》【年(卷),期】2014(043)001【总页数】5页(P9-13)【关键词】粒子滤波;扩展卡尔曼滤波;固定单站无源定位;部分采样【作者】申正义;王晴晴;王洪林;郭锐【作者单位】空军预警学院武汉430019;空军预警学院武汉430019;空军预警学院武汉430019;空军预警学院武汉430019【正文语种】中文【中图分类】TN970 引言有源雷达在现代战争中面临着电子干扰、反辐射攻击、低空超低空突防和隐身技术等一系列新的威胁。
无源定位系统本身并不向外辐射电磁波,具有受环境影响小、隐蔽性强和作用距离远等优点。
仅利用单个固定观测站接收目标辐射源辐射的信号来估计目标位置和运动状态的过程称为固定单站无源定位与跟踪。
相对于多站系统,固定单站无源定位系统只需一个无源信号接收站,且不需要数据通信传输,具有更强的隐蔽性,且设备简单、系统相对独立,作为目标探测发展的重要方向和对有源雷达系统的完善和补充,将在现代电子战中发挥越来越重要的作用[1-3]。
利用角度、相位差变化率、频率和多普勒频率变化率信息实现固定单站无源定位,是一种快速高精度的定位方法。
但参数测量都带有误差,为实现快速高精度的固定单站无源定位,除了要有高精度的参数测量技术外,还需要研究高性能的跟踪滤波算法,以便最大限度地利用观测量提供的目标运动信息,同时也可减轻对参数测量技术的压力。
固定单站无源定位目标跟踪是典型的非线性滤波过程,经典的滤波算法是扩展卡尔曼滤波(Extended Kalman Filter,EKF),但EKF算法存在线性化误差大,严重依赖于初始状态的选择,协方差矩阵易出现病态等问题。
基于改进平方根UKF双向滤波的单站无源定位算法
基于改进平方根UKF双向滤波的单站无源定位算法张智;姜秋喜;孙志勇【摘要】Because of the low observability and the high noise in single observer passive location, the performance of the positioning accuracy,stability and convergence velocity is poor. Based on the Square-Root Unscented Kalman Filter (SRUKF)and the backward smoothing method,a forward-backward filter based on improved SRUKF is presented. To improve the stability and the calculate efficiency of the algorithm,theQ-R decomposition is adopted,and the covariance square-root matrix is used instead of the covariance matrix. Meanwhile,the state vector is augmented. The process noise and measurement noise are propagated through the nonlinearity system. The negative influence of noise on the filtering accuracy is decreased. The more accurate initial value for the next filtering process was obtain by the use of the current filtering results,based on the Rauch-Tung-Striebel(RTS)backward smoothing method. The positioning accuracy and the convergence velocity is improved. Simulation results indicated that the novel algorithm improved the single observer passive location performance while keeping the real-time characteristic.%针对单站无源定位可观测性弱、观测噪声大而导致的定位精度低、稳定性差和收敛速度慢等问题,在结合平方根无迹卡尔曼滤波(Square-Root Unscented Kalman Filter, SRUKF)以及后向平滑思想的基础上,提出了一种改进SRUKF的双向滤波算法。
一种基于空域和频域信息的固定单站无源定位跟踪改进算法
et ae h e c yvco o te mie va h s d -ier a n ie (L F a oi m, h hcnb s m t te l i etr fh t r i tePe oLna l i vo t e t u K ma Fl r P K ) l r h w i e t g t c a
u e o o t i h o ii n v c o , h l a le o i p o e t e l c to c r y b a i g t e e tma i n s d t b a n t e p sto e t r t e Kam n f t ri t i s m r v h o a i n a u a y t k n h s i t c c o o e p sto e t ra a u e e t ; h o f h o ii n v o me t c s s r m n s t ec mp t r i u a i n h w h tt em e h d ha i h l c to c r y u e m l to ss o t a h t o s h g a i n a u a s o c c a d f tc n e g n e s e d n a o v r e c p e . s
n n mo i go s r e . i t o r ty t k sf l d a t g f h p ta n o - v n b e v r Th sme h d f s l a e v n a e o es a i l d ̄e u n y c a g n f r to o i ul a t a q e c h n i gi o ma i n t n
一
种基 于空域和频域信息 的固定单站 无源定位跟踪改进算法
一种改进的单站无源定位与跟踪算法
一种改进的单站无源定位与跟踪算法
邓晓明;徐毓
【期刊名称】《现代电子技术》
【年(卷),期】2004(27)22
【摘要】无源定位与跟踪技术有着广阔的应用前景.对于机动干扰源单站无源定位与跟踪,直角坐标系下一阶卡尔曼滤波算法容易发散,二阶卡尔曼滤波算法运算量大.针对这一不足,本文提出了在极坐标下建立状态方程和观测方程的卡尔曼滤波进行干扰源单站无源定位与跟踪.仿真实验结果表明了该算法的有效性.
【总页数】2页(P83-84)
【作者】邓晓明;徐毓
【作者单位】空军雷达学院,湖北,武汉,430019;空军雷达学院,湖北,武汉,430019【正文语种】中文
【中图分类】TP301.6
【相关文献】
1.一种固定单站对运动辐射源的无源定位跟踪算法 [J], 李宗华;冯道旺;周一宇;孙仲康
2.基于PLKF的固定单站无源定位与跟踪算法研究 [J], 曲长文;徐征;王洋;王国宏
3.一种单站无源定位原理与目标跟踪算法研究 [J], 乔梁
4.一种单站瞬时无源定距技术研究 [J], 黄光明;徐汉林
5.基于UKF的单站无源定位与跟踪算法 [J], 袁罡;陈鲸
因版权原因,仅展示原文概要,查看原文内容请购买。
EKF滤波组合模型建立及在北斗伪距定位中的应用
EKF滤波组合模型建立及在北斗伪距定位中的应用自从1960年Kalman等人提出卡尔曼滤波的基本原理以来,卡尔曼滤波就成了线性估值领域的重要算法。
由于现实中的问题大多都是非线性的,1968年Sunahara等人对卡尔曼滤波进行了变形和扩展,使其能够解决非线性估值问题,此后被广泛应用到导航定位领域。
抑制EKF滤波发散,提高EKF滤波估值精度一直以来就是导航定位领域研究的热点。
目前抑制EKF滤波发散的方法都是针对滤波发散前处理卡尔曼增益来抑制滤波发散,对于EKF滤波发散后处理问题的研究并不多见,不能完全保证滤波迭代的全局收敛性。
本文采用的EKF滤波组合模型是一个有效的解决办法。
对于EKF滤波主要研究两个问题:滤波初始值设置和抑制滤波发散。
对于滤波初始值设置,论文“第四章第1节组合模型EKF滤波初始值的精度分析”部分,从精度和计算效率两方面对滤波初始值设置常用方法进行了对比分析,实验证明,相比其他初始值计算方法WLS法能够更好的兼顾初始值的偏差和解算效率,因此,EKF滤波组合模型的滤波初始值选取WLS法计算;对于抑制EKF 滤波发散的方法,论文第三章“3.2抑制EKF滤波发散的常用方法”部分对此有比较详细的介绍。
3.3节从估值精度和解算效率的角度,对调节增益法、衰减记忆法、限定记忆法、预测误差协方差加权法、自适应法进行对比分析,综合考虑估值精度和解算效率,自适应法是几种方法中最优的。
对于滤波发散后处理方式,在EKF滤波组合模型中引入新息矩阵配合WLS法来解决滤波发散后处理问题。
通过新息公式判断滤波发散要比目前常用的估值分量突变方式计算量小,运算效率高。
而滤波发散后运用WLS法计算滤波迭代初始值,重新迭代解算,能够更好的保证EKF滤波组合模型的全局收敛性。
鉴于以上分析,本文选取WLS法、新息公式、自适应法以及L-M法建立了EKF滤波组合模型,EKF滤波组合模型选取WLS 法作为EKF滤波初始值的计算方法,能够有效的减小EKF滤波初始值的计算偏差,从而大幅度提高了EKF滤波的迭代速度;在EKF滤波迭代过程中,利用L-M算法对EKF滤波预测协方差阵进行修正,有效的保障状态观测的估值误差逐渐减小,抑制了滤波的发散;EKF滤波组合模型中还设计了WLS法结合新息公式判断滤波发散,滤波发散时利用WLS法重新计算滤波初始值,恢复EKF滤波迭代,解决了滤波发散后处理问题,即使观测量短暂缺失依然能够保证EKF滤波组合模型的全局收敛性。
一种改进的基于EKF的天文自主定轨算法[发明专利]
专利名称:一种改进的基于EKF的天文自主定轨算法专利类型:发明专利
发明人:张淼,沈毅,赖镇洲,崔捷,候奉博
申请号:CN201310419075.9
申请日:20130916
公开号:CN103438892A
公开日:
20131211
专利内容由知识产权出版社提供
摘要:一种改进的基于EKF的天文自主定轨算法,涉及一种控制领域的导航方法。
所述方法步骤如下:一、EKF滤波器参数初始化;二、参考坐标系由地心惯性坐标系转为滤波坐标系;三、在滤波坐标系中线性化和离散化滤波器状态方程;四、在滤波坐标系中进行EKF滤波;五、参考坐标系由滤波坐标系转回为地心惯性坐标系。
本发明在传统的基于EKF天文自主定轨算法中,提出并引入滤波坐标系,同时增加坐标变换和坐标反转换等步骤使得传统的基于EKF天文自主定轨算法在线性化和离散化的时候,航天器的位置矢量在滤波坐标系中的各分量能够相等,从而使得状态方程线性化的展开点处于一个线性度较好的位置,进而使得定轨算法的稳定性有所提高。
申请人:哈尔滨工业大学
地址:150000 黑龙江省哈尔滨市南岗区西大直街92号
国籍:CN
更多信息请下载全文后查看。
一种基于多普勒频率变化率单站无源定位的改进跟踪滤波算法
一种基于多普勒频率变化率单站无源定位的改进跟踪滤波算法谈欣荣;高宪军;李宝珠;王宇【摘要】IMM-PF算法巨大的计算量影响跟踪的实时性,IMM-UKF由于线性化误差使得精度不高.针对这些问题,本文在基于多普勒频率变化率的单站无源定位问题的基础上提出了一种改进的交互式多模型滤波算法(IMMEK-UKFPF),利用不同的模型匹配不同类型的滤波器,充分发挥了卡尔曼滤波和无迹卡尔曼滤波以及粒子滤波各自的优点.仿真结果表明该算法减少了跟踪定位所用时间,提高了计算效率,同时具有良好的跟踪性能和较强的鲁棒性.【期刊名称】《电子设计工程》【年(卷),期】2014(022)008【总页数】4页(P77-80)【关键词】多普勒频率变化率;无源定位;粒子滤波;交互式多模型【作者】谈欣荣;高宪军;李宝珠;王宇【作者单位】空军航空大学研究生队,吉林长春130022;空军航空大学科研部,吉林长春130022;空军航空大学研究生队,吉林长春130022;空军航空大学军事仿真技术研究所,吉林长春130022【正文语种】中文【中图分类】TN953无源定位技术是一种定位设备本身并不主动发射信号,而仅仅依靠被动接收辐射源的信息来实现定位的技术[1]。
单站无源定位主要有两个方面的难点:一是相对较少的测量信息使得单一时刻的测量信息无法实现对目标辐射源的相对定位;二是目标辐射源复杂的运动形式使得精确的跟踪方程难以建立,从而影响跟踪算法的精度。
针对上述困难,本文选择了基于多普勒频率变化率的无源定位方法进行定位。
但是光靠单站无源定位技术还不足以获取运动目标连续的位置信息,需要进行有效的跟踪滤波。
在机动目标跟踪领域,交互式多模型(IMM)算法[2-3]被认为是迄今为止最有效的算法之一。
交互式多模型算法考虑了模型的特点,它假设目标有多种运动状态,每一种运动状态对应一种模型,目标在任意时刻的运动状态都可以用给定模型中的一种来表示,而运动状态的变化也就是运动模型之间的切换用齐次马尔可夫链表示,目标的滤波结果是多个模型滤波结果的加权综合。
固定单站无源定位系统的可行性研究的开题报告
固定单站无源定位系统的可行性研究的开题报告1.研究背景随着社会的发展和科技的进步,无线定位技术在各行各业中得到了广泛的应用。
尤其是无线定位技术在物流配送、车辆管理、个人定位、地震监测等领域中的应用越来越广泛。
在无线定位技术中,定位系统的精度、稳定性和可靠性都是十分重要的因素。
目前,最为常见的定位系统是基于GPS技术的,但是GPS技术在城市峡谷和室内环境等复杂环境下的定位精度受限,因此需要开发一些新的无线定位技术来弥补其不足。
其中,固定单站无源定位系统便是一种十分可行的方案。
2.研究意义固定单站无源定位系统是一种能够实现高精度定位的无线定位技术,其在实际应用中有着很广泛的潜力。
例如,该系统在车辆管理中的应用,可以对车辆进行实时位置监控,从而提高运输效率和安全性;在地震监测中的应用,可以通过采集地震波形信号,对地震的发生时间和位置进行精确的测定,为科学家们提供宝贵的地震学数据。
因此,开展固定单站无源定位系统的可行性研究,具有非常实用和重要的意义。
3.研究内容本次论文的研究内容主要包括以下方面:(1)对固定单站无源定位系统的工作原理、系统组成进行分析和研究;(2)通过MATLAB软件进行仿真实验,分析无源定位系统的信号采集、信号处理、定位精度等关键参数的影响;(3)构建一个固定单站无源定位系统的实验平台,对其进行测试,对实验结果进行分析比较;(4)通过实验结果,进一步探究固定单站无源定位系统的优缺点和局限性,提出改进方案。
4.研究方法本次论文研究采用的是实验研究方法和仿真研究方法相结合的方式。
首先,通过文献调研和理论分析,对固定单站无源定位系统的工作原理和系统组成进行深入研究,并通过MATLAB软件进行仿真实验;其次,构建一个实验平台,对固定单站无源定位系统进行实际测试,并对实验结果进行分析比较;最后,综合实验结果和仿真实验结果,探究固定单站无源定位系统的优缺点和局限性,并提出改进方案。
5.预期目标通过本次论文的研究,预计可以达到以下目标:(1)深入了解固定单站无源定位系统的工作原理和系统组成;(2)通过MATLAB软件进行仿真实验,分析无源定位系统的信号采集、信号处理、定位精度等关键参数的影响;(3)构建一个固定单站无源定位系统的实验平台,并对其进行测试,掌握固定单站无源定位系统的工作流程和性能;(4)分析固定单站无源定位系统的局限性和不足,并提出可行的改进方案,推动无源定位技术的发展。
一种改进的基于UKF的单站无源定位方法
X −
(n +1) PX , (n +1) PX ,
i=0 i =1, 2,, n i =n +1, n + 2,, 2n
wim
=
n
λ +
λ
,
1
2(n + λ )
,
i=0 i = 1, 2,, 2n
(7)
( ) wic
=
λ n + λ
+
1−α
2
(
1 n+
λ
)
,
2
+
β
,
i =0 i = 1, 2,, 2n
定位。若两次观测时,传感器位置为(xk-1, yk-1)、(xk, yk),所测量得到的来波到达角度为 θk-1、θk,两条方 向的射线可以交于一点,该点即为目标的位置估计。
根据角度定义可以得到:
( ) yT − yk−1 tgθk−1 = xT − xk−1 ( yT − yk )tgθk = xT − xk
(6)
其中,ηk 表示观测噪声,这里假定为零均值加性高斯白噪声,并且误差矩阵为 R。由于观测模型的 高度非线性,采用扩展卡尔曼滤波不能满足稳定要求,极易发散。在此我们采用 UKF 无迹卡尔曼滤波进 行处理。
基于EKF和PF的多机器人协同定位技术
基于EKF和PF的多机器人协同定位技术田红兵;樊光南;宋龙【期刊名称】《现代电子技术》【年(卷),期】2013(000)023【摘要】无论对于单机器人还是多机器人系统,定位能力是其完成各项任务的前提条件。
针对常用定位技术难以满足移动机器人群体协同定位精度高、实时性强等要求,提出了一种基于扩展卡尔曼滤波(EKF)和粒子滤波(PF)的混合定位技术。
首先,对机器人进行运动建模,然后分别讨论基于扩展卡尔曼滤波和粒子滤波的机器人协同定位的基本原理、优缺点,在此基础上提出基于扩展卡尔曼滤波和粒子滤波相结合的协同定位方法。
结果表明,该算法在满足一定条件下可有效解决定位精度与运算量之间的矛盾,可实现在初始条件未知或存在较大误差情况下多机器人快速、精确地协同定位。
%The positioning capacity is a prerequisite to complete the tasks,no matter for single-robot or multi-robots sys-tems. Itis difficult for common location technique to meet the requirements of mobile robot groups in high co-localization accura-cy and strong real-time.A hybrid location technique based on Extended Kalman Filter(EKF)and Particle Filter(PF)is pro-posed. The multi-robots are motion modeling,then the basic principle of robot co-localization based on EKF or PF and theirad-vantages and disadvantages are discussed respectively. On thisbasis,another co-localization based on the combination of EKF and PF is proposed. The experiment result shows that this method is effectively in solving the contradiction between positioning accuracy and calculationunder some condition. And when the initial condition is unknown or the errors is large,the multi-robots co-localization can also be rapidly and precisely.【总页数】4页(P95-98)【作者】田红兵;樊光南;宋龙【作者单位】兰州理工大学计算机与通信学院,甘肃兰州 730050;兰州理工大学电气工程与信息工程学院,甘肃兰州 730050;兰州理工大学电气工程与信息工程学院,甘肃兰州 730050【正文语种】中文【中图分类】TN710-34;TP332.3【相关文献】1.基于分散式EKF的多机器人协同定位 [J], 卓书芳;何用辉;吴燕峰2.基于EKF的AUV协同定位方法仿真与验证 [J], 孙睿智3.一种基于分布式EKF的多机器人协同定位方法 [J], 张鑫;刘玉东;巨永锋4.基于分散式EKF的多机器人协同定位 [J], 卓书芳;何用辉;吴燕峰;5.采用EKF与PF的室内融合定位技术 [J], 张雨婷; 陈璟因版权原因,仅展示原文概要,查看原文内容请购买。
UKF算法在单站无源定位与跟踪中的应用
专 题 技 术 与工 程 应 用
U KF算 法 在 单 站 无 源定 位 与跟 踪 中的应 用
窦修 全 张建 立 国辛 纯 , ,
(. 1 中国 电子 科技 集 团公 司第 5 4研 究所 , 河北 石 家庄 0 0 8 50 1; 2 天津 大学 电子信 息工程 学 院, 津 30 7 ) . 天 0 0 2
摘 要 提 出 了相 位 差 与 无 迹 卡 尔 曼 ( K ) 法 相 结 合 的 单 站 无 源 定 位 方 法 。 把 2个 相 互 正 交 的 相 位 干 涉 仪 测 量 出 目 U F算
标 辐射 电磁 波 的相 位 差 信 息 作 为 观测 量 , 用 U F滤 波算 法 加 以 处 理 , 粗 略 定 位 结 果 进 行 修 正 和 平 滑 , 步 估 计 出 目标 的 采 K 对 逐 位 置 和速 度 , 实 现 对 辐 射 源 目标 的快 速 高精 度无 源 定 位 。U F与 传 统 的 E F滤 波 算 法 相 比 , 用 计 算 雅 克 比 矩 阵 , 现 简 来 K K 不 实
Ab ta t A e sn l—tto a sv o ain meh d c mbnig p a e i e e c nd UKF lo tm s p ee td. h to a e sr c n w ige sain p sie lc t to o i n h s df rn e a o ag rh i i rs ne T e me d tk s h
s e da d hg rlc t n p e iin. p e n ihe o ai rcso o Ke r s UKF g rt ;p a e dfee c y wo d l i a o hm h s ifrn e;snge sain p sie lc t n;Kama le n i l— tt a sv o ai o o l n f tr g i i
基于MGEKF的单站无源定位跟踪算法
基于MGEKF的单站无源定位跟踪算法
陈立万;廖海军
【期刊名称】《火力与指挥控制》
【年(卷),期】2009(034)006
【摘要】单站无源定位跟踪技术具有隐蔽性强、设备简单,系统相对独立等优点,有着广阔的应用前景.为了提高定位精度和收敛速度以满足实时化需求,在现有的基于多普勒变化率的单站无源定位算法的基础上.详细推导了基于MGEKF的定位算法以解决EKF算法的不稳定性,并通过计算机仿真比较了两种算法的性能,结果表明MGEKF定位算法提高了定位精度、收敛速度和稳定度,定位结果能够满足实际需求.【总页数】4页(P51-53,56)
【作者】陈立万;廖海军
【作者单位】重庆三峡学院应用技术学院,重庆,404000;重庆三峡学院应用技术学院,重庆,404000
【正文语种】中文
【中图分类】TN97
【相关文献】
1.基于平方根UKF的机载单站无源定位跟踪算法 [J], 司记伟;潘莉莉;刘嗥
2.基于修正SUKF的固定单站无源定位跟踪算法 [J], 申正义;王晴晴;王洪林;张建华
3.基于CKF的单站无源定位跟踪算法 [J], 霍光;李冬海
4.单站无源定位MGEKF和MVEKF算法的分析比较 [J], 乔梁
5.基于DOA与TOA的固定单站无源定位滤波跟踪算法研究 [J], 黄凯
因版权原因,仅展示原文概要,查看原文内容请购买。
基于EKF和PF的多机器人协同定位技术
基于EKF和PF的多机器人协同定位技术作者:田红兵樊光南宋龙来源:《现代电子技术》2013年第23期摘要:无论对于单机器人还是多机器人系统,定位能力是其完成各项任务的前提条件。
针对常用定位技术难以满足移动机器人群体协同定位精度高、实时性强等要求,提出了一种基于扩展卡尔曼滤波(EKF)和粒子滤波(PF)的混合定位技术。
首先,对机器人进行运动建模,然后分别讨论基于扩展卡尔曼滤波和粒子滤波的机器人协同定位的基本原理、优缺点,在此基础上提出基于扩展卡尔曼滤波和粒子滤波相结合的协同定位方法。
结果表明,该算法在满足一定条件下可有效解决定位精度与运算量之间的矛盾,可实现在初始条件未知或存在较大误差情况下多机器人快速、精确地协同定位。
关键词:多机器人系统;协同定位;扩展卡尔曼滤波;粒子滤波中图分类号: TN710⁃34; TP332.3 文献标识码: A 文章编号: 1004⁃373X(2013)23⁃0095⁃04Multi⁃robots co⁃localization technique based on EKF and PFTIAN Hong⁃bing1, FAN Guang⁃nan2, SONG Long2(1. College of Computer and Communication, Lanzhou University of Technology, Lanzhou 730050, China;2. College of Electrical and Information Engineering, Lanzhou University of Technology,Lanzhou 730050, China)Abstract: The positioning capacity is a prerequisite to complete the tasks, no matter for single⁃robot or multi⁃robots systems. It is difficult for common location technique to meet the requirements of mobile robot groups in high co⁃localization accuracy and strong real⁃time. A hybrid location technique based on Extended Kalman Filter (EKF) and Particle Filter (PF) is proposed. The multi⁃robots are motion modeling, then the basic principle of robot co⁃localization based on EKF or PF and their advantages and disadvantages are discussed respectively. On this basis, another co⁃localization based on the combination of EKF and PF is proposed. The experiment result shows that this method is effectively in solving the contradiction between positioning accuracy and calculation under some condition. And when the initial condition is unknown or the errors is large,the multi⁃robots co⁃localization can also be rapidly and precisely.Keywords: multi⁃robot system; co⁃operative localization; EKF; PF0 引言随着人工智能、计算机、传感器等技术的不断发展,移动机器人的研究及应用得到了前所未有的进步。
一种改进的单站无源定位算法
( L n r ao nier gU i rt, h nZ o 5 0 2 C i ) P A I om t nE g ei nv sy Z eg hu4 0 0 , hn f i n n ei a
A s a t igeo sre asv o a zt n a d t c ig( O [ T)tc nq eh e o r b t c :Sn l b evrpsielc l ai n r kn S P A r i o a eh iu a bc memoe s
21 0 0年 第 2期
2 1 N 2 0 0, o.
电
子
对
抗
总 第 11 3 期
S re o. 3 e i8 N 1 1
E EC ONI WARF E L TR C AR
一
种 改进 的单 站 无 源 定 位算 法
华铁 洲 李冬 海 陈剑 宇
( 解放 军信 息工 程 大学 , 州 4 00 ) 郑 50 2
u n yc a g eb sdo xe d d K l a l q e e hn ert ae netn e am n ftr( K )i a a zd. htel l zt lo l c o o rh i i rvduige t d dK l a l rb e .n plrcodn ts( C—E F . ecmp tr i m s mpoe s xe e am nft a do oa oria t n n ie s e P K ) T o ue h
adm r pp l re l azt n e . it te grh n eos e ps v c i t n n o oua i t gtol ao l Fr ,h o tmo s g be r as e oaz i e rn a c i i f d s i l a i f il v r i l l ao cm ie i g hnere hs ie necag t,D pl eunyadD pl e o bndwt al cag t,paed fr c hner e op r r ec n ope f - hn e a f e a e fq rr
改进EKF算法在固定单站被动目标跟踪中的应用
性 化 展 开点 及 雅 可 比 矩 阵取 值 点对 线 性 化 逼 近 误 差 的影 响 , 然后 对传 统 E K F算 法 的线 性 化展 开方 式 进行 优 化 , 提 出一 种 基 于 中值 定 理 的后 向平 滑 B S — E K F算 法 .仿 真 结 果表 明 , 与传 统 E K F 相比 , 该 算 法在 时 间复 杂度 上 略 有 增加 , 但稳定性、 滤 波精 度 和 收敛 速度 有 所提 高 , 适 用 于对 定位 精度 要 求较 高的 情 况. 关键 词 : 中值 定 理 ; 后 向平 滑 ; 扩 展 卡 尔曼滤 波 ; 固定单 站被 动 目标 跟 踪
P F算 法 的 运 算 量 较 大 , 实时性 较差 .E K F算 法
阵兀 o ( o , 0 )
阵兀l ( 0 )
图1 二 维 平 面 固定 单 站 无 源 定 位 几 何 示 意 图
1 . 2 目标 跟踪模 型 设 为 观 测 间 隔 , 处 在 巡 航 状 态 的 目标 辐
由 于 固定 单 站无 源 定 位 系 统 的 测 量 方 程 为 非 线
性 系统 , 考 虑系统 噪声 、 观测 噪声 、 系 统 模 型 误
差 的存 在 , 需 要 通 过适 当 的滤 波 跟 踪算 法 来 对 预
测 结 果 进 行 修 正 . 在 固定 单 站 被 动 目标 跟 踪 技
强 , 隐 蔽性 更 好 .对 于 固定 观测 站 , 当 目标 运 动且 满 足 可 观 测 性 时 , 就可 以对 目标 进 行跟 踪 .
v 为 径 向速 度 , s为 目标 航 向 , r为 目标 辐 射 源 相 对 径 向距 离 , 为信 号到 达角 , d为 基 线 长 度 .二 维 平 面 固定 单 站 无 源 定 位 几何 关 系 如 图 1 所示 , 本文采用角度 、 相 位 差 变 化率 、 多普 勒 频 率 变 化 率 为 观测 量 的 固定 单 站无 源 定 位 方法 .
基于改进EKF的室内机器人充电站自主定位方法研究
基于改进EKF的室内机器人充电站自主定位方法研究
李瑞峰;张文杰;赵立军
【期刊名称】《机电一体化》
【年(卷),期】2010()5
【摘要】针对智能机器人自主寻找充电站充电时对充电站位置的定位和自定位问题,采用红外定位模块与里程计定位信息进行数据融合,分析并建立了两轮驱动室内
移动机器人的运动模型与观测模型,利用有限差分线性化方法和小循环迭代结构改
进了扩展卡尔曼滤波方法,一方面提高了机器人对目标充电站定位和自身定位的精度,同时减小了因增加计算量而造成的时间损失。
仿真实验证明,采用改进方法可使
机器人的自定位误差均方差减小约20%,对充电站位置定位的误差控制在约4 cm。
【总页数】5页(P35-39)
【关键词】室内移动机器人;自主充电;自主定位;扩展卡尔曼滤波
【作者】李瑞峰;张文杰;赵立军
【作者单位】哈尔滨工业大学机器人技术与系统国家重点实验室
【正文语种】中文
【中图分类】TP242.6
【相关文献】
1.自主移动机器人室内定位方法研究综述 [J], 高云峰;周伦;吕明睿;刘文涛
2.一种基于分布式EKF的多机器人协同定位方法 [J], 张鑫;刘玉东;巨永锋
3.基于改进ICP算法的移动机器人室内激光扫描定位方法 [J], 华豪; 葛孟媛
4.基于改进MSCKF算法的室内机器人定位方法 [J], 孙弋; 张雪丽
5.基于改进ICP算法的移动机器人室内激光扫描定位方法 [J], 华豪; 葛孟媛
因版权原因,仅展示原文概要,查看原文内容请购买。
MIEKF优化算法在GPS定位测速中的应用
文章编号 :1006—9348(2018)07—0O65—05
计 算 机 仿 真
2018年7月
MIEKF优 化 算 法在 GPS定 位 测 速 中 的应 用
彭雅 奇 ,许 承 东 ,李 臻 ,赵 靖
(北京理工大学宇航学 院,北京 100081)
摘要 :为了提高 GPS定位测速的精度 ,引入了迭代扩展卡尔曼滤波(IEKF)算法 。针对上述算法存在受状态初值影 响的问题 以及 在迭代 过程中存 在稳定性不 足的缺点 ,提 出基 于最小二乘 ( )和 Levenberg—Marquardt(L—M)方法的改进迭代 扩展卡尔 曼滤 波(MIEKF)优化算法。先用 Ls算法对用户接收机初始状态进行估算 ,然后在 IEKF算法解算 过程 中利用 L—M 方法调 整预测协方差矩 阵,以保证算法具有全局收敛性 ,最后采用 GPS星历 数据进行仿真对 比实验 。通过对仿真结果 的分析 ,证 明 MIEKF优化算法 能够提 高 GPS定位测速精度 。改善收敛性能。 关键 词:卫 星导航 ;最dx--乘 ;迭代扩展卡尔曼滤波 ;优化算法 中图分类号 :TN967.1 文献标识码 :B
3.1 LS算 法 算法是将所有 的观测量放在一起处理 ,是 残差平方 和
达 到 最 小 意 义 下 的 线性 无偏 估 计 。设 第 k个 历元 待定 位 置 和 速度坐标近似值分别为 (xio,yr加,z )和 ( 焉, 未, 磊),利用 泰 勒 级 数 将 伪 距 方 程 和 多 普 勒 方程 进 行 线 性 化 展 开 为
2.1 伪 距 单点 定 位 GPS接收机测量的是 信号从 卫星 到用户 接收 机的传 播
时间 ,由于用 户接 收机时钟 与卫 星时钟 不 同步 ,并 且计 时相 互独立 ,所以这种测 量是有 偏差 的 。通过用 真空 中光速 与测 得 的传播时 间相乘 ,就得 到存在 一定偏 差 的传 播距 离 。即伪 距 。设伪距单点定位的观测方程 [1 为
基于纯角度信息的单站无源定位算法
基于纯角度信息的单站无源定位算法作者:曹志亮来源:《电子技术与软件工程》2017年第10期本文研究了在纯角度测量信息下地面干扰源的单站无源定位问题,给出了一种新的基于纯角度信息的非线性滤波无源定位算法。
该算法首先利用载机初始位置和目标角度测量值,计算得到初步的目标状态值和状态协方差值,其次用这些信息来初始化扩展卡尔曼滤波器,最后运用扩展卡尔曼滤波器进行非线性滤波,得到高精度的目标定位结果。
经过仿真结果分析,该算法具有收敛速度快、定位精度高的特点,能够较好的满足工程实际的应用要求。
【关键词】纯角度无源定位非线性滤波器无源定位是雷达等传感器在无法获得目标的距离、速度等信息的情况下,通过可以测得的目标回波或干扰信号的到达角信息,采用特殊的滤波算法以实现对目标定位的一种技术。
由于其具有电磁隐蔽性好、反电子侦察能力强等特点,因此这种技术在电子情报(ELINT)系统和电子战(EW)中,得到了广泛的应用。
无源定位系统根据参与的被动传感器的数目,可分为多站无源定位和单站无源定位。
单站纯角度无源定位是利用机载平台上的测角系统,在飞行航线的多个观测点上对地面同一辐射源目标进行探测,将获得的一组方位角、俯仰角测量信息按照非线性滤波算法进行处理,获得辐射源的位置估值。
单站无源定位技术因具有隐蔽性强,设备量小,作用距离远,覆盖地域大,机动性能好等特点,更为重要的是避免了复杂的时间同步和多个观测站之间的数据融合而备受重视,对现代信息战有着极其重要的军事意义。
本文通过研究基于测向交叉非线性滤波的单站无源定位算法,解决实际工程应用中遇到的海面干扰源目标定位问题,该算法可以推广到地面固定或慢速辐射源定位问题的解决。
文章中首先介绍了基于测向交叉定位的原理,接着介绍了基于测向交叉非线性滤波算法,给出了该算法的状态模型、观测模型、EKF处理算法和状态初始值的确定,最后做了Monte-Carlo仿真,以验证该算法的有效性和可行性。
1 机载单站无源定位技术的原理和方法机载雷达是基于单站无源定位技术来实现对地面或海面干扰源目标定位。
PF、EKF算法在目标跟踪中的研究
上 能 够 逼 近满 足 任 何 状 态 分布 的后 验 概 率 密 度 ,十 分 灵 活 , 因此 受 到 了广 泛 关 注 _2]。
2扩展 卡 尔曼滤 波 EKF 扩 展 卡 尔 曼 滤 波 (EKF)算 法 的
主 要 思 想 是对 非线 性 函 数进 行一 阶 线 性 化 处 理 ,忽 略其 高 阶 项将 线性 化 问 题 转 化 为 非 线 性 问题 【3]。 具体 方式 为 对 非线 性 函数 进行 一阶 泰勒 级 数展 开 , 保 留一 阶项 部 分其 余高 阶项 全 部忽 略 , 从 而 将 非 线 性 问题 转 化 为 线 性 问题 。 定义 以下模 型 :
法 往 往 不 能 实现 [1]。 目前 ,针 对 非 线 性 问题 的处 理 ,可 以通 过 扩 展 卡 尔曼 滤 波 (EKF)算 法 来 处 理 。EKF算 法 的基 本 思 想 是对 非线 性 问题 进 行 一 阶 Taylor展 开 进 行 线 性 化 处 理 , 忽 略 高 阶项 ,然 后 进 行 卡尔 曼 滤 波 算 法 进 行 处理 。但 是 ,在 非线 性 程 度 较 强 时 , 线性 化 过 程 会 引入 较 大 的 误差 ,导 致 滤波 结果 发散 ,影响 系统 的稳 定 性 。
技 术 探 讨 与 研 究
TECHNIQ
Design of M ain Control Circuit for DITC System of Switched Reluctance M otor
大连 交通 大 学 电气信 息学 院 刘 福 志 (IJiuFuzhi) 河北建 筑Z-程 学 院机 械工 程 学 院 倪 笑宇 (Ni Xiaoyu)
目标 追 踪 的 本 质 是 , 结 合 预 先 假 定 的运 动模 型 ,将 传 感 器 获取 的量 测 量 ,采 用 一 定 的滤 波 算 法 来估 计 载 体 的运 动 状态 。在 线 性 状 态 下 ,卡 尔 曼 滤 波 (KF)方 法 一 般 能 够 给 出 较 为 准 确 的 预 测 结 果 ; 对 于 非 线 性 问 题 ,要 得 到 目标 载 体 准 确 的 后验 概 率 密 度 函 数在 实 际 的应 用 中采 用 KF算
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
的E K P F算法相 比 , 改进 算法在 保证 滤 波性 能基本 不 变的前提 下 , 算 法运 算量 大幅 下降 。
关键词 : 粒 子滤波; 扩 展 卡 尔 曼滤 波 ; 固定单站无源定位 ; 部 分 采 样 中图分类号 : T N 9 7 文 献 标 志码 : A 文章编号 : 1 0 0 8 — 8 6 5 2 ( 2 0 1 4 ) 0 1 — 0 0 9 — 0 5
d i s a d v a n t a g e s o f h i g h c o mp u t a t i o n l o a d a nd p o o r r e a l - t i me pe r f o r ma nc e . An i mp r o v e d EKPF a l g o r i t h m i s a c h i e v e d
Ke y w o r d s : p a r t i c l e f i l t e r( P F) ;E x t e n d e d K a l ma n F i l t e r( E K F) ;f i x e d s i n g l e o b s e r v e r p a s s i v e l o c a t i o n ;
一
种 改进 的 E K P F算 法 在 固定 单 站 无 源定 位 中的应 用
申正 义 王 晴 晴 王 洪林 郭 锐
( 空 军预 警 学 院 武 汉 4 3 0 0 1 9 )
【 摘要 】 本 文针 对 E K P F算法在 固定单站 无 源定位 目标跟 踪 的应 用 中运 算量 大、 实时性差 的 问题 , 通
o n l y e f f e c t i v e l y r e d uc e t h e c o mp u t a t i o n l o a d,b u t a l s o i n c r e a s e t h e d i v e r s i t y o f p a r t i c l e s ,wh i c h ma k e s t h e p a r t i c l e s
s e t b e c a pa b l e o f s h o wi n g r e a l d i s t r i b u t i o n o f p r o b a bi l i t y d e n s i t y f un c t i o n .Ma t l a b s i mu l a t i o n r e s u l t s h o ws t h a t ,c o m—
b y wa y o f e x t e n d e d k a l ma n i f l t e r( E KP)s a mp l i n g t o a p o r t i o n o f p a r t i c l e s .T h e i mp r o v e d EK P F a l g o r i t h m c a n n o t
第4 3卷 第 1期 ( 总第 1 6 7期 )
2 01 4年 3月
ห้องสมุดไป่ตู้
火 控 雷 达技 术
Fi r e Co n t r o l Ra d a r Te c hn o l o g y
V o 1 . 4 3 No . 1 ( S e r i e s 1 6 7)
Ma r .2 01 4
Ap pl i c a t i o n o f An I m pr o v e d EK PF Al g o r i t hm i n Fi x e d S i ng l e O b s e r v e r Pa s s i v e Lo c a t i o n
S h e n Z h e n g y i , Wa n g Q i n g q i n g , Wa n g Ho n g l i n ,G u o R u i ( A i r F o r c e E a r l y Wa r n i n g A c a d e m y , Wu h a n 4 3 0 0 1 9 ) A b s t r a c t : E x t e n d e d K a l ma n p a r t i c l e f i l t e r( E K P F )a l g o r i t h m a p p l i e d i n i f x e d s i n g l e o b s e r v e r p a s s i v e l o c a t i o n h a s
过对 部分 粒子进 行 E K F采样 , 将 E K P F算法进 行 改进 , 改进 的 E K P F算 法 不仅 有 效 降低 了运 算 量 , 同时增加 了粒 子的 多样性 , 使 粒子 集更 能体现 概 率 密度 函数 的 真 实分布 。Ma t l a b仿 真表 明 , 与 传统