CN103841638B - 定位方法、装置及系统 - Google Patents
定位方法、装置及系统 Download PDFInfo
- Publication number
- CN103841638B CN103841638B CN201210486831.5A CN201210486831A CN103841638B CN 103841638 B CN103841638 B CN 103841638B CN 201210486831 A CN201210486831 A CN 201210486831A CN 103841638 B CN103841638 B CN 103841638B
- Authority
- CN
- China
- Prior art keywords
- marg
- gps
- positioning
- integrated positioning
- integrated
- 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.)
- Expired - Fee Related
Links
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/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/01—Determining conditions which influence positioning, e.g. radio environment, state of motion or energy consumption
- G01S5/011—Identifying the radio environment
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种定位方法、装置及系统,其中,该方法包括:计算得到GPS/MARG组合定位系统当前的定位性能参数;如果定位性能参数符合预先设置的条件,则启动Wi‑Fi/MARG组合定位系统进行定位;根据GPS/MARG组合定位系统定位得到的结果和Wi‑Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息。本发明解决了现有技术中单独采用GPS/MARG组合定位系统或者Wi‑Fi/MARG组合定位系统进行定位而导致的在有些环境下对移动目标的定位准确性较低的技术问题,达到了提高定位系统在各个环境下的定位准确性的技术效果,扩大了定位系统的使用范围。
Description
技术领域
本发明涉及通信领域,具体而言,涉及一种定位方法、装置及系统。
背景技术
目前,全球定位系统(Global Position System,简称为GPS)是一种被广泛应用在智能终端的定位系统,。在空旷的区域GPS能够获得比较好的定位性能,然而,在高楼林立的市区或者是在完全被遮挡的室内环境中,GPS定位性能将会急剧恶化甚至无法进行定位。无线保真(Wireless Fidelity,简称为Wi-Fi)定位技术在市区和室内环境中具有良好的定位性能,可以有效弥补GPS定位技术的不足,然而,在无线访问节点(Access Point,简称为AP)没有覆盖到的区域,由于AP缺失经常会导致Wi-Fi定位失效。MARG传感器(一种基于三轴陀螺、三轴加速度计以及三轴磁强计组成的传感器组合)构成了一种自主式定位系统,能够提供载体的位置、速度和姿态信息,在短时间内具有很好的定位精度,但是由于存在累积误差,长时间内定位精度较差。为了有效融合这三种特性互补的定位技术,人们提出了多种方法,可以分为以下三类,下面对这三种方式进行具体描述。
1)基于粒子滤波的Wi-Fi/MARG组合定位系统
基于粒子滤波的Wi-Fi/MARG组合定位系统的基本思想是:首先利用Wi-Fi定位算法获得移动目标的位置估计,然后建立粒子滤波方程,对移动目标的位置估计进行滤波处理。
上述方式有效融合了Wi-Fi和MARG这两种定位技术的互补特性,不仅校正了由接收信号强度浮动和Wi-Fi接入点非连续覆盖引起的Wi-Fi定位误差,还解决了由MARG传感器引起的累积误差,在市区和室内环境下都能取得较好的定位性能。然而,对于Wi-Fi接入点没有覆盖到的郊区,Wi-Fi/MARG组合定位系统的定位性能将会极度恶化,甚至无法使用。
2)基于卡尔曼滤波的GPS/MARG组合定位系统
基于卡尔曼滤波的GPS/MARG组合定位系统的基本思想是:首先利用GPS定位算法获得移动目标的位置估计,然后MARG传感器获得的载体姿态信息,构造卡尔曼滤波器的状态方程和观测方程,对用户的位置估计进行滤波处理。该方法有效融合了这两种定位技术的互补特性,不仅能够很好地弥补GPS信号阻塞的间隙,而且还可以利用GPS获得的位置和速度信息,修正MARG传感器的累积误差。然而,在GPS信号完全阻塞的室内环境中,GPS/MARG组合定位系统的定位性能将会极度恶化,甚至无法使用。
3)基于数值加权的GPS/Wi-Fi组合定位系统
基于数值加权的GPS/Wi-Fi组合定位系统的基本思想是:首先利用GPS和Wi-Fi定位分别获得移动目标的位置信息;然后,根据GPS的水平精度衰减因子(HorizontalDilution of Precision,HDOP)来决定加权因子。由于GPS在室外空旷地区,能够取得很好的定位精度,因此在AP缺失的区域,可以利用GPS获得准确的位置信息;同时在高楼林立的市区,可以利用WLAN定位来弥补GPS定位的不足,通过这种方式在室外环境下可以取得良好的定位性能,然而在室内环境下,由于GPS信号被遮挡,无法改善WLAN室内定位的精度,同时由于只考虑利用水平精度衰减因子,组合性能相对较差。
针对上述的问题,目前尚未提出有效的解决方案。
发明内容
本发明实施例提供了一种定位方法、装置及系统,以至少解决现有技术中由单独采用GPS/MARG组合定位系统或者Wi-Fi/MARG组合定位系统进行定位而导致的在有些环境下对移动目标的定位准确性较低的技术问题。
根据本发明实施例的一个方面,提供了一种定位方法,包括:计算得到GPS/MARG组合定位系统当前的定位性能参数;如果上述定位性能参数符合预先设置的条件,则启动Wi-Fi/MARG组合定位系统进行定位;根据上述GPS/MARG组合定位系统定位得到的结果和上述Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息。
优选地,在计算得到GPS/MARG组合定位系统当前的定位性能参数之后,上述方法还包括:如果上述定位性能参数不符合预先设置的条件,则将上述GPS/MARG组合定位系统定位得到的结果作为上述移动目标的位置信息。
优选地,上述计算得到GPS/MARG组合定位系统当前的定位性能参数包括:获取当前时刻GPS接收机的水平精度衰减因子;计算上述GPS/MARG组合定位系统的失效率,其中,上述失效率是当前时刻GPS接收机的测量值与卡尔曼滤波后更新的结果之间的差值;根据上述水平精度衰减因子和上述失效率计算得到上述定位性能参数。
优选地,符合上述预先设置的条件包括:上述定位性能参数大于预定的参数阈值。
优选地,按照以下公式计算上述GPS/MARG组合定位系统的失效率:
其中,rgps,k表示当前时刻GPS/MARG组合定位系统的失效率,lgps,k表示当前时刻GPS/MARG组合定位系统输出的移动目标的位置信息,Φgps,k表示状态转换矩阵,k是时刻标识;|| ||表示求欧式距离,表示当前时刻的前一时刻利用卡尔曼滤波获得的所述移动目标的位置估计值;
按照以下公式计算得到上述定位性能参数:
Cgps,k=αrgps,k+(1-α)HDOP
其中,Cgps,k表示上述定位性能参数,α表示加权因子,0≤α≤1,HDOP表示水平精度衰减因子。
优选地,上述根据上述GPS/MARG组合定位系统定位得到的结果和上述Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息包括:将上述定位性能参数作为加权系数;根据上述加权系数对上述GPS/MARG组合定位系统定位得到的结果和上述Wi-Fi/MARG组合定位系统定位得到的结果进行加权运算计算得到上述移动目标的位置信息。
优选地,按照以下公式计算上述移动目标的位置信息:
其中,lk表示计算得到的上述移动目标的位置信息,rgps,k表示当前时刻GPS/MARG组合定位系统的失效率,rwifi,k表示当前时刻Wi-Fi/MARG组合定位系统的失效率,lgps,k表示当前时刻GPS/MARG组合定位系统输出的移动目标的位置信息,lwifi,k表示当前时刻Wi-Fi/MARG组合定位系统输出的移动目标的位置信息,k是时刻标识。
根据本发明实施例的另一方面,提供了一种定位装置,包括:第一计算单元,用于计算GPS/MARG组合定位系统当前的定位性能参数;启动单元,用于在上述定位性能参数符合预先设置的条件情况下,启动Wi-Fi/MARG组合定位系统进行定位;第二计算单元,用于根据上述GPS/MARG组合定位系统定位得到的结果和上述Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息。
优选地,上述第一计算单元包括:获取模块,用于获取当前时刻GPS接收机的水平精度衰减因子;第一计算模块,用于计算上述GPS/MARG组合定位系统的失效率,其中,上述失效率是当前时刻GPS接收机的测量值与卡尔曼滤波后更新的结果之间的差值;第二计算模块,用于根据上述水平精度衰减因子和上述失效率计算得到上述定位性能参数。
优选地,上述第二计算单元包括:确定模块,用于将上述定位性能参数作为加权系数;运算模块,用于根据上述加权系数对上述GPS/MARG组合定位系统定位得到的结果和上述Wi-Fi/MARG组合定位系统定位得到的结果进行加权运算计算得到上述移动目标的位置信息。
根据本发明实施例的另一方面,提供了一种定位系统,包括:Wi-Fi定位装置、MARG传感器、GPS接收机,粒子滤波器、卡尔曼滤波器、性能检测装置,以及组合定位装置,其中,上述Wi-Fi定位装置的输出端与上述粒子滤波器的输入端相连;上述GPS接收机的输出端与上述卡尔曼滤波器的输入端相连;上述MARG传感器通过姿态信息获取单元分别与上述粒子滤波器和上述卡尔曼滤波器相连;上述性能检测装置的输入端分别与上述GPS接收机的输出端和上述卡尔曼滤波器的输出端相连,用于计算GPS/MARG组合定位系统当前的定位性能参数;上述组合定位装置,分别与上述粒子滤波器的输出端和上述性能检测装置的输出端相连,用于根据上述GPS/MARG组合定位系统定位得到的结果和上述Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息。
优选地,上述性能检测装置的输出端通过单刀双掷开关与上述组合定位装置相连,其中,上述性能检测装置的输出端与上述单刀双掷开关的输入端相连,上述单刀双掷开关的第一输出端与上述组合定位装置的输入端相连,上述单刀双掷开关的第二输出端与输出线路相连;上述Wi-Fi定位装置输出端通过第一开关与上述粒子滤波器的输入端相连;上述粒子滤波器的输出端通过第二开关与上述组合定位装置的输入端相连;在上述定位性能参数符合预先设置的条件情况下,上述单刀双掷开关的输入端与上述单刀双掷开关的第一输出端处于导通状态,上述第一开关和上述第二开关处于闭合状态。
在本发明实施例中,同时采用了GPS/MARG组合定位系统和Wi-Fi/MARG组合定位系统,当GPS/MARG组合定位系统的定位性能参数不能满足要求时,就开启Wi-Fi/MARG组合定位系统进行定位,然后结合这两个组合定位系统定位得到的结果最终计算的到移动目标的位置信息,从而实现对移动目标的准确定位。通过上述方式解决了现有技术中单独采用GPS/MARG组合定位系统或者Wi-Fi/MARG组合定位系统进行定位而导致的在有些环境下对移动目标的定位准确性较低的技术问题,达到了提高定位系统在各个环境下的定位准确性的技术效果,扩大了定位系统的使用范围。
附图说明
此处所说明的附图用来提供对本发明的进一步理解,构成本申请的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1是根据本发明实施例的定位方法的一种优选流程图;
图2是根据本发明实施例的计算定位性能参数的一种优选流程图;
图3是根据本发明实施例的定位装置的一种优选结构框图;
图4是根据本发明实施例的第一计算单元的一种优选结构框图;
图5是根据本发明实施例的第二计算单元的一种优选结构框图;
图6是根据本发明实施例的定位系统的一种优选结构框图;
图7是根据本发明实施例的基于实施例中的定位系统进行定位的定位方法的一种优选流程图。
具体实施方式
下文中将参考附图并结合实施例来详细说明本发明。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
本发明实施例提供了一种优选的定位方法,如图1所示,该方法包括以下步骤:
步骤S102:计算得到GPS/MARG组合定位系统当前的定位性能参数;
步骤S104:如果定位性能参数符合预先设置的条件,则启动Wi-Fi/MARG组合定位系统进行定位;
步骤S106:根据GPS/MARG组合定位系统定位得到的结果和Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息。
在上述优选实施方式中,同时采用了GPS/MARG组合定位系统和Wi-Fi/MARG组合定位系统,当GPS/MARG组合定位系统的定位性能参数不能满足要求时,就开启Wi-Fi/MARG组合定位系统进行定位,然后结合这两个组合定位系统定位得到的结果最终计算的到移动目标的位置信息,从而实现对移动目标的准确定位。通过上述方式解决了现有技术中单独采用GPS/MARG组合定位系统或者Wi-Fi/MARG组合定位系统进行定位而导致的在有些环境下对移动目标的定位准确性较低的技术问题,达到了提高定位系统在各个环境下的定位准确性的技术效果,扩大了定位系统的使用范围。
为了减少定位系统的功耗,如果说单独使用GPS/MARG组合定位系统的定位性能参数已经能够满足要求,则可知直接以该GPS/MARG组合定位系统的定位结果作为移动目标的位置信息。在一个优选实施方式中,在计算得到GPS/MARG组合定位系统当前的定位性能参数之后,上述方法还包括:如果定位性能参数不符合预先设置的条件,则将GPS/MARG组合定位系统定位得到的结果作为移动目标的位置信息。
对于上述的定位性能参数可以是水平精度衰减因子,然而,如果仅采用水平精度衰减因子,作为定位性能参数,其组合性能相对较差,为了解决组合性能较差的问题,可以引入失效率的概念,从而更为有效地获取定位性能参数。在一个有效实施方式,如图2所示,计算得到GPS/MARG组合定位系统当前的定位性能参数可以包括以下步骤:
步骤S202:获取当前时刻GPS接收机的水平精度衰减因子;
步骤S204:计算GPS/MARG组合定位系统的失效率,其中,失效率是当前时刻GPS接收机的测量值与卡尔曼滤波后更新的结果之间的差值;
步骤S206:根据水平精度衰减因子和失效率计算得到定位性能参数。
在上述各个优选实施方式中,符合预先设置的条件可以包括:定位性能参数大于预定的参数阈值,即,预先定义一个参数阈值,如果大于该阈值,则认为GPS/MARG组合定位系统的定位效果不能满足要求,这个时候便需要开启Wi-Fi/MARG组合定位系统进行定位。
本优选实施例还提供了一种优选的计算失效率的公式,该公式为:
其中,rgps,k表示当前时刻GPS/MARG组合定位系统的失效率,lgps,k表示当前时刻GPS/MARG组合定位系统输出的移动目标的位置信息,Φgps,k表示状态转换矩阵,k是时刻标识;|| ||表示求欧式距离,表示当前时刻的前一时刻利用卡尔曼滤波获得的所述移动目标的位置估计值;
其中,在二维和三维空间中的欧氏距离就是两点之间的距离:
在二维空间中计算欧式距离的公式为:d=sqrt((x1-x2)^2+(y1-y2)^2);
在三维空间中计算欧式距离的公式为:d=sqrt(x1-x2)^2+(y1-y2)^2+(z1-z2)^2)
推广到n维空间中,计算欧氏距离的公式为:d=sqrt(∑(xi1-xi2)^2),其中,i=1,2..n。xi1表示第一个点的第i维坐标,xi2表示第二个点的第i维坐标。
在明确了失效率和水平衰因子后,可以按照以下公式计算定位性能参数:
Cgps,k=αrgps,k+(1-α)HDOP
其中,Cgps,k表示定位性能参数,α表示加权因子,0≤α≤1,α的具体大小可以根据实验数据选取,HDOP表示水平精度衰减因子。
如果是根据GPS/MARG组合定位系统定位得到的结果和Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息,可以将定位性能参数作为加权系数,用该加权系数最终确定移动目标的位置信息。在一个优选实施方式中,根据GPS/MARG组合定位系统定位得到的结果和Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息包括:将定位性能参数作为加权系数;根据加权系数对GPS/MARG组合定位系统定位得到的结果和Wi-Fi/MARG组合定位系统定位得到的结果进行加权运算计算得到移动目标的位置信息。
在计算移动目标的位置信息的过程中,可以按照以下公式进行计算:
其中,lk表示计算得到的移动目标的位置信息,rgps,k表示当前时刻GPS/MARG组合定位系统的失效率,rwifi,k表示当前时刻Wi-Fi/MARG组合定位系统的失效率,lgps,k表示当前时刻GPS/MARG组合定位系统输出的移动目标的位置信息,lwifi,k表示当前时刻Wi-Fi/MARG组合定位系统输出的移动目标的位置信息,k是时刻标识,-1表示求矩阵的逆。
在本实施例中还提供了一种定位装置,该装置用于实现上述实施例及优选实施方式,已经进行过说明的不再赘述。如以下所使用的,术语“单元”或者“模块”可以实现预定功能的软件和/或硬件的组合。尽管以下实施例所描述的装置较佳地以软件来实现,但是硬件,或者软件和硬件的组合的实现也是可能并被构想的。图3是根据本发明实施例的定位装置的一种优选结构框图,如图3所示,包括:第一计算单元302、启动单元304以及第二计算单元306,下面对该结构进行说明。
第一计算单元302,用于计算GPS/MARG组合定位系统当前的定位性能参数;
启动单元304,与第一计算单元302耦合,用于在定位性能参数符合预先设置的条件情况下,启动Wi-Fi/MARG组合定位系统进行定位;
第二计算单元306,与启动单元304耦合,用于根据GPS/MARG组合定位系统定位得到的结果和Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息。
在一个优选实施方式中,如图4所示,第一计算单元包括:获取模块402,用于获取当前时刻GPS接收机的水平精度衰减因子;第一计算模块404,用于计算GPS/MARG组合定位系统的失效率,其中,失效率是当前时刻GPS接收机的测量值与卡尔曼滤波后更新的结果之间的差值;第二计算模块406,与获取模块402和第一计算模块404耦合,用于根据水平精度衰减因子和失效率计算得到定位性能参数。
在一个优选实施方式中,如图5所示,第二计算单元包括:确定模块502,用于将定位性能参数作为加权系数;运算模块504,与确定模块502耦合,用于根据加权系数对GPS/MARG组合定位系统定位得到的结果和Wi-Fi/MARG组合定位系统定位得到的结果进行加权运算计算得到移动目标的位置信息。
本发明实施例还提供了一种优选的定位系统,如图6所示,包括:Wi-Fi定位装置602、MARG传感器604、GPS接收机606,粒子滤波器608、卡尔曼滤波器610、性能检测装置612,以及组合定位装置614,其中,
Wi-Fi定位装置602的输出端与粒子滤波器608的输入端相连;
GPS接收机606的输出端与卡尔曼滤波器610的输入端相连;
MARG传感器604通过姿态信息获取单元616分别与粒子滤波器608和卡尔曼滤波器610相连;
性能检测装置614的输入端分别与GPS接收机606的输出端和卡尔曼滤波器610的输出端相连,用于计算GPS/MARG组合定位系统当前的定位性能参数;
组合定位装置614,分别与粒子滤波器608的输出端和性能检测装置612的输出端相连,用于根据GPS/MARG组合定位系统定位得到的结果和Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息。
为了实现在满足条件的情况下,即GPS/MARG组合定位系统的定位效果不能满足预定要求的情况下,才会开启Wi-Fi/MARG组合定位系统的目的。可以如图6所示,设置控制开关,通过控制开关的开闭来控制是否采用Wi-Fi/MARG组合定位系统进行定位。在一个优选实施方式中,性能检测装置的输出端通过单刀双掷开关(K1)与组合定位装置相连,其中,性能检测装置的输出端与单刀双掷开关的输入端相连,单刀双掷开关的第一输出端(b)与组合定位装置的输入端相连,所述单刀双掷开关的第二输出端(a)与输出线路相连;
Wi-Fi定位装置输出端通过第一开关(K2)与粒子滤波器的输入端相连;
粒子滤波器的输出端通过第二开关(K3)与组合定位装置的输入端相连;
在定位性能参数符合预先设置的条件情况下,单刀双掷开关的输入端与单刀双掷开关的第一输出端处于导通状态,第一开关(K2)和第二开关(K3)处于闭合状态。
上述的基于自适应加权算法的GPS/Wi-Fi/MARG组合定位系统,该系统融合特性互补的Wi-Fi/MARG组合定位子系统和GPS/MARG组合定位子系统,解决了现有技术中GPS/Wi-Fi/MARG组合定位系统存在的不足。本优选实施例还根据卡尔曼滤波器定义了一个失效率因子,同时结合GPS的水平衰减因子,提出一种自适应加权算法融合Wi-Fi/MARG组合定位子系统和GPS/MARG组合定位子系统,不仅有效提高了定位精度,还实现了室内室外的无缝定位,扩大了定位系统的使用范围。
基于上述的自适应加权算法的GPS/Wi-Fi/MARG组合定位系统,如图7所示,该定位方法主要包括以下几个步骤:
步骤S702:基于卡尔曼滤波的GPS/MARG组合进行定位。主要包括:
S1:GPS接收机接收卫星信号,计算位置,建立GPS测量输出模型;
S2:将MARG传感器获得的滚动角、俯仰角、航向角,以及载体速度信息等信息作为卡尔曼滤波状态值的输入,并建立MARG传感器模型;
S3:进行卡尔曼滤波的状态一步预测;
S4:计算预测误差方差矩阵;
S5:计算滤波增益矩阵;
S6:状态估计;
S7:估计误差方差计算。
步骤S704:性能检测。主要包括:
S1:获得当前时刻GPS接收机的水平精度衰减因子。粒子滤波器输出载体的位置信息,载体航向角信息,速度信息。其中,位置信息作为移动用户(移动目标)的位置估计。
S2:计算失效率,其中,失效率定义为当前时刻GPS测量值与卡尔曼滤波后得到的值之间的差值。
S3:利用水平精度衰减因子和失效率,计算GPS/MARG组合定位子系统定位性能参数。
步骤S706:阈值判定。主要包括:
S1:设定阈值参数;
S2:判定GPS/MARG组合定位子系统定位性能参数是小于阈值还是大于阈值。
S3:如果小于阈值,则直接将GPS/MARG组合定位子系统的定位结果作为整个定位系统的输出,即将其作为移动目标的最终定位信息。
S4:如果大于阈值,则启动Wi-Fi/MARG组合定位子系统。
步骤S708:基于粒子滤波的Wi-Fi/MARG组合进行定位。主要包括:
S1:MARG传感器获得的滚动角、俯仰角、航向角,以及载体速度信息,将其作为粒子滤波器的输入。
S2:初始化粒子,优选地,可以采用高斯分布来初始化粒子的概率密度函数,其中,均值为移动目标的初始位置;
S3:预测,可以利用载体航向角、速度信息,以及WLAN定位的结果,通过粒子滤波预测目标下一步的位置信息;
S4:粒子权重计算及归一化,可以通过测量模型和现在的测量值来求取每个粒子的权重,当粒子位置越靠近目标当前估计位置时,粒子获得的权重越大。
S5:重采样,可以根据后验概率密度函数来产生新的粒子,解决粒子退化问题。
步骤S710:组合定位。主要包括:
S1:获得GPS/MARG组合定位的结果;
S2:获得Wi-Fi/MARG组合定位的结果;
S3:将GPS/MARG组合定位子系统的定位性能参数作为加权参数,对预测GPS/MARG组合定位的结果和Wi-Fi/MARG组合定位的结果进行加权融合,从而获得移动目标的最终位置信息。
本发明实施例还给出了一种具体的实施方法,下面对其进行详细描述。
GPS/Wi-Fi/MARG组合定位系统实现框图如图6所示,主要由三部分组成:基于粒子滤波的Wi-Fi/MARG组合定位子系统、基于卡尔曼滤波的GPS/MARG组合定位子系统、以及基于自适应加权算法的两种子系统的组合定位。
其中,基于自适应加权算法的两种定位子系统的组合定位实现分为以下步骤:
S1:首先由GPS接收机接收卫星信号,计算位置,建立卡尔曼滤波系统方程融合MARG传感器数据,减小多径等因素对GPS的影响,最终获得移动目标准确的位置信息。
S2:接着进行性能检测,其中,性能检测主要由GPS的水平精度衰减因子(Horizontal Dilution of Precision,简称为HDOP)和失效率决定。GPS的精度衰减因子整体上反映了有效可视卫星的空间几何结构对移动目标导航精度的影响,其中,可视卫星的数目是影响精度衰减因子的主要因素之一,通常,随着可视卫星数目的增加,精度衰减因子将减小,精度衰减因子与GPS定位精度之间的关系表1所示。然而,精度衰减因子只是很粗糙地反映了GPS定位精度,因此在本优选实施例中提出了另外一个参数:失效率。
表1
HDOP | 1 | 1-2 | 2-5 | 5-10 | 10-20 | >20 |
定位精度 | 理想 | 极好 | 好 | 中等 | 尚可 | 差 |
上述失效率可以定义为当前时刻GPS测量值与卡尔曼滤波后更新值之间的差值,可以通过以下公式计算得到失效率:
其中,lgps,k为当前时刻GPS/MARG组合定位子系统输出的移动目标的位置信息,Φgps,k为状态转换矩阵,|| ||表示求欧式距离,表示当前时刻的前一时刻利用卡尔曼滤波获得的所述移动目标的位置估计值;
GPS定位性能Cgps,k由GPS的水平精度衰减因子和失效率共同决定,可以通过以下公式计算得到:
Cgps,k=αrgps,k+(1-α)HDOP
其中,α表示加权因子,0≤α≤1,具体大小可以根据实验数据选取。
S3:当GPS的定位性能指标Cgps,k小于设定的阈值时,就认为GPS/MARG定位子系统的性能已经能够满足移动目标定位性能的需求,因此GPS/MARG定位子系统的输出可以直接作为整个定位系统的输出,相应的,在图6中,可以是开关闭合到a点,即,此时并不启动Wi-Fi/MARG组合定位子系统进行定位。
S4:当GPS的定位性能指标Cgps,k大于设定的阈值时,就认为GPS/MARG定位子系统的输出不可靠,已经无法满足移动目标定位性能的需求。此时启动Wi-Fi/MARG组合定位子系统,相应的,在图6中将开关闭合到b点。定位系统的输出为两个组合定位子系统输出,具体数值可以通过以下公式计算得到:
其中,rwifi,k表示Wi-Fi/MARG组合定位子系统的失效率,定义为当前时刻Wi-Fi定位系统测量值与粒子滤波后更新值之间的差值,lwifi,k为当前时刻Wi-Fi/MARG组合定位子系统输出的移动目标的位置信息。
通过上述数据融合的GPS/Wi-Fi/MARG组合定位系统进行定位,有效地利用了特性互补的两个定位子系统,显著改善了Wi-Fi/MARG定位子系统和GPS/MARG定位子系统中出现的各种问题,不仅显著提高了定位精度,还实现了室内室外的无缝定位,扩大了定位系统的使用范围。
在另外一个实施例中,还提供了一种软件,该软件用于执行上述实施例及优选实施方式中描述的技术方案。
在另外一个实施例中,还提供了一种存储介质,该存储介质中存储有上述软件,该存储介质包括但不限于:光盘、软盘、硬盘、可擦写存储器等。
从以上的描述中,可以看出,本发明实现了如下技术效果:同时采用了GPS/MARG组合定位系统和Wi-Fi/MARG组合定位系统,当GPS/MARG组合定位系统的定位性能参数不能满足要求时,就开启Wi-Fi/MARG组合定位系统进行定位,然后结合这两个组合定位系统定位得到的结果最终计算的到移动目标的位置信息,从而实现对移动目标的准确定位。通过上述方式解决了现有技术中单独采用GPS/MARG组合定位系统或者Wi-Fi/MARG组合定位系统进行定位而导致的在有些环境下对移动目标的定位准确性较低的技术问题,达到了提高定位系统在各个环境下的定位准确性的技术效果,扩大了定位系统的使用范围。
显然,本领域的技术人员应该明白,上述的本发明的各模块或各步骤可以用通用的计算装置来实现,它们可以集中在单个的计算装置上,或者分布在多个计算装置所组成的网络上,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,并且在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。这样,本发明不限制于任何特定的硬件和软件结合。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种定位方法,其特征在于,包括:
计算得到GPS/MARG组合定位系统当前的定位性能参数;
如果所述定位性能参数符合预先设置的条件,则启动Wi-Fi/MARG组合定位系统进行定位;
根据所述GPS/MARG组合定位系统定位得到的结果和所述Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息;
所述计算得到GPS/MARG组合定位系统当前的定位性能参数包括:
获取当前时刻GPS接收机的水平精度衰减因子;
计算所述GPS/MARG组合定位系统的失效率,其中,所述失效率是当前时刻GPS接收机的测量值与卡尔曼滤波后更新的结果之间的差值;
根据所述水平精度衰减因子和所述失效率计算得到所述定位性能参数。
2.根据权利要求1所述的方法,其特征在于,在计算得到GPS/MARG组合定位系统当前的定位性能参数之后,所述方法还包括:
如果所述定位性能参数不符合预先设置的条件,则将所述GPS/MARG组合定位系统定位得到的结果作为所述移动目标的位置信息。
3.根据权利要求1或2所述的方法,其特征在于,符合所述预先设置的条件包括:所述定位性能参数大于预定的参数阈值。
4.根据权利要求1所述的方法,其特征在于,
按照以下公式计算所述GPS/MARG组合定位系统的失效率:
其中,rgps,k表示当前时刻GPS/MARG组合定位系统的失效率,lgps,k表示当前时刻GPS/MARG组合定位系统输出的移动目标的位置信息,Φgps,k表示状态转换矩阵,k是时刻标识;||||表示求欧式距离,表示当前时刻的前一时刻利用卡尔曼滤波获得的所述移动目标的位置估计值;
按照以下公式计算得到所述定位性能参数:
Cgps,k=αrgps,k+(1-α)HDOP
其中,Cgps,k表示所述定位性能参数,α表示加权因子,0≤α≤1,HDOP表示水平精度衰减因子。
5.根据权利要求1或2所述的方法,其特征在于,所述根据所述GPS/MARG组合定位系统定位得到的结果和所述Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息包括:
将所述定位性能参数作为加权系数;
根据所述加权系数对所述GPS/MARG组合定位系统定位得到的结果和所述Wi-Fi/MARG组合定位系统定位得到的结果进行加权运算计算得到所述移动目标的位置信息。
6.根据权利要求5所述的方法,其特征在于,按照以下公式计算所述移动目标的位置信息:
其中,lk表示计算得到的所述移动目标的位置信息,rgps,k表示当前时刻GPS/MARG组合定位系统的失效率,rwifi,k表示当前时刻Wi-Fi/MARG组合定位系统的失效率,lgps,k表示当前时刻GPS/MARG组合定位系统输出的移动目标的位置信息,lwifi,k表示当前时刻Wi-Fi/MARG组合定位系统输出的移动目标的位置信息,k是时刻标识。
7.一种定位装置,其特征在于,包括:
第一计算单元,用于计算GPS/MARG组合定位系统当前的定位性能参数;
启动单元,用于在所述定位性能参数符合预先设置的条件情况下,启动Wi-Fi/MARG组合定位系统进行定位;
第二计算单元,用于根据所述GPS/MARG组合定位系统定位得到的结果和所述Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息;
所述第一计算单元包括:
获取模块,用于获取当前时刻GPS接收机的水平精度衰减因子;
第一计算模块,用于计算所述GPS/MARG组合定位系统的失效率,其中,所述失效率是当前时刻GPS接收机的测量值与卡尔曼滤波后更新的结果之间的差值;
第二计算模块,用于根据所述水平精度衰减因子和所述失效率计算得到所述定位性能参数。
8.根据权利要求7所述的装置,其特征在于,所述第二计算单元包括:
确定模块,用于将所述定位性能参数作为加权系数;
运算模块,用于根据所述加权系数对所述GPS/MARG组合定位系统定位得到的结果和所述Wi-Fi/MARG组合定位系统定位得到的结果进行加权运算计算得到所述移动目标的位置信息。
9.一种定位系统,其特征在于,包括:Wi-Fi定位装置、MARG传感器、GPS接收机,粒子滤波器、卡尔曼滤波器、性能检测装置,以及组合定位装置,其中,
所述Wi-Fi定位装置的输出端与所述粒子滤波器的输入端相连;
所述GPS接收机的输出端与所述卡尔曼滤波器的输入端相连;
所述MARG传感器通过姿态信息获取单元分别与所述粒子滤波器和所述卡尔曼滤波器相连;
所述性能检测装置的输入端分别与所述GPS接收机的输出端和所述卡尔曼滤波器的输出端相连,用于计算GPS/MARG组合定位系统当前的定位性能参数;
所述组合定位装置,分别与所述粒子滤波器的输出端和所述性能检测装置的输出端相连,用于在确定所述定位性能参数符合预先设置条件的情况下,启动Wi-Fi/MARG组合定位系统进行定位,以及用于根据所述GPS/MARG组合定位系统定位得到的结果和所述Wi-Fi/MARG组合定位系统定位得到的结果计算得到移动目标的位置信息;
所述性能检测装置用于计算GPS/MARG组合定位系统当前的定位性能参数包括:
获取当前时刻GPS接收机的水平精度衰减因子;
计算所述GPS/MARG组合定位系统的失效率,其中,所述失效率是当前时刻GPS接收机的测量值与卡尔曼滤波后更新的结果之间的差值;
根据所述水平精度衰减因子和所述失效率计算得到所述定位性能参数。
10.根据权利要求9所述的定位系统,其特征在于,
所述性能检测装置的输出端通过单刀双掷开关与所述组合定位装置相连,其中,所述性能检测装置的输出端与所述单刀双掷开关的输入端相连,所述单刀双掷开关的第一输出端与所述组合定位装置的输入端相连,所述单刀双掷开关的第二输出端与输出线路相连;
所述Wi-Fi定位装置输出端通过第一开关与所述粒子滤波器的输入端相连;
所述粒子滤波器的输出端通过第二开关与所述组合定位装置的输入端相连;
在所述定位性能参数符合预先设置的条件情况下,所述单刀双掷开关的输入端与所述单刀双掷开关的第一输出端处于导通状态,所述第一开关和所述第二开关处于闭合状态。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210486831.5A CN103841638B (zh) | 2012-11-26 | 2012-11-26 | 定位方法、装置及系统 |
PCT/CN2013/082230 WO2014079245A1 (zh) | 2012-11-26 | 2013-08-23 | 定位方法、装置及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210486831.5A CN103841638B (zh) | 2012-11-26 | 2012-11-26 | 定位方法、装置及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103841638A CN103841638A (zh) | 2014-06-04 |
CN103841638B true CN103841638B (zh) | 2018-06-22 |
Family
ID=50775478
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210486831.5A Expired - Fee Related CN103841638B (zh) | 2012-11-26 | 2012-11-26 | 定位方法、装置及系统 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN103841638B (zh) |
WO (1) | WO2014079245A1 (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105050052A (zh) * | 2015-06-04 | 2015-11-11 | 大连理工大学 | 一种基于卡方距离及灵敏度法则的无线局域网室内定位方法 |
CN108966127B (zh) * | 2018-07-18 | 2021-03-30 | 广东小天才科技有限公司 | 结合Wi-Fi指纹与卫星定位的定位纠偏方法和定位服务器 |
CN113079458B (zh) * | 2021-03-19 | 2023-02-28 | 甄十信息科技(上海)有限公司 | 一种用于可穿戴移动终端定位的方法及设备 |
CN113932809B (zh) * | 2021-11-26 | 2024-03-12 | 昆山九毫米电子科技有限公司 | 基于智能粒子滤波的室内无人靶车定位方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1875290A (zh) * | 2003-09-19 | 2006-12-06 | 高通股份有限公司 | 用于在位置确定技术中整合无线计算机网络的系统和方法 |
CN101799530A (zh) * | 2009-12-29 | 2010-08-11 | 广东广联电子科技有限公司 | 一种无线室内定位方法和系统 |
CN102333351A (zh) * | 2011-06-27 | 2012-01-25 | 北京邮电大学 | 定位技术切换的方法及移动设备 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20110131781A (ko) * | 2010-05-31 | 2011-12-07 | 삼성전자주식회사 | 위치정보의 정확도 확인방법 및 장치 |
US8812014B2 (en) * | 2010-08-30 | 2014-08-19 | Qualcomm Incorporated | Audio-based environment awareness |
-
2012
- 2012-11-26 CN CN201210486831.5A patent/CN103841638B/zh not_active Expired - Fee Related
-
2013
- 2013-08-23 WO PCT/CN2013/082230 patent/WO2014079245A1/zh active Application Filing
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1875290A (zh) * | 2003-09-19 | 2006-12-06 | 高通股份有限公司 | 用于在位置确定技术中整合无线计算机网络的系统和方法 |
CN101799530A (zh) * | 2009-12-29 | 2010-08-11 | 广东广联电子科技有限公司 | 一种无线室内定位方法和系统 |
CN102333351A (zh) * | 2011-06-27 | 2012-01-25 | 北京邮电大学 | 定位技术切换的方法及移动设备 |
Also Published As
Publication number | Publication date |
---|---|
CN103841638A (zh) | 2014-06-04 |
WO2014079245A1 (zh) | 2014-05-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Yang et al. | A novel NLOS error compensation method based IMU for UWB indoor positioning system | |
US9594150B2 (en) | Determining device locations using movement, signal strength | |
CN105588566B (zh) | 一种基于蓝牙与mems融合的室内定位系统及方法 | |
CN104796866B (zh) | 室内定位方法和装置 | |
CN106908821A (zh) | 一种室内外无缝定位切换方法 | |
KR101231378B1 (ko) | 파티클 필터 기반의 사용자 위치 추적 장치 및 기록매체 | |
CN105424030A (zh) | 基于无线指纹和mems传感器的融合导航装置和方法 | |
CN103841638B (zh) | 定位方法、装置及系统 | |
US8130103B2 (en) | Method of reducing power consumption of a radio badge in a boundary detection localization system | |
US10057831B2 (en) | Communications | |
CN106646574A (zh) | 室内外无缝定位方法及定位系统 | |
CN110579780B (zh) | 一种基于北斗geo卫星的阴影匹配改进算法 | |
CN107941211A (zh) | 基于二阶级联的多元素融合定位方法、装置及电子设备 | |
CN105683778A (zh) | 用于移动装置的低电力定位技术 | |
CN107655474A (zh) | 一种基于智能终端的导航方法及导航系统 | |
Rohrig et al. | Estimation of position and orientation of mobile systems in a wireless LAN | |
CN104884895A (zh) | 电子罗盘校准方法和终端 | |
KR101264306B1 (ko) | 이동 모델 학습을 통한 실내 위치 추적 장치 및 이를 위한 기록매체 | |
CN106028450B (zh) | 室内定位方法及设备 | |
CN103813444B (zh) | 选择用于定位的接入点的装置和方法 | |
CN109379702A (zh) | 一种三维传感器网络节点定位方法及系统 | |
EP2982157B1 (en) | Determining effects on communication signals | |
US10054688B2 (en) | Method and apparatus for saving power during synthetic positioning in GNSS receivers | |
Elbakly et al. | Cone: Zero-calibration accurate confidence estimation for indoor localization systems | |
CN109633531A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180622 Termination date: 20201126 |