CN108267757B - 一种多模定位数据融合方法 - Google Patents
一种多模定位数据融合方法 Download PDFInfo
- Publication number
- CN108267757B CN108267757B CN201711488415.8A CN201711488415A CN108267757B CN 108267757 B CN108267757 B CN 108267757B CN 201711488415 A CN201711488415 A CN 201711488415A CN 108267757 B CN108267757 B CN 108267757B
- Authority
- CN
- China
- Prior art keywords
- positioning
- signal
- positioning signal
- current
- calculating
- 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
- 238000007500 overflow downdraw method Methods 0.000 title claims abstract description 7
- 238000000034 method Methods 0.000 claims abstract description 25
- 238000004364 calculation method Methods 0.000 claims abstract description 10
- 230000001133 acceleration Effects 0.000 claims description 5
- 102100034112 Alkyldihydroxyacetonephosphate synthase, peroxisomal Human genes 0.000 claims description 4
- 101000799143 Homo sapiens Alkyldihydroxyacetonephosphate synthase, peroxisomal Proteins 0.000 claims description 4
- 230000004927 fusion Effects 0.000 abstract description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/33—Multimode operation in different systems which transmit time stamped messages, e.g. GPS/GLONASS
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种多模定位数据融合方法,包括以下步骤:采集定位信号以及信号强度;根据定位信号计算对应的定位坐标;根据上一时刻的数据计算当前定位坐标偏差度;根据偏差度、当前的定位信号对应的信号强度、特征权值和定位坐标计算多模定位坐标。本发明方法针对不同的定位信号,结合各信号的信号强度、对应定位信号的特征权值和根据历史数据得到的定位信号偏差度更新权值,对各定位坐标计算加权平均值,在计算过程中同时考虑了信号源种类、强度和历史数据,避免移动过程中由于定位服务器切换、信号强度变化等突变造成定位坐标出现漂移,保持数据融合后定位坐标的准确性。本发明作为一种多模定位数据融合方法可广泛应用于数据处理领域。
Description
技术领域
本发明涉及数据处理领域,尤其是一种多模定位数据融合方法。
背景技术
卫星定位系统即全球定位系统(Global Positioning System),就是使用卫星对某物进行准确定位的技术,在很大程度上提高了人们生产中的效率,给人们的生活提供了便利,提升了人们生活的质量。在现有生活中常用的卫星导航系包括中国的北斗卫星导航系统(BD Navigation Satellite System)和美国的全球定位系统(GlobalPositioningSystem,GPS)。现有技术中已经提供了多种北斗和GPS等结合的多模定位方法,但是在智能穿戴领域,由于需要对目标进行高精度的定位,因此还需要结合其他定位方式进行精准定位,然而定位目标是随时移动的,采用更多的定位方式时更容易造成一种或多种定位服务器切换,从而影响信号信号强度和定位准确性。例如在结合了LBS定位的多模定位方法中,很容易由于LBS定位坐标的漂移导致定位出现极大误差。
发明内容
为了解决上述技术问题,本发明的目的是:提供一种运动状态下实现精确定位的多模定位数据融合方法。
本发明所采用的技术方案是:一种多模定位数据融合方法,包括有以下步骤:
A、采集当前的定位信号以及当前的定位信号对应的信号强度st,i,所述定位信号包括有卫星定位信号、LBS基站定位信号、WIFI定位信号和加速度传感器的信号;
B、根据当前的定位信号分别计算当前的定位信号对应的定位坐标xt,i;
C、根据上一时刻的多模定位坐标Xt-1、上一时刻的定位信号对应的定位坐标xt-1,i和当前的定位信号对应的定位坐标xt,i计算当前的定位信号对应的偏差度bt,i;
D、根据上一时刻的定位信号对应的偏差度bt-1,i、当前的定位信号对应的信号强度st,i、特征权值wi和定位坐标xt,i计算加权平均值作为多模定位坐标Xt:
进一步,所述卫星定位信号包括有北斗定位信号、GPS定位信号和AGPS定位信号中的一种或多种。
进一步,所述信号强度st,i为距离当前的单位时间内采集定位信号的成功率。
进一步,所述步骤C中当前的定位信号对应的偏差度bt,i的计算方法具体为:
其中,N为定位信号的数量,Xt-1为上一时刻的多模定位坐标。
进一步,计算当前的定位信号对应的偏差度bt,i后,若当前的定位信号对应的偏差度bt,i小于定位信号对应的偏差度下限阈值bi,min,则赋值偏差度bt,i=bi,min;若当前的定位信号对应的偏差度bt,i大于定位信号对应的偏差度上限阈值bi,max,则赋值偏差度bt,i=bi,max。
进一步,采用步骤D第一次计算多模定位坐标Xt时,初始化上一时刻定位信号对应的偏差度bt-1,i=1。
进一步,采用步骤D第一次计算多模定位坐标Xt时,初始化当前的定位信号对应的信号强度st,i=1。
进一步,所述特征权值wi为与时间无关的常数。
本发明的有益效果是:针对不同的定位信号,结合各信号的信号强度、对应定位信号的特征权值和根据历史数据得到的定位信号偏差度更新权值,对各定位坐标计算加权平均值,在计算过程中同时考虑了信号源种类、强度和历史数据,避免移动过程中由于定位服务器切换、信号强度变化等突变造成定位坐标出现漂移,保持数据融合后定位坐标的准确性。
附图说明
图1为本发明方法的步骤流程图。
具体实施方式
下面结合附图对本发明的具体实施方式作进一步说明:
参照图1,一种多模定位数据融合方法,包括有以下步骤:
A、采集当前的定位信号以及当前的定位信号对应的信号强度st,i,所述定位信号包括有卫星定位信号、LBS基站定位信号、WIFI定位信号和加速度传感器的信号;
其中t为当前时间,i代表定位信号的种类,例如WIFI定位信号用序号3表示,则当前的WIFI定位信号对应的信号强度为st,3;信号强度越大,则在计算时该定位信号时,所对应的权值应该更小。
B、根据当前的定位信号分别计算当前的定位信号对应的定位坐标xt,i。
C、根据上一时刻的多模定位坐标Xt-1、上一时刻的定位信号对应的定位坐标xt-1,i和当前的定位信号对应的定位坐标xt,i计算当前的定位信号对应的偏差度bt,i;
偏差度表示定位信号与计算出的最终的多模定位信号的偏差程度,偏差程度越大则偏差度越大,在计算时该定位信号所对应的权值应该更小。
D、根据上一时刻的定位信号对应的偏差度bt-1,i、当前的定位信号对应的信号强度st,i、特征权值wi和定位坐标xt,i计算加权平均值作为多模定位坐标Xt:
进一步作为优选的实施方式,所述特征权值wi为与时间无关的常数。对于卫星定位信号、LBS基站定位信号、WIFI定位信号和加速度传感器的信号,每种定位信号的精度都不同,对于更高精度的定位方式,则特征权值也应该设置为更高。
进一步作为优选的实施方式,所述卫星定位信号包括有北斗定位信号、GPS定位信号和AGPS定位信号中的一种或多种。
进一步作为优选的实施方式,所述信号强度st,i为距离当前的单位时间内采集定位信号的成功率。
进一步作为优选的实施方式,所述步骤C中当前的定位信号对应的偏差度bt,i的计算方法具体为:
其中,N为定位信号的数量,例如同时采用北斗定位信号、GPS定位信号、AGPS定位信号、LBS基站定位信号、WIFI定位信号和加速度传感器的信号时,N的值为6;Xt-1为上一时刻的多模定位坐标,是以Xt-1作为上一时刻定位坐标的平均值计算得到的上一时刻定位坐标的方差,因为定位信号采集的间隔时间很短,短时间内目标的移动距离可以忽略,因此近似认为其位置仍然在Xt-1,而此时的定位坐标可能因为移动而造成突变,因此通过上式实现对当前定位坐标偏差度的计算。
进一步作为优选的实施方式,计算当前的定位信号对应的偏差度bt,i后,若当前的定位信号对应的偏差度bt,i小于定位信号对应的偏差度下限阈值bi,min,则赋值偏差度bt,i=bi,min;若当前的定位信号对应的偏差度bt,i大于定位信号对应的偏差度上限阈值bi,max,则赋值偏差度bt,i=bi,max。
当某个定位方式对应定位信号的偏差度增大时,其相应的权值减小,对计算结果的影响会进一步减小,在下一次计算中容易造成偏差度继续增大的问题,因此为了避免偏差度的无限增大,在实际计算过程中考虑设置偏差度的下限阈值bi,min。相应的,在实际计算过程中同样考虑设置偏差度的上限阈值bi,max。
进一步作为优选的实施方式,采用步骤D第一次计算多模定位坐标Xt时,初始化上一时刻定位信号对应的偏差度bt-1,i=1。
进一步作为优选的实施方式,采用步骤D第一次计算多模定位坐标Xt时,初始化当前的定位信号对应的信号强度st,i=1。
初始化过程中,无法计算偏差度和信号强度,因此只根据特征权值对定位信号进行相应的计算。
以上是对本发明的较佳实施进行了具体说明,但本发明创造并不限于所述实施例,熟悉本领域的技术人员在不违背本发明精神的前提下还可以作出种种的等同变换或替换,这些等同的变形或替换均包含在本申请权利要求所限定的范围内。
Claims (7)
1.一种多模定位数据融合方法,其特征在于,包括有以下步骤:
A、采集当前的定位信号以及当前的定位信号对应的信号强度st,i,所述定位信号包括有卫星定位信号、LBS基站定位信号、WTFI定位信号和加速度传感器的信号;
B、根据当前的定位信号分别计算当前的定位信号对应的定位坐标xt,i;
C、根据上一时刻的多模定位坐标Xt-1、上一时刻的定位信号对应的定位坐标xt-1,i和当前的定位信号对应的定位坐标xt,i计算当前的定位信号对应的偏差度bt,i;
D、根据上一时刻的定位信号对应的偏差度bt-1,i、当前的定位信号对应的信号强度st,i、特征权值wi和定位坐标xt,i计算加权平均值作为多模定位坐标Xt:
其中,所述步骤C中当前的定位信号对应的偏差度bt,i的计算方法具体为:
其中,N为定位信号的数量,Xt-1为上一时刻的多模定位坐标。
2.根据权利要求1所述的一种多模定位数据融合方法,其特征在于:所述卫星定位信号包括有北斗定位信号、GPS定位信号和AGPS定位信号中的一种或多种。
3.根据权利要求1所述的一种多模定位数据融合方法,其特征在于:所述信号强度st,i为距离当前的单位时间内采集定位信号的成功率。
4.根据权利要求1所述的一种多模定位数据融合方法,其特征在于:计算当前的定位信号对应的偏差度bt,i后,若当前的定位信号对应的偏差度bt,i小于定位信号对应的偏差度下限阈值bi,min,则赋值偏差度bt,i=bi,min;若当前的定位信号对应的偏差度bt,i大于定位信号对应的偏差度上限阈值bi,max,则赋值偏差度bt,i=bi,max。
5.根据权利要求1所述的一种多模定位数据融合方法,其特征在于:采用步骤D第一次计算多模定位坐标Xt时,初始化上一时刻定位信号对应的偏差度bt-1,i=1。
6.根据权利要求1所述的一种多模定位数据融合方法,其特征在于:采用步骤D第一次计算多模定位坐标Xt时,初始化当前的定位信号对应的信号强度st,i=1。
7.根据权利要求1所述的一种多模定位数据融合方法,其特征在于:所述特征权值wi为与时间无关的常数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711488415.8A CN108267757B (zh) | 2017-12-30 | 2017-12-30 | 一种多模定位数据融合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711488415.8A CN108267757B (zh) | 2017-12-30 | 2017-12-30 | 一种多模定位数据融合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108267757A CN108267757A (zh) | 2018-07-10 |
CN108267757B true CN108267757B (zh) | 2021-08-24 |
Family
ID=62772918
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711488415.8A Active CN108267757B (zh) | 2017-12-30 | 2017-12-30 | 一种多模定位数据融合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108267757B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111645727A (zh) * | 2019-03-04 | 2020-09-11 | 比亚迪股份有限公司 | 列车及其定位方法和装置 |
CN110967678A (zh) * | 2019-12-20 | 2020-04-07 | 安徽博微长安电子有限公司 | 一种多波段雷达目标识别的数据融合算法及系统 |
CN113890592B (zh) * | 2021-10-27 | 2022-05-24 | 广州爱浦路网络技术有限公司 | 通信卫星切换方法、天地一体化信息网络系统、装置和介质 |
CN118244310B (zh) * | 2024-05-28 | 2024-08-09 | 深圳市飞易通科技有限公司 | 车辆定位方法及装置、汽车 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8917206B2 (en) * | 2009-06-09 | 2014-12-23 | Qualcomm Incorporated | Mobile-based positioning with non-conforming use of assistance data |
CN103906228B (zh) * | 2012-12-28 | 2018-04-10 | 中国电信股份有限公司 | 移动终端的基站差分定位方法、定位装置和系统 |
US20150169597A1 (en) * | 2013-12-17 | 2015-06-18 | Qualcomm Incorporated | Methods and Systems for Locating Items and Determining Item Locations |
CN105554706B (zh) * | 2015-05-04 | 2019-06-11 | 四川大学 | 基于多网络融合的室内定位方案 |
CN106507311B (zh) * | 2016-12-13 | 2019-12-24 | 南京福盛建材有限公司 | 一种定位的处理方法及系统 |
CN206575533U (zh) * | 2017-03-29 | 2017-10-20 | 深圳市美力高集团有限公司 | 公共交通紧急自助救援系统 |
-
2017
- 2017-12-30 CN CN201711488415.8A patent/CN108267757B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108267757A (zh) | 2018-07-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108267757B (zh) | 一种多模定位数据融合方法 | |
CN106919171B (zh) | 一种机器人室内定位导航系统及方法 | |
CN110806215B (zh) | 车辆定位的方法、装置、设备及存储介质 | |
Nakazawa et al. | Indoor positioning using a high-speed, fish-eye lens-equipped camera in visible light communication | |
US11503428B2 (en) | Systems and methods for co-localization of multiple devices | |
EP3090407B1 (en) | Methods and systems for determining estimation of motion of a device | |
CN110542436B (zh) | 车辆定位系统的评测方法、装置、设备及存储介质 | |
US8538671B2 (en) | Apparatus and method for detecting position and orientation of mobile object | |
US20130054130A1 (en) | Navigation system, method of position estimation and method of providing navigation information | |
US11714161B2 (en) | Distance-based positioning system and method using high-speed and low-speed wireless signals | |
CN109724603A (zh) | 一种基于环境特征检测的室内机器人导航方法 | |
US10901096B2 (en) | Antenna phase variation correction | |
CN114554392A (zh) | 一种基于uwb与imu融合的多机器人协同定位方法 | |
CN113678171A (zh) | 信息处理装置、信息处理方法和记录介质 | |
US10962654B2 (en) | Multiple-positioning-system switching and fused calibration method and device thereof | |
Verma et al. | Wireless position tracking of a DTMF based mobile robot using GSM and GPS | |
TW201812338A (zh) | 旋翼飛行器的定位方法 | |
US20210053232A1 (en) | Information processing apparatus, information processing method and program | |
CN109883419B (zh) | 机器人导航方法及系统 | |
CN114413894A (zh) | 一种多传感器融合的机器人定位的方法 | |
KR102406240B1 (ko) | 강인한 스테레오 비주얼 관성 항법 장치 및 방법 | |
CN114485623A (zh) | 一种聚焦距离的相机-imu-uwb融合精准定位方法 | |
WO2024065852A1 (en) | Robot position error correction | |
CN108645403B (zh) | 一种基于卫星导航及姿态测量的无人机自动跟拍系统 | |
Nasir et al. | Data fusion of stereo vision and gyroscope for estimation of indoor mobile robot orientation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CP03 | Change of name, title or address |
Address after: 510000 room 402, building C1, No. 182, Kexue Avenue, Huangpu District, Guangzhou, Guangdong Patentee after: Guangzhou AI care Digital Technology Co.,Ltd. Address before: 510663 unit 1106, C1, innovation building, 182 science Avenue, Science City, Guangzhou high tech Industrial Development Zone, Guangdong Province Patentee before: GUANGZHOU BAIYI INFORMATION TECHNOLOGY Co.,Ltd. |
|
CP03 | Change of name, title or address |