CN113093255B - 一种多信号真融合定位计算方法、装置、设备及存储介质 - Google Patents
一种多信号真融合定位计算方法、装置、设备及存储介质 Download PDFInfo
- Publication number
- CN113093255B CN113093255B CN202110499859.1A CN202110499859A CN113093255B CN 113093255 B CN113093255 B CN 113093255B CN 202110499859 A CN202110499859 A CN 202110499859A CN 113093255 B CN113093255 B CN 113093255B
- Authority
- CN
- China
- Prior art keywords
- positioning
- beacon
- gps
- fusion
- inertial navigation
- 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
- 230000004927 fusion Effects 0.000 title claims abstract description 129
- 238000004364 calculation method Methods 0.000 title claims abstract description 24
- 238000006073 displacement reaction Methods 0.000 claims description 18
- 238000004590 computer program Methods 0.000 claims description 12
- 238000004422 calculation algorithm Methods 0.000 claims description 10
- 230000006870 function Effects 0.000 claims description 7
- 238000000034 method Methods 0.000 claims description 7
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
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/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/46—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being of a radio-wave signal type
-
- 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/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明适用终端设备定位技术领域,提供了一种多信号真融合定位计算方法,该方法包括基于Beacon定位信号的RSS I最大强度构建Beacon定位结果的置信度模型,并基于该置信度模型通过融合计算终端设备中GPS、Beacon、加速度计、陀螺仪和指南针多种传感器的定位数据,获得多信号融合定位的结果。
Description
技术领域
本发明属于终端设备定位领域,尤其涉及一种多信号真融合定位计算方法、装置、设备及存储介质。
背景技术
随着技术的不断进步,多信号融合定位技术已经成为定位领域的主流,传统多信号融合定位,是综合GPS、Beacon、陀螺仪、指南针多种传感器的信号,同时利用区域做出非此即彼的判断,其定位算法要么在信号种类上顾此失彼,要么缺乏前后定位的连续性,定位效果和体验远未达到完美程度。
发明内容
本发明的目的在于提供一种多信号真融合定位计算方法、装置、设备及存储介质,用于解决多信号融合定位中定位效果和体验差的问题。
一方面,本发明提供了一种多信号真融合定位计算方法,所述方法包括下述步骤:
1,定义一个时长T,以所述时长T为时间周期定义时间周期序列T1,T2,T3...Tn;
S2,获取当前时间周期Tn结束时GPS、Beacon、指南针和惯性传感器的实时数据;
S3,基于所述Beacon定位信号的RSSI最大强度E构建所述Beacon定位结果的置信度模型;
S4,基于所述置信度模型对所述GPS定位信号和所述Beacon定位信号及其RSSI最大强度E进行融合计算,获得当前时间周期Tn结束时所述GPS和所述Beacon的双信号融合定位结果;
S5,基于所述置信度模型对当前时间周期Tn结束时所述双信号融合定位结果与惯性导航的定位结果进行融合计算,获得当前时间周期Tn结束时多信号融合定位结果;
S6,下一个时间周期开始后循环执行步骤S2至步骤S5,直至收到终止信号结束循环。
进一步地,所述置信度模型公式为
P(E)=1-ke-cE;
其中,P(E)需要满足以下两个实际边界条件:
边界条件(1):即E无穷大时所述Beacon定位结果的置信度P为1,
边界条件(2):P(0)=0;即E为0时所述Beacon定位结果的置信度P为0;
在所述置信度模型函数中,k和c表示两个根据实际情况确定的参数。
进一步地,所述基于所述置信度模型对所述GPS定位信号和所述Beacon定位信号及其RSSI最大强度E进行融合计算,获得当前时间周期Tn结束时所述GPS和所述Beacon的双信号融合定位结果包括以下步骤:
根据所述置信度模型计算所述GPS和所述Beacon的定位融合的置信度,所述置信度模型具体为
其中,Pbg(E)表示所述GPS和所述Beacon的定位融合的置信度,g表示GPS定位相关,b表示Beacon相关,kg和cg表示两个根据实际情况确定的参数;
基于所述GPS和所述Beacon的定位融合的置信度,根据双信号融合定位公式计算所述GPS和所述Beacon的双信号融合定位结果,所述双信号融合定位公式为
Rbg=RbPbg(E)+Rg(1-Pbg(E)),
其中,Rbg表示所述GPS和所述Beacon的双信号融合定位结果,Rb表示Beacon的定位结果,Rg表示GPS的定位结果,Pbg(E)表示所述GPS和Beacon融合定位的置信度。
进一步地,所述基于所述置信度模型对当前时间周期Tn结束时所述双信号融合定位结果与惯性导航的定位结果进行融合计算,获得当前时间周期Tn结束时多信号融合的定位结果包括以下步骤:
根据所述置信度模型计算所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,所述置信度模型具体为
其中,Pbgi(E)表示所述置信度模型计算所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,g表示GPS定位相关,b表示Beacon相关,i表示惯性导航相关,ki,ci表示两个根据实际情况确定的参数;
基于所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,计算当前时间周期Tn结束时所述GPS、所述Beacon和所述惯性导航的多信号融合定位结果。
进一步地,所述基于所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,计算当前时间周期Tn结束时所述GPS、所述Beacon和所述惯性导航的多信号融合定位结果,包括以下步骤:
通过惯性导航定位公式计算当前时间周期Tn结束时惯性导航的定位结果,所述惯性导航定位公式为
Ri=Rn-1+dRn,
其中,Ri表示时间周期Tn结束时所述惯性导航的定位结果,Rn-1表示时间周期Tn-1结束时多信号融合的定位结果,dRn表示时间周期Tn内惯性导航的相对位移;
利用多信号融合定位公式计算当前时间周期Tn结束时所述GPS、所述Beacon和所述惯性导航的多信号融合定位结果,所述多信号融合定位公式为
Rn=RbgPbgi(E)+Ri(1-Pbgi(E)),
由于Ri=Rn-1+dRn,
即Rn=RbgPbgi(E)+(Rn-1+dRn)(1-Pbgi(E)),
其中,Rn表示时间周期Tn结束时多信号融合定位结果,Rbg表示GPS和Beacon的双信号融合定位结果,Ri表示惯性导航的定位结果,Pbgi(E)表示GPS、Beacon和惯性导航融合定位的置信度。
进一步地,所述时间周期Tn内惯性导航的相对位移dRn通过以下步骤获取:
定义一个时间周期t,
所述时间周期t需要满足条件:Tn=m*t,
其中,m表示不小于1的自然数;
以所述时间周期t为轮询间隔,通过惯性导航算法计算所述时间周期t内惯性导航的相对位移;
通过惯性导航算法根据所述时间周期t内惯性导航的相对位移计算出所述时间周期Tn内惯性导航的相对位移dRn。
进一步地,所述惯性传感器包括加速度计和陀螺仪。
另一方面,本发明提供了多信号真融合定位计算装置,所述装置包括:
数据获取模块,用于以一个时间周期为轮询间隔获取终端设备中GPS、Beacon、指南针和加速度计和陀螺仪的实时数据;
置信度模型模块:用于基于Beacon定位信号的RSSI强度的最大值构建置信度模型;
双信号融合定位模块,用于基于置信度模型计算GPS和Beacon的双信号融合定位结果;
多信号融合定位模块,用于基于置信度模型计算GPS、Beacon和惯性导航的多信号融合结果;
惯性导航模块,用于根据南针、加速度计和陀螺仪的数据计算所述时间周期内惯性导航的相对位移。
另一方面,本发明还提供了一种多信号真融合定位计算设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现多信号真融合定位计算方法所述的步骤。
另一方面,本发明还提供了一种可读存储介质,所述可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现多信号真融合定位计算方法中所述的步骤。
本发明的有益效果:本发明通过构建Beacon定位结果的置信度模型,并基于该置信度模型通过融合计算终端设备中GPS、Beacon、加速度计、陀螺仪和指南针多种传感器的定位数据,获得多信号融合定位的结果。本发明的定位算法中,通过构建置信度模型解决了现有的多信号融合定位算法中存在的多种信号处理中顾此失彼的问题,通过对各个时间周期的定位结果进行迭代提高了定位结果的连续性,改善了用户体验。
附图说明
图1是本发明实施例提供的多信号真融合定位计算方法的流程图;
图2是本发明实施例提供的多信号真融合定位计算方法的示意图;
图3是本发明实施例提供的多信号真融合定位计算装置的结构示意图;
图4是本发明实施例提供的在多信号真融合定位计算设备的结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
以下结合具体实施例对本发明的具体实现进行详细描述:
实施例一:
如图1,参阅图2,示出了本发明实施例一提供的多信号真融合定位计算方法的实现流程,为了便于说明,仅示出了与本发明实施例相关的部分,详述如下:
步骤S101:定义一个时长T,以时长T为时间周期定义一个时间周期序列T1,T2,T3...Tn;
步骤S102:获取当前时间周期Tn结束时GPS、Beacon、指南针和惯性传感器的实时数据;
步骤S103:基于Beacon定位信号的RSSI最大强度E构建Beacon定位结果的置信度模型;
步骤S104:基于置信度模型对所述GPS定位信号和Beacon定位信号及其RSSI最大强度E进行融合计算,获得当前时间周期Tn结束时GPS和Beacon的双信号融合定位结果;
步骤S105:基于置信度模型对当前时间周期Tn结束时双信号融合定位结果与惯性导航的定位结果进行融合计算,获得当前时间周期Tn结束时多信号融合定位结果;
步骤S106:判断是否收到终止信号,若是,结束,若否,下一个时间周期开始后循环执行步骤S102至步骤S105。
进一步地,在步骤S101中,取时长T=1000ms;
进一步地,在步骤S103中,基于Beacon定位信号的RSSI最大强度E构建所述Beacon定位结果的置信度模型置信度模型公式为
P(E)=1-ke-cE;
其中,P(E)需要满足以下两个实际边界条件:
边界条件(1):即E无穷大时所述Beacon定位结果的置信度P为1,
边界条件(2):P(0)=0;即E为0时所述Beacon定位结果的置信度P为0;
在置信度模型函数中,k和c表示两个根据实际情况确定的参数。
进一步地,步骤S104包括以下步骤:
根据置信度模型计算GPS和Beacon的定位融合的置信度,置信度模型具体为
其中,Pbg(E)表示GPS和Beacon的定位融合的置信度,g表示GPS定位相关,b表示Beacon相关,kg和cg表示两个根据实际情况确定的参数;
基于GPS和Beacon的定位融合的置信度,根据双信号融合定位公式计算GPS和所述Beacon的双信号融合定位结果,所述双信号融合定位公式为
Rbg=RbPbg(E)+Rg(1-Pbg(E)),
其中,Rbg表示GPS和Beacon的双信号融合定位结果,Rb表示Beacon的定位结果,Rg表示GPS的定位结果,Pbg(E)表示GPS和Beacon融合定位的置信度。
进一步地,步骤S105包括以下步骤:
根据所述置信度模型计算GPS、Beacon和惯性导航的定位融合的置信度,置信度模型具体为
其中,Pbgi(E)表示所述置信度模型计算所述GPS、Beacon和惯性导航的定位融合的置信度,g表示GPS定位相关,b表示Beacon相关,i表示惯性导航相关,ki,ci表示两个根据实际情况确定的参数;
基于GPS、Beacon和惯性导航的定位融合的置信度,计算当前时间周期Tn结束时GPS、Beacon和惯性导航的多信号融合定位结果。
进一步地,步骤S105包括以下步骤:
通过惯性导航定位公式计算当前时间周期Tn结束时惯性导航的定位结果,惯性导航定位公式为
Ri=Rn-1+dRn,
其中,Ri表示时间周期Tn结束时惯性导航的定位结果,Rn-1表示时间周期Tn-1结束时多信号融合的定位结果,dRn表示时间周期Tn内惯性导航的相对位移;
利用多信号融合定位公式计算当前时间周期Tn结束时GPS、Beacon和惯性导航的多信号融合定位结果,多信号融合定位公式为
Rn=RbgPbgi(E)+Ri(1-Pbgi(E)),
由于Ri=Rn-1+dRn,
即Rn=RbgPbgi(E)+(Rn-1+dRn)(1-Pbgi(E)),
其中,Rn表示时间周期Tn结束时多信号融合定位结果,Rbg表示GPS和Beacon的双信号融合定位结果,Ri表示惯性导航的定位结果,Pbgi(E)表示GPS、Beacon和惯性导航融合定位的置信度。
进一步地,步骤S105中时间周期Tn内惯性导航的相对位移dRn通过以下步骤获取:
定义一个时间周期t,
时间周期t需要满足条件:Tn=m*t,
其中,m表示不小于1的自然数;
以时间周期t为轮询间隔,通过惯性导航算法计算所述时间周期t内惯性导航的相对位移;
通过惯性导航算法根据时间周期t内惯性导航的相对位移计算出时间周期Tn内惯性导航的相对位移dRn。
实施例二:
图3示出了本发明实施例提供的多信号真融合定位计算装置的结构示意图,为了便于说明,仅示出了与本发明实施例相关的部分,其中包括:
数据获取模块201,用于以一个时间周期为轮询间隔获取终端设备中GPS、Beacon、指南针和加速度计和陀螺仪的实时数据;
置信度模型模块202:用于基于Beacon定位信号的RSSI强度的最大值构建置信度模型;
双信号融合定位模块203,用于基于置信度模型计算GPS和Beacon的双信号融合定位结果;
多信号融合定位模块204,用于基于置信度模型计算GPS、Beacon和惯性导航的多信号融合结果;
惯性导航模块205,用于根据南针、加速度计和陀螺仪的数据计算所述时间周期内惯性导航的相对位移。
在本发明实施例中,多信号真融合定位计算装置的各模块可由相应的硬件或软件模块实现,各模块可以为独立的软、硬件模块,也可以集成为一个软、硬件模块,在此不用以限制本发明。
实施例三:
图4示出了本发明实施例提供的多信号真融合定位计算设备的结构示意图,为了便于说明,仅示出了与本发明实施例相关的部分,其中包括:
在本发明实施例中,提供了一种设备,包括存储器301、处理器302以及存储在存储器中并可在处理器上运行的计算机程序303,该计算机程序被处理器执行时实现上述多信号真融合定位计算方法实施例中的步骤,例如,图1所示的步骤S101至S107。或者,该计算机程序被处理器执行时实现上述多信号真融合定位计算装置中各模块的功能,例如,图3所示的模块201至205。
实施例四:
在本发明实施例中,提供了一种可读存储介质,该可读存储介质存储有计算机程序,该计算机程序被处理器执行时实现上述多信号真融合定位计算方法实施例中的步骤,例如,图1所示的步骤S101至S106。或者,该计算机程序被处理器执行时实现上述各装置实施例中各模块的功能,例如图4所示的各个模块的功能。
本发明实施例的计算机可读存储介质可以包括能够携带计算机程序代码的任何实体或装置、记录介质,例如,ROM/RAM、s磁盘、光盘、闪存等存储器。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (7)
1.一种多信号真融合定位计算方法,其特征在于,所述方法包括下述步骤:
S1,定义一个时长T,以所述时长T为时间周期定义时间周期序列T1,T2,T3...Tn;
S2,获取当前时间周期Tn结束时GPS、Beacon、指南针和惯性传感器的实时数据;
S3,基于所述Beacon定位信号的RSSI最大强度E构建所述Beacon定位结果的置信度模型,所述置信度模型公式为
P(E)=1-ke-cE;
其中,P(E)需要满足以下两个实际边界条件:
边界条件(1):即E无穷大时所述Beacon定位结果的置信度P为1,
边界条件(2):P(0)=0;即E为0时所述Beacon定位结果的置信度P为0;
在所述置信度模型函数中,k和c表示两个根据实际情况确定的参数;
S4,根据所述置信度模型计算所述GPS和所述Beacon的定位融合的置信度,所述置信度模型具体为
其中,Pbg(E)表示所述GPS和所述Beacon的定位融合的置信度,g表示GPS定位相关,b表示Beacon相关,kg和cg表示两个根据实际情况确定的参数;
基于所述GPS和所述Beacon的定位融合的置信度,根据双信号融合定位公式计算所述GPS和所述Beacon的双信号融合定位结果,所述双信号融合定位公式为
Rbg=RbPbg(E)+Rg(1-Pbg(E)),
其中,Rbg表示所述GPS和所述Beacon的双信号融合定位结果,Rb表示Beacon的定位结果,Rg表示GPS的定位结果,Pbg(E)表示所述GPS和Beacon融合定位的置信度;
S5,根据所述置信度模型计算所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,所述置信度模型具体为
其中,Pbgi(E)表示所述置信度模型计算所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,g表示GPS定位相关,b表示Beacon相关,i表示惯性导航相关,ki,ci表示两个根据实际情况确定的参数;
基于所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,计算当前时间周期Tn结束时所述GPS、所述Beacon和惯性导航的多信号融合定位结果;
S6,下一个时间周期开始后循环执行步骤S2至步骤S5,直至收到终止信号结束循环。
2.根据权利要求1所述的多信号真融合定位计算方法,其特征在于,所述基于所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,计算当前时间周期Tn结束时所述GPS、所述Beacon和所述惯性导航的多信号融合定位结果,包括以下步骤:
通过惯性导航定位公式计算当前时间周期Tn结束时惯性导航的定位结果,所述惯性导航定位公式为
Ri=Rn-1+dRn,
其中,Ri表示时间周期Tn结束时所述惯性导航的定位结果,Rn-1表示时间周期Tn-1结束时多信号融合的定位结果,dRn表示时间周期Tn内惯性导航的相对位移;
利用多信号融合定位公式计算当前时间周期Tn结束时所述GPS、所述Beacon和所述惯性导航的多信号融合定位结果,所述多信号融合定位公式为
Rn=RbgPbgi(E)+Ri(1-Pbgi(E)),
由于Ri=Rn-1+dRn,
即Rn=RbgPbgi(E)+(Rn-1+dRn)(1-Pbgi(E)),
其中,Rn表示时间周期Tn结束时多信号融合定位结果,Rbg表示GPS和Beacon的双信号融合定位结果,Ri表示惯性导航的定位结果,Pbgi(E)表示GPS、Beacon和惯性导航融合定位的置信度。
3.根据权利要求2所述的多信号真融合定位计算方法,其特征在于,所述时间周期Tn内惯性导航的相对位移dRn通过以下步骤获取:
定义一个时间周期t,
所述时间周期t需要满足条件:Tn=m*t,
其中,m表示不小于1的自然数;
以所述时间周期t为轮询间隔,通过惯性导航算法计算所述时间周期t内惯性导航的相对位移;
通过惯性导航算法根据所述时间周期t内惯性导航的相对位移计算出所述时间周期Tn内惯性导航的相对位移dRn。
4.根据权利要求1所述的多信号真融合定位计算方法,其特征在于,所述惯性传感器包括加速度计和陀螺仪。
5.一种多信号真融合定位计算装置,其特征在于,所述装置包括:
数据获取模块,用于以一个时间周期为轮询间隔获取终端设备中GPS、Beacon、指南针和加速度计和陀螺仪的实时数据;
置信度模型模块:用于基于Beacon定位信号的RSSI强度的最大值构建置信度模型,所述置信度模型公式为
P(E)=1-ke-cE;
其中,P(E)需要满足以下两个实际边界条件:
边界条件(1):即E无穷大时所述Beacon定位结果的置信度P为1,
边界条件(2):P(0)=0;即E为0时所述Beacon定位结果的置信度P为0;
在所述置信度模型函数中,k和c表示两个根据实际情况确定的参数;
双信号融合定位模块,用于根据所述置信度模型计算所述GPS和所述Beacon的定位融合的置信度,所述置信度模型具体为
其中,Pbg(E)表示所述GPS和所述Beacon的定位融合的置信度,g表示GPS定位相关,b表示Beacon相关,kg和cg表示两个根据实际情况确定的参数;
基于所述GPS和所述Beacon的定位融合的置信度,根据双信号融合定位公式计算所述GPS和所述Beacon的双信号融合定位结果,所述双信号融合定位公式为
Rbg=RbPbg(E)+Rg(1-Pbg(E)),
其中,Rbg表示所述GPS和所述Beacon的双信号融合定位结果,Rb表示Beacon的定位结果,Rg表示GPS的定位结果,Pbg(E)表示所述GPS和Beacon融合定位的置信度;
多信号融合定位模块,用于根据所述置信度模型计算所述GPS、所述Beacon和惯性导航的定位融合的置信度,所述置信度模型具体为
其中,Pbgi(E)表示所述置信度模型计算所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,g表示GPS定位相关,b表示Beacon相关,i表示惯性导航相关,ki,ci表示两个根据实际情况确定的参数;
基于所述GPS、所述Beacon和所述惯性导航的定位融合的置信度,计算当前时间周期Tn结束时所述GPS、所述Beacon和所述惯性导航的多信号融合定位结果;
惯性导航模块,用于根据南针、加速度计和陀螺仪的数据计算所述时间周期内惯性导航的相对位移。
6.一种设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至4任一项所述方法的步骤。
7.一种可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至4任一项所述方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110499859.1A CN113093255B (zh) | 2021-05-07 | 2021-05-07 | 一种多信号真融合定位计算方法、装置、设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110499859.1A CN113093255B (zh) | 2021-05-07 | 2021-05-07 | 一种多信号真融合定位计算方法、装置、设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113093255A CN113093255A (zh) | 2021-07-09 |
CN113093255B true CN113093255B (zh) | 2024-05-07 |
Family
ID=76664308
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110499859.1A Active CN113093255B (zh) | 2021-05-07 | 2021-05-07 | 一种多信号真融合定位计算方法、装置、设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113093255B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117454316B (zh) * | 2023-12-25 | 2024-04-26 | 安徽蔚来智驾科技有限公司 | 多传感器的数据融合方法、存储介质及智能设备 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017092180A1 (zh) * | 2015-12-01 | 2017-06-08 | 中国矿业大学 | 一种惯性导航与激光扫描融合的采煤机定位装置及方法 |
CN108064019A (zh) * | 2017-12-29 | 2018-05-22 | 北京奇宝科技有限公司 | 一种智能定位方法、装置、服务器和计算机可读存储介质 |
CN109474894A (zh) * | 2019-01-03 | 2019-03-15 | 腾讯科技(深圳)有限公司 | 终端定位处理方法、装置及电子设备 |
CN109831737A (zh) * | 2019-02-25 | 2019-05-31 | 广州市香港科大霍英东研究院 | 一种基于置信度的蓝牙定位方法、装置、设备和系统 |
CN110118549A (zh) * | 2018-02-06 | 2019-08-13 | 刘禹岐 | 一种多源信息融合定位方法和装置 |
CN111709517A (zh) * | 2020-06-12 | 2020-09-25 | 武汉中海庭数据技术有限公司 | 一种基于置信度预测系统的冗余融合定位增强的方法和装置 |
CN112333818A (zh) * | 2020-10-27 | 2021-02-05 | 中南民族大学 | 基于自适应周期性粒子滤波的多源融合室内定位系统及方法 |
CN112577526A (zh) * | 2020-12-29 | 2021-03-30 | 武汉中海庭数据技术有限公司 | 一种多传感器融合定位的置信度计算方法及系统 |
WO2021068650A1 (zh) * | 2019-10-07 | 2021-04-15 | 佛吉亚歌乐电子(丰城)有限公司 | 基于gps惯性导航的车载指南针实现方法及系统 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7646336B2 (en) * | 2006-03-24 | 2010-01-12 | Containertrac, Inc. | Automated asset positioning for location and inventory tracking using multiple positioning techniques |
US10812877B2 (en) * | 2017-05-15 | 2020-10-20 | Fuji Xerox Co., Ltd. | System and method for calibration-lessly compensating bias of sensors for localization and tracking |
US11686862B2 (en) * | 2018-12-19 | 2023-06-27 | Uber Technologies, Inc. | Inferring vehicle location and movement using sensor data fusion |
-
2021
- 2021-05-07 CN CN202110499859.1A patent/CN113093255B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017092180A1 (zh) * | 2015-12-01 | 2017-06-08 | 中国矿业大学 | 一种惯性导航与激光扫描融合的采煤机定位装置及方法 |
CN108064019A (zh) * | 2017-12-29 | 2018-05-22 | 北京奇宝科技有限公司 | 一种智能定位方法、装置、服务器和计算机可读存储介质 |
CN110118549A (zh) * | 2018-02-06 | 2019-08-13 | 刘禹岐 | 一种多源信息融合定位方法和装置 |
CN109474894A (zh) * | 2019-01-03 | 2019-03-15 | 腾讯科技(深圳)有限公司 | 终端定位处理方法、装置及电子设备 |
CN109831737A (zh) * | 2019-02-25 | 2019-05-31 | 广州市香港科大霍英东研究院 | 一种基于置信度的蓝牙定位方法、装置、设备和系统 |
WO2021068650A1 (zh) * | 2019-10-07 | 2021-04-15 | 佛吉亚歌乐电子(丰城)有限公司 | 基于gps惯性导航的车载指南针实现方法及系统 |
CN111709517A (zh) * | 2020-06-12 | 2020-09-25 | 武汉中海庭数据技术有限公司 | 一种基于置信度预测系统的冗余融合定位增强的方法和装置 |
CN112333818A (zh) * | 2020-10-27 | 2021-02-05 | 中南民族大学 | 基于自适应周期性粒子滤波的多源融合室内定位系统及方法 |
CN112577526A (zh) * | 2020-12-29 | 2021-03-30 | 武汉中海庭数据技术有限公司 | 一种多传感器融合定位的置信度计算方法及系统 |
Non-Patent Citations (8)
Title |
---|
农机INS/GNSS组合导航系统航向信息融合方法;张京;陈度;王书茂;禹振军;伟利国;贾全;;农业机械学报;20151230(S1);全文 * |
基于MEMS传感器的姿态检测系统;王窕丽;孙玉国;;电子科技;20151015(10);全文 * |
基于RFID的物流中心室内定位系统的研究与仿真;付永涛;中国优秀硕士论文全文库 信息科技辑;20100515;全文 * |
基于RSSI和惯性导航的融合室内定位算法;朱亚萍;夏玮玮;章跃跃;燕锋;左旭舟;沈连丰;;电信科学(第10期);全文 * |
基于WiFi标定与融合置信度算法的室内定位技术研究;宋斌斌;中国优秀硕士论文全文库信息科技辑;20191015;全文 * |
基于置信度加权的组合导航数据融合算法;徐田来;崔平远;崔祜涛;;航空学报(第06期);全文 * |
现代有轨电车与常规公交信号协调控制技术研究;杨斌;中国优秀硕士论文全文库 工程科技Ⅱ辑;20190515;全文 * |
祝燕华 ; 蔡体菁 ; 刘莹 ; .IMU/计程仪/重力组合导航系统信息融合方法.东南大学学报(自然科学版).(06),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN113093255A (zh) | 2021-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111199564B (zh) | 智能移动终端的室内定位方法、装置与电子设备 | |
EP2825850B1 (en) | Segment validation | |
CN104200454B (zh) | 鱼眼图像畸变校正方法及装置 | |
CN102121992B (zh) | 定位装置、定位方法以及摄像装置 | |
CN106767772B (zh) | 地磁指纹分布图的构建方法和装置及定位方法和装置 | |
CN107462260A (zh) | 一种运动轨迹生成方法、装置及可穿戴设备 | |
CN109756837A (zh) | 定位方法及装置 | |
CN113093255B (zh) | 一种多信号真融合定位计算方法、装置、设备及存储介质 | |
US20170115131A1 (en) | Inertial Positioning and Navigation Device Featuring a Novel Walk Detection Method | |
CN105138589A (zh) | 地理位置监测方法及设备 | |
CN109938740A (zh) | 一种步态周期检测方法、装置及计算机可读存储介质 | |
CN110231592A (zh) | 室内定位方法、装置、计算机可读存储介质及终端设备 | |
CN112629558A (zh) | 车辆惯导匹配矫正方法和装置、设备及存储介质 | |
CN109308291B (zh) | 地图轨迹的平滑方法、装置、终端及计算机可读存储介质 | |
CN104977016B (zh) | 导航处理方法及移动智能终端 | |
CN115629386B (zh) | 一种用于自动泊车的高精度定位系统及方法 | |
CN114911990B (zh) | 基于虚拟现实和智能交互的地图浏览系统 | |
CN105635958A (zh) | 一种定位数据采集方法和装置 | |
CN115795082A (zh) | 一种基于图算法的分布式位姿优化方法及系统 | |
CN111121774B (zh) | 一种可实时检测自身姿态的红外定位相机 | |
CN106289273A (zh) | 一种数据处理方法及系统 | |
CN112950709A (zh) | 一种位姿预测方法、位姿预测装置及机器人 | |
CN112526571A (zh) | 位姿数据的处理方法、处理装置、处理器和车辆系统 | |
CN112911363A (zh) | 轨迹视频生成方法、终端设备以及计算机可读存储介质 | |
CN113554711A (zh) | 相机在线标定方法、装置、计算机设备和存储介质 |
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 |