CN102494684B - 一种基于wsn/mins组合导航的导航信息无偏紧组合方法 - Google Patents
一种基于wsn/mins组合导航的导航信息无偏紧组合方法 Download PDFInfo
- Publication number
- CN102494684B CN102494684B CN201110356559.4A CN201110356559A CN102494684B CN 102494684 B CN102494684 B CN 102494684B CN 201110356559 A CN201110356559 A CN 201110356559A CN 102494684 B CN102494684 B CN 102494684B
- Authority
- CN
- China
- Prior art keywords
- mins
- wsn
- navigation
- error
- navigation information
- 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.)
- Active
Links
Images
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公布了一种基于WSN/MINS组合导航的导航信息无偏紧组合方法,属于复杂环境下组合定位技术领域。在本地相对坐标系中将MINS(微惯性导航系统)、WSN(无线传感器网络)进行集成,通过无迹卡尔曼滤波(UnscentedKalmanFilter,UKF)对得到的同步导航数据在导航计算机中进行数据融合,从而得到一种比上述任何单一导航方法精度更高,导航覆盖范围更大也更加稳定的新式组合导航方法。
Description
技术领域
一种基于WSN/MINS组合导航的导航信息无偏紧组合方法,属于复杂环境下组合定位技术领域。
背景技术
对未知节点精确位置信息的需求推动了精确定位技术的发展,这种趋势在未来很长一段时间里仍将保持不变。近年来,无线传感器网络(WirelessSensors Network,WSN)以其低成本、低功耗和低系统复杂度的特点在短距离定位领域表现出很大的潜力。WSN为在无GPS信号地区,即所谓的“盲区”时,如室内、高层建筑密集的市区、矿井、隧道等环境下未知节点定位提供了可能,但由于WSN采用的通信技术通常为短距离无线通信技术(如ZigBee、WIFI等),因此若想完成长距离的目标跟踪定位,需要大量的网络节点共同完成,这并不符合WSN低成本、低功耗的需求。
微惯性导航系统(MEMS inertial navigation system,MINS)具有全自主、运动信息全面、短时、高精度的优点,虽然可以实现自主导航,但误差随时间积累,长航时运行条件下将导致导航精度严重下降。为了克服单独使用MINS或WSN定位的缺点,综合了二者的优点,许多学者将上述两种导航方式融合在一起,形成了WSN/MINS组合导航技术。传统的WSN/MINS组合方式较多的采用松组合的方式,即将WSN和MINS所测量的位置、速度等相关的导航信息进行融合,得到最后的最优的误差估计。这种方法思路简单,所需要的系统结构也很简单,计算量较小,工程实现较容易。但由于两个导航系统各自独立工作,彼此获得的导航信息具有一定冗余度。而且,SINS系统输出的载体速度和位置经滤波处理,也使得组合系统的滤波器存在相关性问题,导致状态误差估计难以达到最优。而目前在组合导航领域较为常用的紧组合方式基本采用将未知节点与已知节点之间的距离表达公式进行泰勒级数展开,从展开式中省略二次项之后与相应的WSN测量的距离作差。这种方法虽然将原始数据进行了融合,但是由于在推导过程中忽略了泰勒展开式中的二次项,使得滤波精度受到很大影响。
发明内容
为了解决上述问题,本发明提供了一种基于WSN/MINS组合导航的无需忽略泰勒展开式二次项的导航信息无偏紧组合方法,将微惯性导航系统(MINS)、无线传感器网络(WSN)通过无迹卡尔曼滤波(Unscented KalmanFilter,UKF)对得到的同步导航数据在导航计算机中进行数据融合,从而得到一种比上述任何单一导航方法精度更高,导航覆盖范围更大也更加稳定的新式组合导航方法。组合导航系统分为培训和自适应补偿两个阶段。将有WSN信号的区域称为培训阶段。而只有MINS信号的区域称之为自适应补偿阶段。在培训阶段通过UKF,利用本文提出的紧组合方案,对各种信号采集的导航信息进行数据融合。滤波模型仅需获得MINS所测量的每个时刻的位置、速度信息以及WSN测量的每个时刻未知节点与已知节点之间的距离信息。而不需要获取通过WSN测量的每个时刻未知节点的位置和速度等相关导航信息。克服了传统松组合必须需要同时获取3个以上的未知节点的信息才能够完成相应的数据滤波,给出最优估计。与此同时,由于在组合模型的推导过程中以MINS的测量值(X)与其误差(ΔX)的差值替代了该参数的真实值,减少了传统紧组合方法由于泰勒展开后忽略二次项对定位精度造成的影响。在滤波过程中,采用人工智能算法对MINS导航系统的导航误差模型进行训练,在MINS导航系统离开培训区域之后,依靠之前培训的误差模型对导航系统进行补偿,克服传统MINS导航系统定位精度随时间发生漂移的缺点,以及在密闭环境下无法提供有效的训练网络的问题,提供持久的高精度实时导航。
本发明为解决其技术问题采用如下技术方案:
1、在有WSN信号的培训阶段通过UKF,利用MINS所测量的每个时刻的位置、速度信息以及WSN测量的每个时刻未知节点与已知节点之间的距离信息进行数据融合,得到每一时刻在相对本地相对坐标系中MINS最优误差估计。而不需要获取通过WSN测量的每个时刻未知节点的位置和速度等相关导航信息。
3、无迹卡尔曼滤波器的系统方程以MINS每一时刻两个方向的位置误差(ex,k,ey,k)和速度误差(evx,k,evy,k)作为状态变量,以每一时刻MINS和WSN各自测量的未知节点与参考节点之间的距离的平方差和速度差作为观测量。系统方程如式(1)所示:
系统方程如式(2)所示:
其中,rins,i,(i=1,2,L,N)为MINS测量的第i个已知节点与未知节点之间的距离;rwsn,i,(i=1,2,L,N)为WSN测量的第i个已知节点与未知节点之间的距离,(i=1,2,L,N);(Δvx,Δvy)为两种测量方式的测量速度之差;(Δvx,Δvy)为两种测量方式的测量速度之差;(xRi,yRi)(i=1,2,L,N)为已知节点在相对坐标系中的位置;(xi,yi),(i=1,2,L,N)为MINS测量的未知节点在相对坐标系中的位置;T为采样周期;ωk为系统噪声;υk为系统噪声;A为系统转移矩阵;f(Xk)为观测方程的非线性函数。
4、在滤波器进行数据滤波的同时,将UKF得到的这一时刻最优的误差估计与T输入到人工智能算法中,通过人工智能算法构建MINS预估的相对导航信息随时间偏差的模型。
5、若未知节点离开搭建有WSN的区域进入自适应补偿阶段,在这一阶段,组合导航系统获取不到WSN测量的相对导航信息,只能依靠MINS系统完成这一部分的自主导航,MINS利用在培训区域训练的误差模型对测量的绝对导航信息进行误差补偿,得到最优的导航信息。
本发明具有如下有益效果:
本发明能满足地面城市交通、狭长隧道、小型智能机器人等中低精度的定位和定向的要求。
滤波器的系统方程以MINS每一时刻两个方向的位置误差和速度误差作为状态变量,以每一时刻MINS和WSN各自测量的未知节点与参考节点之间的距离的平方差和速度差作为观测量。由于该方法在滤波器进行数据融合时只需要获得MINS的位置、速度信息和WSN测量得到的未知节点与已知节点之间的距离信息,而不需要获得WSN测量得到的未知节点的位置、速度信息,因此通过紧组合方法,能够有效的克服传统松组合方式必须至少获得3个以上未知节点的位置、速度信息才能完成数据融合的缺点,充分的利用了导航环境中的资源。与此同时,由于在组合模型的推导过程中以MINS的测量值(X)与其误差(ΔX)的差值替代了该参数的真实值,减少了传统紧组合方法由于泰勒展开后忽略二次项对定位精度造成的影响。
附图说明
图1为WSN/MINS高精度实时组合导航系统。
图2为组合导航系统利用无迹卡尔曼滤波组合导航方法示意图。
图3为有WSN信号的培训区域组合导航模型。
图4为自适应补偿区域组合导航模型。
具体实施方式
下面结合附图对本发明创造做进一步详细说明
如图1所示为WSN/MINS高精度实时组合导航系统。
本发明一种基于WSN/MINS组合导航的导航信息无偏紧组合方法,包括下列步骤:在有WSN信号的培训阶段通过UKF,利用MINS所测量的每个时刻的位置、速度信息以及WSN测量的每个时刻未知节点与已知节点之间的距离信息进行数据融合,得到每一时刻在相对本地相对坐标系中MINS最优误差估计。而不需要获取通过WSN测量的每个时刻未知节点的位置和速度等相关导航信息。
如图2所示,无迹卡尔曼滤波器的系统方程以MINS每一时刻两个方向的位置误差(ex,k,ey,k)和速度误差(evx,k,evy,k)作为状态变量,以每一时刻MINS和WSN各自测量的未知节点与参考节点之间的距离的平方差和速度差作为观测量。系统方程如式(1)所示:
系统方程如式(2)所示:
其中,(i=1,2,L,N)为两种测量方式的测量距离之差;(Δvx,Δvy)为两种测量方式的测量速度之差;(xRi,yRi),(i=1,2,L,N)为已知节点在相对坐标系中的位置;(xi,yi),(i=1,2,L,N)为MINS测量的未知节点在相对坐标系中的位置;T为采样周期;ωk为系统噪声;υk为系统噪声。
在滤波器进行数据滤波的同时,将UKF得到的这一时刻最优的误差估计与T输入到人工智能算法中,通过人工智能算法构建MINS预估的相对导航信息随时间偏差的模型。
若未知节点离开搭建有WSN的区域进入自适应补偿阶段,在这一阶段,组合导航系统获取不到WSN测量的相对导航信息,只能依靠MINS系统完成这一部分的自主导航,MINS利用在培训区域训练的误差模型对测量的绝对导航信息进行误差补偿,得到最优的导航信息。
如图3为有WSN信号的培训区域组合导航模型,在这一培训区域,WSN导航系统与MINS导航系统同时工作,利用MINS所测量的每个时刻的位置、速度信息以及WSN测量的每个时刻未知节点与已知节点之间的距离信息进行数据融合,得到每一时刻在相对本地相对坐标系中MINS最优误差估计。而不需要获取通过WSN测量的每个时刻未知节点的位置和速度等相关导航信息。在采用滤波器进行数据融合,并得出最优导航信息的同时,将滤波器做出误差信息分别反馈给MINS的误差模型,将MINS自身预估的位置、速度误差与滤波器给出的最优估计通过人工智能算法进行培训,寻找二者之间的关系。
若未知节点离开搭建有WSN的区域,则组合导航系统进入自适应补偿阶段,如图4所示。在这一区域,组合导航系统获取不到WSN测量的相对导航信息,只能依靠MINS系统完成这一部分的自主导航。MINS利用在培训区域训练的误差模型对测量的绝对导航信息进行误差补偿,得到最优的导航信息,避免了因GPS/WSN导航无法工作导致导航误差快速下降、无法保证导航精度的问题,具有一定的可行性和前瞻性。
Claims (1)
1.一种基于WSN/MINS组合导航的导航信息无偏紧组合方法,其特征在于包括下列步骤:
(1)组合方法将导航过程分为培训过程和自适应补偿过程两部分:有WSN信号的导航过程为培训过程;而只有MINS信号的区域为自适应补偿过程;
(2)在培训过程中,紧组合方法在本地相对坐标系中将MINS即微惯性导航系统、WSN即无线传感器网络进行集成,通过无迹卡尔曼滤波对得到的同步导航数据在导航计算机中进行数据融合;
(3)无迹卡尔曼滤波器的系统方程以MINS每一时刻两个方向的位置误差(ex,k,ey,k)和速度误差(evx,k,evy,k)作为状态变量,以每一时刻MINS和WSN各自测量的未知节点与参考节点之间的距离的平方差和速度差作为观测量,系统方程如式(1)所示:
系统方程如式(2)所示:
其中,rins,i为MINS测量的第i个已知节点与未知节点之间的距离;rwsn,i为WSN测量的第i个已知节点与未知节点之间的距离,(Δvx,Δvy)为两种测量方式的测量速度之差;(xRi,yRi)为已知节点在相对坐标系中的位置;(xi,yi)为MINS测量的未知节点在相对坐标系中的位置,i=1,2,L,N;T为采样周期;ωk为系统噪声;υk为系统噪声;A为系统转移矩阵;f(Xk)为观测方程的非线性函数;
(4)在滤波器进行数据滤波的过程中,将UKF得到的这一时刻最优的误差估计与T输入到人工智能算法中,通过人工智能算法构建MINS预估的相对导航信息随时间偏差的模型;
(5)若未知节点离开搭建有WSN的区域进入自适应补偿阶段,在这一阶段,组合导航系统获取不到WSN测量的相对导航信息,只能依靠MINS系统完成这一部分的自主导航,MINS利用在培训区域训练的误差模型对测量的绝对导航信息进行误差补偿,得到最优的导航信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110356559.4A CN102494684B (zh) | 2011-11-11 | 2011-11-11 | 一种基于wsn/mins组合导航的导航信息无偏紧组合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110356559.4A CN102494684B (zh) | 2011-11-11 | 2011-11-11 | 一种基于wsn/mins组合导航的导航信息无偏紧组合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102494684A CN102494684A (zh) | 2012-06-13 |
CN102494684B true CN102494684B (zh) | 2014-06-04 |
Family
ID=46186528
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110356559.4A Active CN102494684B (zh) | 2011-11-11 | 2011-11-11 | 一种基于wsn/mins组合导航的导航信息无偏紧组合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102494684B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102692223B (zh) * | 2012-06-27 | 2014-10-08 | 东南大学 | 用于wsn/ins组合导航的多级非线性滤波器的控制方法 |
CN103197279B (zh) * | 2013-03-12 | 2014-10-29 | 中国矿业大学 | 一种移动目标协同定位系统的定位方法 |
CN103776442B (zh) * | 2014-01-17 | 2016-06-29 | 中国人民解放军海军工程大学 | 区域无线定位及微捷联惯导组合系统的定位方法 |
CN104135333B (zh) * | 2014-07-24 | 2017-01-11 | 航天恒星科技有限公司 | 一种基于卡尔曼滤波器的tdma节点开环网络时间同步方法 |
CN104316058B (zh) * | 2014-11-04 | 2017-01-18 | 东南大学 | 一种采用交互多模型的移动机器人wsn/ins组合导航方法 |
CN104374389B (zh) * | 2014-12-10 | 2017-04-05 | 济南大学 | 一种面向室内移动机器人的imu/wsn组合导航方法 |
CN105424030B (zh) * | 2015-11-24 | 2018-11-09 | 东南大学 | 基于无线指纹和mems传感器的融合导航装置和方法 |
CN105928518B (zh) * | 2016-04-14 | 2018-10-19 | 济南大学 | 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法 |
CN106226732B (zh) * | 2016-07-08 | 2018-11-16 | 西安电子科技大学 | 基于tof及迭代无迹滤波的室内无线定位跟踪方法 |
CN106370183A (zh) * | 2016-11-14 | 2017-02-01 | 黑龙江省科学院自动化研究所 | 一种消防组合定位系统 |
CN106840154B (zh) * | 2017-03-21 | 2023-07-07 | 江苏星月测绘科技股份有限公司 | 地下空间惯性测量与无线传感器组合定位系统与方法 |
CN108827295A (zh) * | 2018-07-19 | 2018-11-16 | 华北电力大学 | 基于无线传感器网络和惯性导航的微型无人机自定位方法 |
CN111580144B (zh) * | 2020-05-07 | 2023-03-14 | 西北工业大学 | 一种mins/gps超紧组合导航系统设计方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7043364B2 (en) * | 2001-12-03 | 2006-05-09 | Applanix Corporation, Inc. | Walking stick navigator for position determination |
CN101000245A (zh) * | 2007-01-10 | 2007-07-18 | 北京航空航天大学 | 一种sins/gps/磁罗盘组合导航系统的数据融合方法 |
CN101059349A (zh) * | 2007-05-18 | 2007-10-24 | 南京航空航天大学 | 微型组合导航系统及自适应滤波方法 |
CN101576384A (zh) * | 2009-06-18 | 2009-11-11 | 北京航空航天大学 | 一种基于视觉信息校正的室内移动机器人实时导航方法 |
-
2011
- 2011-11-11 CN CN201110356559.4A patent/CN102494684B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7043364B2 (en) * | 2001-12-03 | 2006-05-09 | Applanix Corporation, Inc. | Walking stick navigator for position determination |
CN101000245A (zh) * | 2007-01-10 | 2007-07-18 | 北京航空航天大学 | 一种sins/gps/磁罗盘组合导航系统的数据融合方法 |
CN101059349A (zh) * | 2007-05-18 | 2007-10-24 | 南京航空航天大学 | 微型组合导航系统及自适应滤波方法 |
CN101576384A (zh) * | 2009-06-18 | 2009-11-11 | 北京航空航天大学 | 一种基于视觉信息校正的室内移动机器人实时导航方法 |
Non-Patent Citations (5)
Title |
---|
《GFMIMU_GPS组合导航系统信息融合技术研究》;曹娟娟等;《系统仿真学报》;20080131;第20卷(第2期);全文 * |
《UKF在GPS_INS组合导航系统中的应用》;毛克诚等;《测绘科学技术学报》;20070630;第24卷(第3期);全文 * |
曹娟娟等.《GFMIMU_GPS组合导航系统信息融合技术研究》.《系统仿真学报》.2008,第20卷(第2期), |
毛克诚等.《UKF在GPS_INS组合导航系统中的应用》.《测绘科学技术学报》.2007,第24卷(第3期), |
隋树林等.《基于多模型扩展卡尔曼滤波的组合导航算法》.《青岛科技大学学报(自然科学版)》.2009,第30卷(第5期), * |
Also Published As
Publication number | Publication date |
---|---|
CN102494684A (zh) | 2012-06-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102494684B (zh) | 一种基于wsn/mins组合导航的导航信息无偏紧组合方法 | |
CN102692223B (zh) | 用于wsn/ins组合导航的多级非线性滤波器的控制方法 | |
CN103148855B (zh) | 一种ins辅助的室内移动机器人无线定位方法 | |
CN102636166B (zh) | 基于航向角的wsn/ins组合导航系统的控制方法 | |
CN102494685B (zh) | 用于wsn/ins高精度实时组合导航的h无穷信息融合方法 | |
Chen et al. | Improving ultrasonic-based seamless navigation for indoor mobile robots utilizing EKF and LS-SVM | |
Fan et al. | Data fusion for indoor mobile robot positioning based on tightly coupled INS/UWB | |
CN102359787B (zh) | 一种wsn/mins高精度实时组合导航信息融合方法 | |
CN106597017B (zh) | 一种基于扩展卡尔曼滤波的无人机角加速度估计方法及装置 | |
CN104729506A (zh) | 一种视觉信息辅助的无人机自主导航定位方法 | |
CN111595348B (zh) | 一种自主水下航行器组合导航系统的主从式协同定位方法 | |
CN104864865B (zh) | 一种面向室内行人导航的ahrs/uwb无缝组合导航方法 | |
CN105319534A (zh) | 一种基于水声双程测距的多auv协同定位方法 | |
CN104809326A (zh) | 一种异步传感器空间配准算法 | |
CN104316058B (zh) | 一种采用交互多模型的移动机器人wsn/ins组合导航方法 | |
CN103196448A (zh) | 一种机载分布式惯性测姿系统及其传递对准方法 | |
CN106871893A (zh) | 分布式ins/uwb紧组合导航系统及方法 | |
CN103697889A (zh) | 一种基于多模型分布式滤波的无人机自主导航与定位方法 | |
CN111536967A (zh) | 一种基于ekf的多传感器融合温室巡检机器人跟踪方法 | |
CN104374389B (zh) | 一种面向室内移动机器人的imu/wsn组合导航方法 | |
CN104296741B (zh) | 采用距离平方和距离平方变化率的wsn/ahrs紧组合方法 | |
CN103697892B (zh) | 一种多无人艇协同导航条件下陀螺漂移的滤波方法 | |
CN103968844A (zh) | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 | |
CN114111802A (zh) | 一种行人航迹推算辅助uwb的定位方法 | |
CN105115507A (zh) | 一种基于双imu的双模式室内个人导航系统及方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |