CN103076016A - 一种用于运动载体定位的系统 - Google Patents
一种用于运动载体定位的系统 Download PDFInfo
- Publication number
- CN103076016A CN103076016A CN2012105906136A CN201210590613A CN103076016A CN 103076016 A CN103076016 A CN 103076016A CN 2012105906136 A CN2012105906136 A CN 2012105906136A CN 201210590613 A CN201210590613 A CN 201210590613A CN 103076016 A CN103076016 A CN 103076016A
- Authority
- CN
- China
- Prior art keywords
- analog
- module
- digital conversion
- signal
- conversion module
- 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.)
- Pending
Links
Images
Landscapes
- Navigation (AREA)
Abstract
本发明公开了一种用于运动载体定位的系统,特别是涉及地面车辆、海上船舶及近地飞行器的在线实时定位方法,属于导航领域。所述系统包括:三分量磁强计、倾角传感器、第一模数转换模块、第二模数转换模块、坐标转换模块、卡尔曼滤波模块、地磁参考模块、显示单元,坐标转换模块、卡尔曼滤波模块构成数据处理模块。所述系统不需要向外辐射信号和接收外来信号,具有很强的自主性,使用过程中不存在盲区,能够实现对偏远地区的定位。
Description
技术领域
本发明涉及一种用于运动载体定位的系统,特别是涉及地面车辆、海上船舶及近地飞行器的在线实时定位方法,属于导航领域。
背景技术
现有的定位技术主要是无线电定位、GPS定位等。无线电定位需要接收外来信号,并且该方式的应用越来越少,正处于淘汰的阶段。GPS定位存在盲区,如果在同一时刻无法接收到4颗及以上导航卫星的信号,即无法完成定位。传统的惯性技术的核心部件之一—陀螺,由于受自身原理的限制,其漂移随着时间的增长而累积,致使陀螺的误差越来越大,而本文提出的方法不存在类似于陀螺的累积误差,对系统的精度有很大的改善。
发明内容
本发明的目的在于提供一种用于运动载体定位的系统,所述系统不需要向外辐射信号和接收外来信号,具有很强的自主性,使用过程中不存在盲区,能够实现对偏远地区的定位。
本发明的目的由以下技术方案实现:
一种用于运动载体定位的系统,所述系统包括:三分量磁强计、倾角传感器、第一模数转换模块、第二模数转换模块、坐标转换模块、卡尔曼滤波模块、地磁参考模块、显示单元,坐标转换模块、卡尔曼滤波模块构成数据处理模块;
三分量磁强计与第一模数转换模块连接,第一模数转换模块与坐标转换模块连接;倾角传感器与第二模数转换模块连接,第二模数转换模块与坐标转换模块连接,坐标转换模块与卡尔曼滤波模块连接,卡尔曼滤波模块与显示单元连接,地磁参考模块与卡尔曼滤波模块连接;
工作流程如下:
(1)三分量磁强计测量地磁场在运动载体坐标系中的三个分量,并将三个分量的模拟信号发送给第一模数转换模块,倾角传感器测量运动载体相对于惯性坐标系的旋转角度,并将旋转角度的模拟信号发送给第二模数转换模块;
(2)第一模数转换模块将来自三分量磁强计的模拟信号转换为数字信号,并发送给坐标转换模块;
(3)接步骤(1),第二模数转换模块将来自倾角传感器的模拟信号转换为数字信号,并发送给坐标转换模块;
(4)接步骤(2)和(3),坐标转换模块利用来自第二模数转换模块的信号将来自第一模数转换模块的信号转换为惯性坐标系下的三分量数据信号,并发送给卡尔曼滤波模块;
(5)卡尔曼滤波模块利用来自坐标转换模块的信号和地磁参考模块的信号,对运动载体的地理位置进行估计,并将位置信号发送给显示单元进行显示。
有益效果
(1)本发明所述系统不需要向外辐射信号和接收外来信号,具有很强的自主性。
(2)地磁场是地球的基本物理场之一,本发明所述系统在使用过程中不存在盲区,能够实现对偏远地区的定位。
附图说明
图1为本发明所述的用于运动载体定位的系统的示意图。
具体实施方式
下面结合附图和具体实施例来详述本发明,但不限于此。
如图1所示,一种用于运动载体定位的系统,所述系统包括:三分量磁强计、倾角传感器、第一模数转换模块、第二模数转换模块、坐标转换模块、卡尔曼滤波模块、地磁参考模块、显示单元,坐标转换模块、卡尔曼滤波模块构成数据处理模块;
三分量磁强计与第一模数转换模块连接,第一模数转换模块与坐标转换模块连接;倾角传感器与第二模数转换模块连接,第二模数转换模块与坐标转换模块连接,坐标转换模块与卡尔曼滤波模块连接,卡尔曼滤波模块与显示单元连接,地磁参考模块与卡尔曼滤波模块连接;
工作流程如下:
(1)三分量磁强计测量地磁场在运动载体坐标系中的三个分量,并将三个分量的模拟信号发送给第一模数转换模块,倾角传感器测量运动载体相对于惯性坐标系的旋转角度,并将旋转角度的模拟信号发送给第二模数转换模块;
(2)第一模数转换模块将来自三分量磁强计的模拟信号转换为数字信号,并发送给坐标转换模块;
(3)接步骤(1),第二模数转换模块将来自倾角传感器的模拟信号转换为数字信号,并发送给坐标转换模块;
(4)接步骤(2)和(3),坐标转换模块利用来自第二模数转换模块的信号将来自第一模数转换模块的信号转换为惯性坐标系下的三分量数据信号,并发送给卡尔曼滤波模块;
(5)卡尔曼滤波模块利用来自坐标转换模块的信号和地磁参考模块的信号,对运动载体的地理位置进行估计,并将位置信号发送给显示单元进行显示。
地磁参考模块表征地磁场和地理位置的关系,地磁场的强度是地理位置的函数,这个关系可由以下公式来表示:
其中,a是地球平均半径;r是测量点相对于地球中心的距离,θ是余纬,λ是经度,和是时间t的内高斯系数;和是t时间的外高斯系数;是n阶m级的施密特标准化的勒让德函数。n=1,2,3……;m=1,2,3……n;
基本卡尔曼滤波的递推公式如下:
状态一步预测:
状态估计:
滤波增益:K(k)=P(k/k-1)HT(k)[H(k)P(k/k-1)ΗT(k)+R(k)]-1
一步预测均方误差:P(k/k-1)=Φ(k,k-1)P(k-1)ΦT(k,k-1)+Γ(k-1)Q(k-1)ΓT(k-1)
估计均方误差:P(k)=[I-K(k)H(k)]P(k/k-1)
或P(k)=[I-K(k)H(k)]P(k/k-1)[I-K(k)H(k)]T+K(k)R(k)KT(k)
或P-1(k)=P-1(k/k-1)+HT(k)R-1(k)H(k)
式中,Φ(k,k-1)为tk-1时刻至tk时刻的一步转移阵;Γ(k)为系统噪声驱动阵;H(k)为量测阵;V(k)为量测噪声序列;W(k)为系统激励噪声序列。
步骤(5)卡尔曼滤波模块采用Unscented卡尔曼滤波。
本发明包括但不限于以上实施例,凡是在本发明精神的原则之下进行的任何等同替换或局部改进,都将视为在本发明的保护范围之内。
Claims (1)
1.一种用于运动载体定位的系统,其特征在于:所述系统包括:三分量磁强计、倾角传感器、第一模数转换模块、第二模数转换模块、坐标转换模块、卡尔曼滤波模块、地磁参考模块、显示单元,坐标转换模块、卡尔曼滤波模块构成数据处理模块;
三分量磁强计与第一模数转换模块连接,第一模数转换模块与坐标转换模块连接;倾角传感器与第二模数转换模块连接,第二模数转换模块与坐标转换模块连接,坐标转换模块与卡尔曼滤波模块连接,卡尔曼滤波模块与显示单元连接,地磁参考模块与卡尔曼滤波模块连接;
工作流程如下:
(1)三分量磁强计测量地磁场在运动载体坐标系中的三个分量,并将三个分量的模拟信号发送给第一模数转换模块,倾角传感器测量运动载体相对于惯性坐标系的旋转角度,并将旋转角度的模拟信号发送给第二模数转换模块;
(2)第一模数转换模块将来自三分量磁强计的模拟信号转换为数字信号,并发送给坐标转换模块;
(3)接步骤(1),第二模数转换模块将来自倾角传感器的模拟信号转换为数字信号,并发送给坐标转换模块;
(4)接步骤(2)和(3),坐标转换模块利用来自第二模数转换模块的信号将来自第一模数转换模块的信号转换为惯性坐标系下的三分量数据信号,并发送给卡尔曼滤波模块;
(5)卡尔曼滤波模块利用来自坐标转换模块的信号和地磁参考模块的信号,对运动载体的地理位置进行估计,并将位置信号发送给显示单元进行显示。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012105906136A CN103076016A (zh) | 2012-12-29 | 2012-12-29 | 一种用于运动载体定位的系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012105906136A CN103076016A (zh) | 2012-12-29 | 2012-12-29 | 一种用于运动载体定位的系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103076016A true CN103076016A (zh) | 2013-05-01 |
Family
ID=48152629
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2012105906136A Pending CN103076016A (zh) | 2012-12-29 | 2012-12-29 | 一种用于运动载体定位的系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103076016A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104677359A (zh) * | 2015-03-06 | 2015-06-03 | 施浒立 | 一种动态载体运行轨迹预测预报的方法 |
CN114601264A (zh) * | 2022-03-07 | 2022-06-10 | 江西鑫铂瑞科技有限公司 | 一种总控制台在线实时定位方法及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101581583A (zh) * | 2009-06-08 | 2009-11-18 | 美新半导体(无锡)有限公司 | 运动物体的导航定位系统 |
CN201955092U (zh) * | 2011-03-15 | 2011-08-31 | 滨州学院 | 一种基于地磁辅助的平台式惯性导航装置 |
CN202209953U (zh) * | 2011-08-11 | 2012-05-02 | 东北林业大学 | 用于水下载体的地磁辅助惯性导航系统 |
CN102829782A (zh) * | 2012-09-07 | 2012-12-19 | 滨州学院 | 一种地磁辅助惯性导航方法 |
-
2012
- 2012-12-29 CN CN2012105906136A patent/CN103076016A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101581583A (zh) * | 2009-06-08 | 2009-11-18 | 美新半导体(无锡)有限公司 | 运动物体的导航定位系统 |
CN201955092U (zh) * | 2011-03-15 | 2011-08-31 | 滨州学院 | 一种基于地磁辅助的平台式惯性导航装置 |
CN202209953U (zh) * | 2011-08-11 | 2012-05-02 | 东北林业大学 | 用于水下载体的地磁辅助惯性导航系统 |
CN102829782A (zh) * | 2012-09-07 | 2012-12-19 | 滨州学院 | 一种地磁辅助惯性导航方法 |
Non-Patent Citations (1)
Title |
---|
车振等: "地磁场模型理论及其应用", 《水雷战与舰船防护》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104677359A (zh) * | 2015-03-06 | 2015-06-03 | 施浒立 | 一种动态载体运行轨迹预测预报的方法 |
CN104677359B (zh) * | 2015-03-06 | 2017-06-30 | 施浒立 | 一种动态载体运行轨迹预测预报的方法 |
CN114601264A (zh) * | 2022-03-07 | 2022-06-10 | 江西鑫铂瑞科技有限公司 | 一种总控制台在线实时定位方法及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
CN109459027B (zh) | 一种基于偏振-地磁矢量紧组合的导航方法 | |
CN102305630B (zh) | 基于扩展卡尔曼滤波的sar卫星自主定轨方法 | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
Li et al. | Magnetic sensors for navigation applications: an overview | |
CN103017755B (zh) | 一种水下导航姿态测量方法 | |
CN103630139B (zh) | 一种基于地磁梯度张量测量的水下载体全姿态确定方法 | |
CN104880191B (zh) | 一种基于太阳矢量的偏振辅助导航方法 | |
CN103389092B (zh) | 一种系留飞艇姿态测量装置及测量方法 | |
CN102176041B (zh) | 一种基于gnss/sins组合的车辆导航监控系统 | |
CN103926625B (zh) | 一种利用地磁总场对水下磁目标高精度远距离的定位方法 | |
CN108594271B (zh) | 一种基于复合分层滤波的抗欺骗干扰的组合导航方法 | |
CN103900565A (zh) | 一种基于差分gps的惯导系统姿态获取方法 | |
CN106507913B (zh) | 用于管道测绘的组合定位方法 | |
CN103926627B (zh) | 水下载体地磁三分量测量方法 | |
CN104880192A (zh) | 一种基于偏振罗盘的载体航向角计算方法 | |
CN108594272A (zh) | 一种基于鲁棒卡尔曼滤波的抗欺骗干扰组合导航方法 | |
CN102288170A (zh) | 一种水下航行器内电子罗盘的校正方法 | |
CN105928515B (zh) | 一种无人机导航系统 | |
CN103499351A (zh) | 一种基于磁地标和磁传感器的车辆辅助定位方法 | |
CN103604428A (zh) | 基于高精度水平基准的星敏感器定位方法 | |
CN105021198A (zh) | 一种基于多传感器综合导航的位置估计方法 | |
CN103278165A (zh) | 基于剩磁标定的磁测及星光备份的自主导航方法 | |
CN111522067A (zh) | 一种基于垂直起降固定翼无人机的海洋航磁探测系统 | |
CN103697892B (zh) | 一种多无人艇协同导航条件下陀螺漂移的滤波方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20130501 |