WO2019218291A1 - Method and device used for filtering positioning data - Google Patents
Method and device used for filtering positioning data Download PDFInfo
- Publication number
- WO2019218291A1 WO2019218291A1 PCT/CN2018/087199 CN2018087199W WO2019218291A1 WO 2019218291 A1 WO2019218291 A1 WO 2019218291A1 CN 2018087199 W CN2018087199 W CN 2018087199W WO 2019218291 A1 WO2019218291 A1 WO 2019218291A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- filters
- positioning data
- filter
- current time
- calculating
- Prior art date
Links
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
- 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/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0294—Trajectory determination or predictive filtering, e.g. target tracking or Kalman filtering
-
- 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/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- 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/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
-
- 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
-
- 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
- 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/20—Instruments for performing navigational calculations
-
- 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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/66—Radar-tracking systems; Analogous systems
- G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
- G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
-
- 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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/66—Radar-tracking systems; Analogous systems
- G01S13/72—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
- G01S13/723—Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
- G01S13/726—Multiple target tracking
-
- 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
- G01S2205/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S2205/01—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations specially adapted for specific applications
- G01S2205/02—Indoor
Definitions
- the positioning data prediction value for each of the two filters at the current time is based on the predicted value of the positioning data for the filter at the previous time, and is calculated Calculated for the mixed input of the filter, a given and invariant transition matrix, a given and invariant observation matrix, and the coefficient gain of the current time (eg, but not limited to, using equation (3) ) Calculated).
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
A method and device used for filtering positioning data, the method comprising: receiving positioning data outputted by a positioning engine at a current moment (302); using an interactive multi-model consisting of two different filters to filter positioning data to be processed based on the received positioning data so as to obtain filtered positioning data (306). By using the method and device, the accuracy and robustness of positioning may be improved.
Description
本发明涉及定位领域,尤其涉及用于对定位数据滤波的方法、装置和处理设备以及定位设备和计算机可读存储介质。The present invention relates to the field of positioning, and more particularly to a method, apparatus and processing apparatus for filtering positioning data, and positioning apparatus and computer readable storage medium.
室内定位技术是一种用于对位于室内的目标对象(例如,人员、车辆等)进行定位的技术,其在室内的不同位置布置多个信号发射源,然后由定位引擎根据从这些信号发射源中的若干个信号发射源接收的信号连续地计算目标对象的定位数据并输出所计算的定位数据。室内定位技术在许多不同的领域中得到了广泛地应用。Indoor positioning technology is a technology for locating target objects (eg, people, vehicles, etc.) located indoors, which arranges multiple signal transmission sources at different locations in the room, and then is based on the source from these signals. The signals received by the plurality of signal transmitting sources continuously calculate the positioning data of the target object and output the calculated positioning data. Indoor positioning technology is widely used in many different fields.
由于遮挡和各个信号发射源之间的不良同步的缘故,用于室内定位的定位引擎所计算的定位数据经常与目标对象的真实位置有差距并且也不太稳定。为此,现有技术已经提出利用一个滤波器(例如,均值滤波器、卡尔曼滤波器等)来对定位引擎输出的定位数据进行滤波以提供定位的准确性和鲁棒性。然而,目前这种利用一个滤波器来对定位引擎输出的定位数据进行滤波的技术,对定位的准确性和鲁棒性的提高还不太令人满意。Due to the poor synchronization between the occlusion and the individual signal sources, the positioning data calculated by the positioning engine for indoor positioning often differs from the true position of the target object and is also less stable. To this end, the prior art has proposed to utilize a filter (eg, mean filter, Kalman filter, etc.) to filter the positioning data output by the positioning engine to provide positioning accuracy and robustness. However, the current technique of filtering the positioning data output by the positioning engine by using a filter is not satisfactory for the accuracy and robustness of positioning.
发明内容Summary of the invention
考虑到现有技术的以上问题,本发明的实施例提供一种用于对定位数据滤波的方法、装置和处理设备以及定位设备和计算机可读存储介质,其能够提高定位的准确性和鲁棒性。In view of the above problems of the prior art, embodiments of the present invention provide a method, apparatus, and processing apparatus for filtering positioning data, and a positioning apparatus and a computer readable storage medium capable of improving positioning accuracy and robustness Sex.
按照本发明的实施例的一种用于对定位数据滤波的方法,包括:接收定位引擎当前时刻输出的定位数据;以及,利用由两个不同的滤波器组成的交互式多模型对基于所接收的定位数据的待处理定位数 据进行滤波,以得到已滤波的定位数据。A method for filtering positioning data according to an embodiment of the present invention, comprising: receiving positioning data output by a positioning engine at a current time; and using an interactive multi-model pair composed of two different filters based on the received The to-be-processed positioning data of the positioning data is filtered to obtain filtered positioning data.
按照本发明的实施例的一种用于对定位数据滤波的装置,包括:接收模块,用于接收定位引擎当前时刻输出的定位数据;以及,滤波模块,用于利用由两个不同的滤波器组成的交互式多模型对基于所接收的定位数据的待处理定位数据进行滤波,以得到已滤波的定位数据。An apparatus for filtering positioning data according to an embodiment of the present invention includes: a receiving module, configured to receive positioning data output by a positioning engine at a current time; and a filtering module configured to utilize two different filters The composed interactive multi-model filters the to-be-processed positioning data based on the received positioning data to obtain filtered positioning data.
按照本发明的实施例的一种用于对定位数据滤波的处理设备,包括:处理器;以及,存储器,其存储有可执行指令,所述可执行指令当被执行时使得所述处理器执行前述方法所包括的操作。A processing apparatus for filtering positioning data, comprising: a processor; and a memory storing executable instructions that, when executed, cause the processor to execute, in accordance with an embodiment of the present invention The operations included in the foregoing methods.
按照本发明的实施例的一种机器可读存储介质,其上具有可执行指令,当所述可执行指令被执行时,使得机器执行前述方法所包括的操作。A machine readable storage medium having executable instructions thereon that, when executed, cause a machine to perform the operations included in the foregoing methods, in accordance with an embodiment of the present invention.
按照本发明的实施例的一种定位设备,包括:定位引擎,用于连续地计算目标对象的定位数据并输出所计算的定位数据;以及,前述的处理设备。A positioning apparatus according to an embodiment of the present invention includes: a positioning engine for continuously calculating positioning data of a target object and outputting the calculated positioning data; and the aforementioned processing device.
本发明的实施例的方案利用由两个滤波器组成的交互式多模型来对定位引擎输出的定位数据进行滤波,由于与单个滤波器相比,组合两个滤波器的滤波结果而得到的定位更加准确和稳定,因此,与现有技术相比,本发明的实施例的方案能够提高定位的准确性和鲁棒性。The scheme of the embodiment of the present invention utilizes an interactive multi-model composed of two filters to filter the positioning data output by the positioning engine, and the positioning obtained by combining the filtering results of the two filters is compared with a single filter. It is more accurate and stable, and therefore, the solution of the embodiment of the present invention can improve the accuracy and robustness of positioning as compared with the prior art.
本发明的其它特征、特点、益处和优点通过以下结合附图的详细描述将变得更加显而易见。其中:Other features, characteristics, advantages and advantages of the present invention will become more apparent from the detailed description of the appended claims. among them:
图1示出了按照本发明的一个实施例的定位设备的结构示意图;FIG. 1 is a block diagram showing the structure of a positioning apparatus according to an embodiment of the present invention; FIG.
图2示出了按照本发明的一个实施例的用于对定位数据滤波的方法的总体流程图;2 shows a general flow diagram of a method for filtering positioning data in accordance with one embodiment of the present invention;
图3示出了按照本发明的一个实施例的用于对定位数据滤波的方法的示意图;3 shows a schematic diagram of a method for filtering positioning data in accordance with one embodiment of the present invention;
图4示出了按照本发明的一个实施例的用于对定位数据滤波的 装置的示意图;Figure 4 shows a schematic diagram of an apparatus for filtering positioning data in accordance with one embodiment of the present invention;
图5示出了按照本发明的一个实施例的用于对定位数据滤波的处理设备的示意图;以及Figure 5 shows a schematic diagram of a processing device for filtering positioning data in accordance with one embodiment of the present invention;
图6示出了按照本发明的一个实施例的定位设备的示意图。Figure 6 shows a schematic diagram of a positioning device in accordance with one embodiment of the present invention.
下面将参考附图详细描述本发明的各个实施例。Various embodiments of the present invention will be described in detail below with reference to the accompanying drawings.
图1示出了按照本发明的一个实施例的定位设备的结构示意图。如图1所示,定位设备10可以包括定位引擎20和处理设备30。定位引擎20用于例如根据从放置在室内的不同位置的多个信号发射源中的若干信号发射源接收的信号来连续地计算位于室内的目标对象T的定位数据并输出所计算的定位数据。处理设备30用于利用由卡尔曼一阶(first order:FO)滤波器和卡尔曼匀速(constant velocity:CV)滤波器组成的交互式多模型(Interacting Multiple Model,简称IMM)P来对定位引擎20各个时刻输出的定位数据进行滤波,以得到各个时刻的已滤波的定位数据,这将在下面参考图2详细说明。Figure 1 shows a block diagram of a positioning apparatus in accordance with one embodiment of the present invention. As shown in FIG. 1, the positioning device 10 can include a positioning engine 20 and a processing device 30. The positioning engine 20 is for continuously calculating positioning data of a target object T located indoors and outputting the calculated positioning data, for example, based on signals received from a plurality of signal transmission sources among a plurality of signal transmission sources placed at different positions in the room. The processing device 30 is configured to use an Interacting Multiple Model (IMM) P composed of a Kalman first-order (FO) filter and a constant velocity (CV) filter to locate the positioning engine. The positioning data outputted at each time is filtered to obtain filtered positioning data at each moment, which will be described in detail below with reference to FIG.
图2示出了按照本发明的一个实施例的用于对定位数据滤波的方法的总体流程图。图2所示的方法200由处理设备30来实现。2 shows a general flow diagram of a method for filtering positioning data in accordance with one embodiment of the present invention. The method 200 shown in FIG. 2 is implemented by the processing device 30.
如图2所示,在方框202,处理设备30接收定位引擎20当前时刻输出的定位数据。为了便于描述,假设当前时刻是k时刻,将定位引擎20当前时刻输出的定位数据表示为
其也被称为由硬件***测量得到的观测值。
As shown in FIG. 2, at block 202, processing device 30 receives positioning data that is output by positioning engine 20 at the current time. For convenience of description, it is assumed that the current time is the k time, and the positioning data output by the positioning engine 20 at the current time is expressed as It is also referred to as the observations measured by the hardware system.
在方框206,处理设备30对所接收的定位数据
进行预处理,得到待处理定位数据
预处理的目的在于消除其明显偏离最近接收到的定位数据的那些异常的定位数据。例如但不局限于,如果定位数据
被判定是异常的定位数据,则计算在当前时刻之前的多个时刻接收到的定位数据的平均值,作为待处理定位数据
以及,如果定位数据
被判定是正常的定位数据,则待处理定位数据
是定位数据
At block 206, the processing device 30 pairs the received positioning data Perform pre-processing to obtain pending positioning data The purpose of the pre-processing is to eliminate those abnormal positioning data that deviate significantly from the most recently received positioning data. For example but not limited to if positioning data If it is determined that the positioning data is abnormal, the average value of the positioning data received at a plurality of times before the current time is calculated as the positioning data to be processed. And if positioning data If it is determined that it is normal positioning data, the positioning data to be processed Is positioning data
在方框210,处理设备30利用等式(1)计算当前时刻的交互式多模型P中的卡尔曼FO滤波器的滤波结果的占比
(其表示在当前时刻的交互式多模型P中的卡尔曼FO滤波器和卡尔曼CV滤波器的滤波结果的总和中,当前时刻的交互式多模型P中的卡尔曼FO滤波器的滤波结果占据的比例)和当前时刻的交互式多模型P中的卡尔曼CV滤波器的滤波结果的占比
(其表示在当前时刻的交互式多模型P中的卡尔曼FO滤波器和卡尔曼CV滤波器的滤波结果的总和中,当前时刻的交互式多模型P中的卡尔曼CV滤波器的滤波结果占据的比例)。
At block 210, the processing device 30 calculates the proportion of the filtered results of the Kalman FO filter in the interactive multi-model P at the current time using equation (1). (It represents the filtering result of the Kalman FO filter in the interactive multi-model P at the current time in the sum of the filtering results of the Kalman FO filter and the Kalman CV filter in the interactive multi-model P at the current time. Proportion of the filtered results of the Kalman CV filter in the interactive multi-model P at the current time (It represents the filtering result of the Kalman CV filter in the interactive multi-model P at the current time in the sum of the filtering results of the Kalman FO filter and the Kalman CV filter in the interactive multi-model P at the current time. Occupied ratio).
其中,M
1表示交互式多模型P中的卡尔曼FO滤波器的马尔科夫链转移概率,M
2表示交互式多模型P中的卡尔曼CV滤波器的马尔科夫链转移概率,M
1和M
2是已给定的常数,
表示上一时刻(即k-1时刻)的交互式多模型P选择卡尔曼FO滤波器的概率,
表示上一时刻的交互式多模型P选择卡尔曼CV滤波器的概率,以及,
Where M 1 represents the Markov chain transition probability of the Kalman FO filter in the interactive multi-model P, and M 2 represents the Markov chain transition probability of the Kalman CV filter in the interactive multi-model P, M 1 And M 2 is a given constant, The probability of selecting the interactive multi-model P-selected Kalman FO filter at the previous moment (ie, time k-1), The probability of representing the interactive multi-model P-selected Kalman CV filter at the previous moment, and,
在方框214,处理设备30利用等式(2)分别计算针对交互式多模型P中的卡尔曼FO滤波器的混合输入InputMixing
A1和针对交互式多模型P中的卡尔曼CV滤波器的混合输入InputMixing
A2。
At block 214, the processing device 30 calculates a mixture of the mixed input InputMixing A1 for the Kalman FO filter in the interactive multi-model P and the Kalman CV filter for the interactive multi-model P, respectively, using equation (2). Enter InputMixing A2 .
其中,
表示上一时刻的交互式多模型P中的卡尔曼FO滤波器输出的初步滤波结果,以及,
表示上一时刻的交互式多模型P中的卡尔曼CV滤波器输出的初步滤波结果。
among them, Representing the preliminary filtering result of the Kalman FO filter output in the interactive multi-model P at the previous moment, and Represents the preliminary filtering result of the Kalman CV filter output in the interactive multi-model P at the previous moment.
在方框218,处理设备30利用等式(3)计算当前时刻的用于交互式多模型P中的卡尔曼FO滤波器的定位数据预测值
和当前时 刻的用于交互式多模型P中的卡尔曼CV滤波器的定位数据预测值
At block 218, the processing device 30 calculates the positioning data prediction values for the Kalman FO filter in the interactive multi-model P at the current time using equation (3). Positioning data prediction values for the Kalman CV filter in the interactive multi-model P at the current time
其中,F
k表示给定且不变的转移矩阵,H表示给定且不变的观测矩阵,
表示上一时刻的用于交互式多模型P中的卡尔曼FO滤波器的定位数据预测值,
表示上一时刻的用于交互式多模型P中的卡尔曼CV滤波器的定位数据预测值,K
k表示当前时刻的系数增益,
R表示给定且不变的测量噪声的协方差,
表示当前时刻的先验协方差矩阵,
Q表示给定且不变的处理噪声协方差,
表示上一时刻的的先验协方差矩阵。
Where F k represents a given and invariant transition matrix, and H represents a given and invariant observation matrix, Representing the predicted value of the positioning data for the Kalman FO filter in the interactive multi-model P at the previous moment, Representing the predicted value of the positioning data for the Kalman CV filter in the interactive multi-model P at the previous moment, K k represents the coefficient gain of the current time, R represents the covariance of a given and constant measurement noise, a priori covariance matrix representing the current moment, Q represents the given and constant processing noise covariance, Represents the a priori covariance matrix of the previous moment.
在方框222,处理设备30使用交互式多模型P中的卡尔曼FO滤波器对定位数据预测值
进行滤波,所得到的滤波结果作为当前时刻的交互式多模型P中的卡尔曼FO滤波器的初步滤波结果
以及,使用交互式多模型P中的卡尔曼CV滤波器对定位数据预测值
进行滤波,所得到的滤波结果作为当前时刻的交互式多模型P中的卡尔曼CV滤波器的初步滤波结果
At block 222, processing device 30 uses the Kalman FO filter in interactive multi-model P to predict the positioning data. Filtering is performed, and the obtained filtering result is used as a preliminary filtering result of the Kalman FO filter in the interactive multi-model P at the current time. And using the Kalman CV filter in the interactive multi-model P to predict the positioning data Filtering is performed, and the obtained filtering result is used as a preliminary filtering result of the Kalman CV filter in the interactive multi-model P at the current time.
在方框226,处理设备30利用等式(4)计算针对交互式多模型P中的卡尔曼FO滤波器的滤波参数值eK
A1和针对交互式多模型P中的卡尔曼CV滤波器的滤波参数值eK
A2。
At block 226, processing device 30 calculates a filter parameter value eK A1 for the Kalman FO filter in the interactive multi-model P and a filter for the Kalman CV filter in the interactive multi-model P using equation (4) The parameter value is eK A2 .
其中,P
noise表示给定且不变的测量噪声的协方差。
Where P noise represents the covariance of the given and constant measurement noise.
在方框230,处理设备30利用等式(5)计算当前时刻的交互式多模型P选择卡尔曼FO滤波器的概率
和当前时刻的交互式多模型P选择卡尔曼CV滤波器的概率
At block 230, processing device 30 calculates the probability of interactive multi-model P-selected Kalman FO filter at the current time using equation (5) Probability of selecting a Kalman CV filter with an interactive multi-model P at the current moment
在方框234,处理设备30利用等式(6)计算交互式多模型P的滤波输出Output,作为交互式多模型P对当前时刻的待处理定位数据
的滤波结果。
At block 234, the processing device 30 calculates the filtered output Output of the interactive multi-model P using equation (6) as the interactive multi-model P versus the current positional pending data. Filter results.
然后,在方框234之后,流程返回到方框202,以对定位引擎下一时刻(即k+1时刻)输出的定位数据
进行滤波。
Then, after block 234, the flow returns to block 202 to locate the positioning data for the next time the positioning engine (i.e., time k+1). Filtering is performed.
本实施例的方案利用由两个滤波器(即,卡尔曼FO滤波器和卡尔曼CV滤波器)组成的交互式多模型来对定位引擎输出的定位数据进行滤波,由于与单个滤波器相比,组合两个滤波器的滤波结果而得到的定位更加准确和稳定,因此,本实施例的方案能够提高定位的准确性和鲁棒性。The scheme of this embodiment utilizes an interactive multi-model consisting of two filters (ie, a Kalman FO filter and a Kalman CV filter) to filter the positioning data output by the positioning engine, as compared to a single filter. The positioning obtained by combining the filtering results of the two filters is more accurate and stable. Therefore, the solution of the embodiment can improve the accuracy and robustness of the positioning.
其它变型Other variants
本领域技术人员将理解,虽然在上面的实施例中,当前时刻的用于交互式多模型P中的卡尔曼FO滤波器的定位数据预测值和当前时刻的用于交互式多模型P中的卡尔曼CV滤波器的定位数据预测值是利用等式(3)计算得到的,然而,本发明并不局限于此。在本发明的其它一些实施例中,也可以将利用等式(4)计算的针对交互式多模型P中的卡尔曼FO滤波器的滤波参数值eK
A1,作为当前时刻的用于交互式多模型P中的卡尔曼FO滤波器的定位数据预测值,以及,将利用等式(4)计算的针对交互式多模型P中的卡尔曼CV滤波器 的滤波参数值eK
A2,作为当前时刻的用于交互式多模型P中的卡尔曼CV滤波器的定位数据预测值,在这种情况下,利用等式(3)计算的
和
分别是当前时刻的用于交互式多模型P中的卡尔曼FO滤波器的辅助计算值和当前时刻的用于交互式多模型P中的卡尔曼CV滤波器的辅助计算值。
Those skilled in the art will appreciate that although in the above embodiments, the positioning data prediction values for the Kalman FO filter in the interactive multi-model P at the current time and the current time are used in the interactive multi-model P The predicted value of the positioning data of the Kalman CV filter is calculated using Equation (3), however, the present invention is not limited thereto. In some other embodiments of the present invention, the filter parameter value eK A1 for the Kalman FO filter in the interactive multi-model P calculated by using equation (4) may also be used as the current time for interactive multi-induction. The positioning data prediction value of the Kalman FO filter in the model P, and the filter parameter value eK A2 for the Kalman CV filter in the interactive multi-model P calculated using Equation (4) as the current time Positioning data prediction value for the Kalman CV filter in the interactive multi-model P, in this case, calculated using equation (3) with The auxiliary calculation values for the Kalman FO filter in the interactive multi-model P at the current time and the auxiliary calculation values for the Kalman CV filter in the interactive multi-model P at the current time are respectively.
本领域技术人员将理解,虽然在上面的实施例中,方法200包括方框206以对所接收的定位数据
进行预处理,然而,本发明并不局限于此。在本发明的其它一些实施例中,方法200也可以不包括方框206,在这种情况下,待处理定位数据
就是所接收的定位数据
Those skilled in the art will appreciate that while in the above embodiments, method 200 includes block 206 for receiving the received positioning data. The pretreatment is performed, however, the invention is not limited thereto. In some other embodiments of the invention, method 200 may also not include block 206, in which case the location data to be processed Is the received positioning data.
本领域技术人员将理解,虽然在上面的实施例中,交互式多模型P由卡尔曼FO滤波器和卡尔曼CV滤波器组成,然而,本发明并不局限于此。在本发明的其它一些实施例中,交互式多模型P可以例如由卡尔曼FO滤波器和卡尔曼CV滤波器的其中一个和另一个其它的滤波器(例如,均值滤波器等)组成,或者,例如由除了卡尔曼FO滤波器和卡尔曼CV滤波器之外的其它两个滤波器来组成。Those skilled in the art will appreciate that although in the above embodiment, the interactive multi-model P is composed of a Kalman FO filter and a Kalman CV filter, the present invention is not limited thereto. In some other embodiments of the present invention, the interactive multi-model P may be composed, for example, of one of a Kalman FO filter and a Kalman CV filter and another filter (eg, an averaging filter, etc.), or For example, it consists of two other filters than the Kalman FO filter and the Kalman CV filter.
本领域技术人员将理解,本发明的方案不但适用于室内定位的情形,也适用于室外定位的情形。Those skilled in the art will appreciate that the solution of the present invention is applicable not only to indoor positioning but also to outdoor positioning.
图3示出了按照本发明的一个实施例的用于对定位数据滤波的方法的流程图。如图3所示的方法300可以由处理设备30或其它合适的设备来实现。3 shows a flow chart of a method for filtering positioning data in accordance with one embodiment of the present invention. Method 300 as shown in FIG. 3 can be implemented by processing device 30 or other suitable device.
如图3所示,方法300可以包括,在方框302,接收定位引擎当前时刻输出的定位数据。As shown in FIG. 3, method 300 can include, at block 302, receiving positioning data output by the positioning engine at a current time.
方法300还可以包括,在方框306,利用由两个不同的滤波器组成的交互式多模型对基于所接收的定位数据的待处理定位数据进行滤波,以得到已滤波的定位数据。这里,所述待处理定位数据可以是所接收的定位数据或对所接收的定位数据进行预处理后得到的定位数据。The method 300 can also include, at block 306, filtering the to-be-processed positioning data based on the received positioning data using an interactive multi-model consisting of two different filters to obtain filtered positioning data. Here, the to-be-processed positioning data may be the received positioning data or the positioning data obtained by pre-processing the received positioning data.
在第一方面,方框306可以包括:获取所述当前时刻的所述两个 滤波器各自的初步滤波结果,其与所述待处理定位数据相关(例如但不局限于,通过方框210-222来实现);计算所述当前时刻的所述两个滤波器各自的被选择概率,其中,所述当前时刻的每一个滤波器的被选择概率表示在所述当前时刻处所述交互式多模型选择该滤波器的概率(例如但不局限于,通过方框210-230来实现);以及,计算所述当前时刻的所述两个滤波器各自的初步滤波结果与被选择概率的乘积之和,作为所述已滤波的定位数据(例如但不局限于,利用等式(6)计算得到)。In a first aspect, block 306 can include obtaining a respective preliminary filtering result of the two filters at the current time, which is related to the to-be-processed positioning data (eg, but not limited to, by block 210- 222. The method calculates a selected probability of each of the two filters at the current time, wherein a selected probability of each filter of the current time indicates that the interactive time is greater at the current time The probability of the model selecting the filter (such as, but not limited to, implemented by blocks 210-230); and calculating a product of the respective filtered results of the two filters at the current time and the selected probability And as the filtered positioning data (for example, but not limited to, calculated using equation (6)).
在第二方面,所述获取所述当前时刻的所述两个滤波器各自的初步滤波结果包括:基于所述两个滤波器各自的马尔科夫链转移概率和在所述当前时刻之前的上一时刻的所述两个滤波器各自的被选择概率,计算所述当前时刻的所述两个滤波器各自的滤波结果占比(例如但不局限于,利用等式(1)计算得到),其中,所述当前时刻的所述两个滤波器中的任一滤波器的滤波结果占比表示在所述当前时刻的所述两个滤波器的滤波结果总和中,所述当前时刻的该任一滤波器的滤波结果所占据的比例;计算针对所述两个滤波器各自的混合输入(例如但不局限于,利用等式(2)计算得到),其中,针对每一个滤波器的混合输入是基于所述待处理定位数据、所述上一时刻的该滤波器的初步滤波结果、所述两个滤波器各自的马尔科夫链转移概率和所述上一时刻的所述两个滤波器各自的被选择概率而计算的;计算所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值(例如但不局限于,利用等式(3)计算得到);以及,通过利用所述两个滤波器中的每一个滤波器对所述当前时刻的用于该滤波器的定位数据预测值进行滤波,获得所述当前时刻的所述两个滤波器各自的初步滤波结果(例如但不局限于,通过方框222来实现)。In a second aspect, the obtaining the preliminary filtering result of each of the two filters at the current moment comprises: based on a Markov chain transition probability of each of the two filters and before the current moment a selected probability of each of the two filters at a time, calculating a ratio of filtering results of the two filters at the current time (for example, but not limited to, calculated using equation (1)), The ratio of the filtering result of any one of the two filters at the current time is represented by the sum of the filtering results of the two filters at the current time, the current time a ratio of the filtering result of a filter; calculating a mixed input for each of the two filters (for example, but not limited to, calculated using equation (2)), wherein the mixed input for each filter Is based on the to-be-processed positioning data, a preliminary filtering result of the filter at the last moment, a Markov chain transition probability of each of the two filters, and the two filters at the last moment Calculated for each selected probability; calculating a predicted value of the positioning data for each of the two filters at the current time (eg, but not limited to, calculated using equation (3)) And obtaining, by using each of the two filters, the positioning data prediction value for the current time at the current time to obtain the respective two filters of the current time Preliminary filtering results (such as, but not limited to, implemented by block 222).
在第三方面,所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值是基于所述上一时刻的用于该滤波器的定位数据预测值、所计算的针对该滤波器的混合输入、给定且不变的转移矩阵、给定且不变的观测矩阵、以及所述当前时刻的系数增益而计算的(例如但不局限于,利用等式(3)计算得到)。In a third aspect, the positioning data prediction value for each of the two filters at the current time is based on the predicted value of the positioning data for the filter at the previous time, and is calculated Calculated for the mixed input of the filter, a given and invariant transition matrix, a given and invariant observation matrix, and the coefficient gain of the current time (eg, but not limited to, using equation (3) ) Calculated).
在第四方面,所述计算所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值包括:计算所述当前时刻的用于所述两个滤波器中的每一个滤波器的辅助计算值,其是基于所述上一时刻的用于该滤波器的辅助计算值、所计算的针对该滤波器的混合输入、给定且不变的转移矩阵、给定且不变的观测矩阵、以及所述当前时刻的系数增益而计算的(例如但不局限于,利用等式(3)计算得到);以及,确定所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值,其是基于所述待处理定位数据、所述当前时刻的用于该滤波器的辅助计算值和给定且不变的测量噪声的协方差而计算的(例如但不局限于,利用等式(4)计算得到)。In a fourth aspect, the calculating the positioning data prediction value for each of the two filters at the current time comprises: calculating the current time for the two filters An auxiliary calculated value for each filter based on the auxiliary calculated value for the filter at the last moment, the calculated mixed input for the filter, a given and constant transfer matrix, given And an invariant observation matrix, and a coefficient gain of the current time, calculated (for example, but not limited to, calculated using equation (3)); and determining the current time for the two filters a positioning data prediction value for each filter in the device based on the to-be-processed positioning data, the auxiliary calculated value for the filter at the current time, and the covariance of the given and constant measurement noise. Calculated (for example, but not limited to, calculated using equation (4)).
在第五方面,所述计算当前时刻的所述两个滤波器各自的被选择概率包括:计算针对所述两个滤波器各自的滤波参数值,其中,针对所述两个滤波器中的每一个滤波器的滤波参数值是基于所述待处理定位数据、所述当前时刻的用于该滤波器的定位数据预测值和给定且不变的测量噪声的协方差而计算的(例如但不局限于,利用等式(4)计算得到);以及,基于针对所述两个滤波器各自的滤波参数值和所述当前时刻的所述两个滤波器各自的滤波结果占比,确定所述当前时刻的所述两个滤波器各自的被选择概率(例如但不局限于,利用等式(5)计算得到)。In a fifth aspect, the calculating the selected probability of each of the two filters at the current time comprises: calculating a filter parameter value for each of the two filters, wherein for each of the two filters The filter parameter value of a filter is calculated based on the to-be-processed positioning data, the predicted value of the positioning data for the filter at the current time, and the covariance of the given and constant measurement noise (eg, but not Limited to, calculated using equation (4); and determining, based on a respective filter parameter value for each of the two filters and a filter result ratio of each of the two filters at the current time The selected probability of each of the two filters at the current time (such as, but not limited to, calculated using equation (5)).
在第六方面,方法200还可以包括:对所述接收的定位数据进行预处理,以得到所述待处理定位数据(例如但不局限于,通过方框206来实现)。In a sixth aspect, the method 200 can further include pre-processing the received positioning data to obtain the to-be-processed positioning data (such as, but not limited to, implemented by block 206).
图4示出了按照本发明的一个实施例的用于对定位数据滤波的装置的示意图。图4所示的装置400可以利用软件、硬件或软硬件结合的方式来执行。图4所示的装置400例如可以安装在处理设备30或其它合适的设备中。4 shows a schematic diagram of an apparatus for filtering positioning data in accordance with one embodiment of the present invention. The apparatus 400 shown in FIG. 4 can be implemented in a combination of software, hardware, or a combination of software and hardware. The apparatus 400 shown in Figure 4 can be mounted, for example, in the processing device 30 or other suitable device.
如图4所示,装置400可以包括接收模块402和滤波模块406。接收模块402用于接收定位引擎当前时刻输出的定位数据。滤波模块406用于利用由两个不同的滤波器组成的交互式多模型对基于所接收 的定位数据的待处理定位数据进行滤波,以得到已滤波的定位数据。As shown in FIG. 4, apparatus 400 can include a receiving module 402 and a filtering module 406. The receiving module 402 is configured to receive positioning data that is output by the positioning engine at the current time. The filtering module 406 is configured to filter the to-be-processed positioning data based on the received positioning data by using an interactive multi-model composed of two different filters to obtain filtered positioning data.
在第一方面,滤波模块406包括:获取模块,用于获取所述当前时刻的所述两个滤波器各自的初步滤波结果,其与所述待处理定位数据相关;第一计算模块,用于计算所述当前时刻的所述两个滤波器各自的被选择概率,其中,所述当前时刻的每一个滤波器的被选择概率表示在所述当前时刻处所述交互式多模型选择该滤波器的概率;以及,第二计算模块,用于计算所述当前时刻的所述两个滤波器各自的初步滤波结果和被选择概率的乘积之和,作为所述已滤波的定位数据。In a first aspect, the filtering module 406 includes: an obtaining module, configured to acquire a preliminary filtering result of each of the two filters at the current moment, which is related to the to-be-processed positioning data; and a first calculating module, configured to: Calculating a selected probability of each of the two filters at the current time, wherein a selected probability of each filter of the current time indicates that the interactive multi-model selects the filter at the current time And a second calculation module, configured to calculate a sum of products of respective preliminary filtering results and selected probabilities of the two filters at the current moment as the filtered positioning data.
在第二方面,所述获取模块包括:第三计算模块,用于基于所述两个滤波器各自的马尔科夫链转移概率和在所述当前时刻之前的上一时刻的所述两个滤波器各自的被选择概率,计算所述当前时刻的所述两个滤波器各自的滤波结果占比,其中,所述当前时刻的所述两个滤波器中的任一滤波器的滤波结果占比表示在所述当前时刻的所述两个滤波器的滤波结果总和中,所述当前时刻的该任一滤波器的滤波结果所占据的比例;第四计算模块,用于计算针对所述两个滤波器各自的混合输入,其中,针对每一个滤波器的混合输入是基于所述待处理定位数据、所述上一时刻的该滤波器的初步滤波结果、所述两个滤波器各自的马尔科夫链转移概率和所述上一时刻的所述两个滤波器各自的被选择概率而计算的;第五计算模块,用于计算所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值;以及,获得模块,用于通过利用所述两个滤波器中的每一个滤波器对所述当前时刻的用于该滤波器的定位数据预测值进行滤波,获得所述当前时刻的所述两个滤波器各自的初步滤波结果。In a second aspect, the obtaining module includes: a third calculating module, configured to perform, according to a respective Markov chain transition probability of the two filters and the two filters at a previous moment before the current moment The respective selected probabilities of the respective ones of the two filters are calculated at the current time, wherein the filtering results of any one of the two filters at the current time are proportioned a ratio representing a filter result of the filter of the current time at the current time, and a fourth calculation module, configured to calculate for the two a respective mixed input of the filter, wherein the mixed input for each filter is based on the to-be-processed positioning data, the preliminary filtering result of the filter at the last moment, and the respective Marcos of the two filters Calculated by the probability of the chain transition and the selected probability of each of the two filters at the last moment; a fifth calculation module, configured to calculate the current time for the two filters a positioning data prediction value for each of the filters; and an obtaining module for predicting the positioning data for the current time of the filter by using each of the two filters Filtering is performed to obtain a preliminary filtering result of each of the two filters at the current moment.
在第三方面,所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值是基于所述上一时刻的用于该滤波器的定位数据预测值、所计算的针对该滤波器的混合输入、给定且不变的转移矩阵、给定且不变的观测矩阵、以及所述当前时刻的系数增益而计算的。In a third aspect, the positioning data prediction value for each of the two filters at the current time is based on the predicted value of the positioning data for the filter at the previous time, and is calculated Calculated for the mixed input of the filter, the given and invariant transition matrix, the given and invariant observation matrix, and the coefficient gain of the current instant.
在第四方面,所述第五计算模块包括:第六计算模块,用于计算 所述当前时刻的用于所述两个滤波器中的每一个滤波器的辅助计算值,其是基于所述上一时刻的用于该滤波器的辅助计算值、所计算的针对该滤波器的混合输入、给定且不变的转移矩阵、给定且不变的观测矩阵、以及所述当前时刻的系数增益而计算的;以及,第一确定模块,用于确定所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值,其是基于所述待处理定位数据、所述当前时刻的用于该滤波器的辅助计算值和给定且不变的测量噪声的协方差而计算的。In a fourth aspect, the fifth calculation module includes: a sixth calculation module, configured to calculate an auxiliary calculation value for each of the two filters at the current moment, which is based on the The auxiliary calculated value for the filter at the previous moment, the calculated mixed input for the filter, the given and invariant transition matrix, the given and invariant observation matrix, and the coefficients of the current moment Calculated by the gain; and a first determining module, configured to determine a positioning data prediction value for each of the two filters at the current time, based on the to-be-processed positioning data, The current time is calculated for the auxiliary calculated value of the filter and the covariance of the given and constant measurement noise.
在第五方面,所述第一计算模块包括:第七计算模块,用于计算针对所述两个滤波器各自的滤波参数值,其中,针对所述两个滤波器中的每一个滤波器的滤波参数值是基于所述待处理定位数据、所述当前时刻的用于该滤波器的定位数据预测值和给定且不变的测量噪声的协方差而计算的;以及,第二确定模块,用于基于针对所述两个滤波器各自的滤波参数值和所述当前时刻的所述两个滤波器各自的滤波结果占比,确定所述当前时刻的所述两个滤波器各自的被选择概率。In a fifth aspect, the first calculation module includes: a seventh calculation module, configured to calculate a filter parameter value for each of the two filters, wherein, for each of the two filters The filter parameter value is calculated based on the to-be-processed positioning data, the positioning data prediction value for the filter at the current time, and the covariance of the given and constant measurement noise; and a second determining module, Determining, respectively, that each of the two filters of the current time is selected based on a respective filter result ratio of each of the two filters for the filter values of the two filters and the current time Probability.
在第六方面,装置400还可以包括:预处理模块,用于对所述接收的定位数据进行预处理,以得到所述待处理定位数据。In a sixth aspect, the apparatus 400 may further include: a pre-processing module, configured to perform pre-processing on the received positioning data to obtain the to-be-processed positioning data.
图5示出了按照本发明的一个实施例的用于对定位数据滤波的处理设备的示意图。如图5所示,处理设备500可以包括处理器502和与处理器502耦合的存储器504。其中,存储器504存储有可执行指令,所述可执行指令当被执行时使得处理器502执行图2所示的方法200或图3所示的方法300。处理设备500可以由处理设备30或其它合适的设备来实现。Figure 5 shows a schematic diagram of a processing device for filtering positioning data in accordance with one embodiment of the present invention. As shown in FIG. 5, processing device 500 can include a processor 502 and a memory 504 coupled to processor 502. Therein, the memory 504 stores executable instructions that, when executed, cause the processor 502 to perform the method 200 illustrated in FIG. 2 or the method 300 illustrated in FIG. Processing device 500 can be implemented by processing device 30 or other suitable device.
本发明实施例还提供一种机器可读存储介质,其上具有可执行指令,当所述可执行指令被执行时,使得机器执行图2所示的方法200或图3所示的方法300。Embodiments of the present invention also provide a machine readable storage medium having executable instructions thereon that, when executed, cause a machine to perform the method 200 illustrated in FIG. 2 or the method 300 illustrated in FIG.
图6示出了按照本发明的一个实施例的定位设备的示意图。如图6所示,定位设备600可以包括定位引擎602和处理设备606。定位引擎602连续地计算目标对象的定位数据并向处理设备606输出所计算的定位数据,定位引擎602可以例如但不局限于由定位引擎20来实现。处理设备606可以例如但不局限于由处理设备500来实现。Figure 6 shows a schematic diagram of a positioning device in accordance with one embodiment of the present invention. As shown in FIG. 6, positioning device 600 can include positioning engine 602 and processing device 606. Positioning engine 602 continuously calculates positioning data for the target object and outputs the calculated positioning data to processing device 606, which may be implemented by, for example, but not limited to, positioning engine 20. Processing device 606 can be implemented, for example, but not limited to, by processing device 500.
本领域技术人员应当理解,上面所公开的各个实施例可以在不偏离发明实质的情况下做出各种变形、修改和改变,这些变形、修改和改变都应当落入在本发明的保护范围之内。因此,本发明的保护范围由所附的权利要求书来限定。It should be understood by those skilled in the art that various modifications, changes and modifications may be made without departing from the spirit of the invention. Inside. Therefore, the scope of the invention is defined by the appended claims.
Claims (17)
- 一种用于对定位数据滤波的方法,包括:A method for filtering positioning data, comprising:接收定位引擎当前时刻输出的定位数据;以及Receiving positioning data output by the positioning engine at the current moment;利用由两个不同的滤波器组成的交互式多模型对基于所接收的定位数据的待处理定位数据进行滤波,以得到已滤波的定位数据。The to-be-processed positioning data based on the received positioning data is filtered using an interactive multi-model consisting of two different filters to obtain filtered positioning data.
- 如权利要求1所述的方法,其中,所述利用由两个不同的滤波器组成的交互式多模型对基于所接收的定位数据的待处理定位数据进行滤波包括:The method of claim 1 wherein said filtering the to-be-processed positioning data based on the received positioning data using an interactive multi-model consisting of two different filters comprises:获取所述当前时刻的所述两个滤波器各自的初步滤波结果,其与所述待处理定位数据相关;Obtaining, respectively, a preliminary filtering result of each of the two filters at the current moment, which is related to the to-be-processed positioning data;计算所述当前时刻的所述两个滤波器各自的被选择概率,其中,所述当前时刻的每一个滤波器的被选择概率表示在所述当前时刻处所述交互式多模型选择该滤波器的概率;以及Calculating a selected probability of each of the two filters at the current time, wherein a selected probability of each filter of the current time indicates that the interactive multi-model selects the filter at the current time Probability;计算所述当前时刻的所述两个滤波器各自的初步滤波结果与被选择概率的乘积之和,作为所述已滤波的定位数据。Calculating a sum of products of respective preliminary filtering results and selected probabilities of the two filters at the current time as the filtered positioning data.
- 如权利要求2所述的方法,其中,所述获取所述当前时刻的所述两个滤波器各自的初步滤波结果包括:The method of claim 2, wherein the obtaining the preliminary filtering results of the two filters of the current moment comprises:基于所述两个滤波器各自的马尔科夫链转移概率和在所述当前时刻之前的上一时刻的所述两个滤波器各自的被选择概率,计算所述当前时刻的所述两个滤波器各自的滤波结果占比,其中,所述当前时刻的所述两个滤波器中的任一滤波器的滤波结果占比表示在所述当前时刻的所述两个滤波器的滤波结果总和中,所述当前时刻的该任一滤波器的滤波结果所占据的比例;Calculating the two filters of the current time based on a respective Markov chain transition probability of the two filters and a selected probability of each of the two filters at a previous time before the current time The respective filter result ratios of the respective filters, wherein the filter result ratio of any one of the two filters at the current time is represented by the sum of the filter results of the two filters at the current time The ratio of the filtering result of any of the filters at the current time;计算针对所述两个滤波器各自的混合输入,其中,针对每一个滤波器的混合输入是基于所述待处理定位数据、所述上一时刻的该滤波器的初步滤波结果、所述两个滤波器各自的马尔科夫链转移概率和所述上一时刻的所述两个滤波器各自的被选择概率而计算的;Calculating a mixing input for each of the two filters, wherein a mixing input for each filter is based on the to-be-processed positioning data, a preliminary filtering result of the filter at the last moment, the two Calculating the respective Markov chain transition probabilities of the filters and the selected probabilities of the two filters at the last moment;计算所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值;以及Calculating a predicted value of the positioning data for each of the two filters at the current time; and通过利用所述两个滤波器中的每一个滤波器对所述当前时刻的用于该滤波器的定位数据预测值进行滤波,获得所述当前时刻的所述两个滤波器各自的初步滤波结果。Obtaining a preliminary filtering result of each of the two filters at the current time by filtering the positioning data prediction value for the current time at the current time by using each of the two filters .
- 如权利要求3所述的方法,其中,The method of claim 3, wherein所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值是基于所述上一时刻的用于该滤波器的定位数据预测值、所计算的针对该滤波器的混合输入、给定且不变的转移矩阵、给定且不变的观测矩阵、以及所述当前时刻的系数增益而计算的。The positioning data prediction value for each of the two filters at the current time is based on the positioning data prediction value for the filter at the last moment, and the calculated for the filter The mixed input, the given and constant transfer matrix, the given and invariant observation matrix, and the coefficient gain of the current time are calculated.
- 如权利要求3所述的方法,其中,所述计算所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值包括:The method of claim 3, wherein said calculating a positioning data prediction value for each of said two filters at said current time comprises:计算所述当前时刻的用于所述两个滤波器中的每一个滤波器的辅助计算值,其是基于所述上一时刻的用于该滤波器的辅助计算值、所计算的针对该滤波器的混合输入、给定且不变的转移矩阵、给定且不变的观测矩阵、以及所述当前时刻的系数增益而计算的;以及Calculating an auxiliary calculation value for each of the two filters at the current time, which is based on the auxiliary calculation value for the filter at the last moment, and the calculated for the filter Calculated by the mixed input of the device, the given and constant transfer matrix, the given and invariant observation matrix, and the coefficient gain of the current time;确定所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值,其是基于所述待处理定位数据、所述当前时刻的用于该滤波器的辅助计算值和给定且不变的测量噪声的协方差而计算的。Determining, at the current time, a positioning data prediction value for each of the two filters, which is based on the to-be-processed positioning data, an auxiliary calculation value for the filter at the current time Calculated with the covariance of the given and constant measurement noise.
- 如权利要求4所述的方法,其中,所述计算当前时刻的所述两个滤波器各自的被选择概率包括:The method of claim 4, wherein said calculating a selected probability of each of said two filters at a current time comprises:计算针对所述两个滤波器各自的滤波参数值,其中,针对所述两个滤波器中的每一个滤波器的滤波参数值是基于所述待处理定位数据、所述当前时刻的用于该滤波器的定位数据预测值和给定且不变的测量噪声的协方差而计算的;以及Calculating a filter parameter value for each of the two filters, wherein a filter parameter value for each of the two filters is based on the to-be-processed positioning data, the current time for the Calculated by the predicted value of the positioning data of the filter and the covariance of the given and constant measurement noise;基于针对所述两个滤波器各自的滤波参数值和所述当前时刻的 所述两个滤波器各自的滤波结果占比,确定所述当前时刻的所述两个滤波器各自的被选择概率。Determining a selected probability of each of the two filters at the current time based on a respective filter result value for each of the two filters and a filter result ratio of each of the two filters at the current time.
- 如权利要求1所述的方法,还包括:The method of claim 1 further comprising:对所述接收的定位数据进行预处理,以得到所述待处理定位数据。Pre-processing the received positioning data to obtain the to-be-processed positioning data.
- 一种用于对定位数据滤波的装置,包括:An apparatus for filtering positioning data, comprising:接收模块,用于接收定位引擎当前时刻输出的定位数据;以及a receiving module, configured to receive positioning data output by the positioning engine at a current time;滤波模块,用于利用由两个不同的滤波器组成的交互式多模型对基于所接收的定位数据的待处理定位数据进行滤波,以得到已滤波的定位数据。And a filtering module, configured to filter the to-be-processed positioning data based on the received positioning data by using an interactive multi-model composed of two different filters to obtain filtered positioning data.
- 如权利要求8所述的装置,其中,所述滤波模块包括:The apparatus of claim 8 wherein said filtering module comprises:获取模块,用于获取所述当前时刻的所述两个滤波器各自的初步滤波结果,其与所述待处理定位数据相关;An obtaining module, configured to acquire a preliminary filtering result of each of the two filters at the current moment, which is related to the to-be-processed positioning data;第一计算模块,用于计算所述当前时刻的所述两个滤波器各自的被选择概率,其中,所述当前时刻的每一个滤波器的被选择概率表示在所述当前时刻处所述交互式多模型选择该滤波器的概率;以及a first calculating module, configured to calculate a selected probability of each of the two filters at the current moment, wherein a selected probability of each filter of the current moment represents the interaction at the current moment The probability that the multi-model selects the filter;第二计算模块,用于计算所述当前时刻的所述两个滤波器各自的初步滤波结果和被选择概率的乘积之和,作为所述已滤波的定位数据。And a second calculating module, configured to calculate, as the filtered positioning data, a sum of products of respective preliminary filtering results and selected probabilities of the two filters at the current moment.
- 如权利要求9所述的装置,其中,所述获取模块包括:The apparatus of claim 9, wherein the obtaining module comprises:第三计算模块,用于基于所述两个滤波器各自的马尔科夫链转移概率和在所述当前时刻之前的上一时刻的所述两个滤波器各自的被选择概率,计算所述当前时刻的所述两个滤波器各自的滤波结果占比,其中,所述当前时刻的所述两个滤波器中的任一滤波器的滤波结果占比表示在所述当前时刻的所述两个滤波器的滤波结果总和中,所述当前时刻的该任一滤波器的滤波结果所占据的比例;a third calculating module, configured to calculate the current based on a respective Markov chain transition probability of the two filters and a selected probability of each of the two filters at a previous time before the current time a filter result ratio of each of the two filters at a time, wherein a filter result ratio of any one of the two filters at the current time indicates the two at the current time a ratio of a filter result of the filter at the current time in a sum of filter results of the filter;第四计算模块,用于计算针对所述两个滤波器各自的混合输入,其中,针对每一个滤波器的混合输入是基于所述待处理定位数据、所述上一时刻的该滤波器的初步滤波结果、所述两个滤波器各自的马尔科夫链转移概率和所述上一时刻的所述两个滤波器各自的被选择概率而计算的;a fourth calculation module, configured to calculate a hybrid input for each of the two filters, wherein a hybrid input for each filter is based on the to-be-processed positioning data, the preliminary of the filter at the last moment Calculating a result of the filtering, a Markov chain transition probability of each of the two filters, and a selected probability of each of the two filters at the last moment;第五计算模块,用于计算所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值;以及a fifth calculating module, configured to calculate a positioning data prediction value for each of the two filters at the current moment;获得模块,用于通过利用所述两个滤波器中的每一个滤波器对所述当前时刻的用于该滤波器的定位数据预测值进行滤波,获得所述当前时刻的所述两个滤波器各自的初步滤波结果。Obtaining a module, configured to filter, by using each of the two filters, the positioning data prediction value for the current time of the filter to obtain the two filters of the current moment Their respective preliminary filtering results.
- 如权利要求10所述的装置,其中,The device of claim 10, wherein所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值是基于所述上一时刻的用于该滤波器的定位数据预测值、所计算的针对该滤波器的混合输入、给定且不变的转移矩阵、给定且不变的观测矩阵、以及所述当前时刻的系数增益而计算的。The positioning data prediction value for each of the two filters at the current time is based on the positioning data prediction value for the filter at the last moment, and the calculated for the filter The mixed input, the given and constant transfer matrix, the given and invariant observation matrix, and the coefficient gain of the current time are calculated.
- 如权利要求10所述的装置,其中,所述第五计算模块包括:The apparatus of claim 10 wherein said fifth computing module comprises:第六计算模块,用于计算所述当前时刻的用于所述两个滤波器中的每一个滤波器的辅助计算值,其是基于所述上一时刻的用于该滤波器的辅助计算值、所计算的针对该滤波器的混合输入、给定且不变的转移矩阵、给定且不变的观测矩阵、以及所述当前时刻的系数增益而计算的;以及a sixth calculation module, configured to calculate an auxiliary calculation value for each of the two filters at the current moment, which is an auxiliary calculation value for the filter based on the last moment Calculated for the mixed input of the filter, a given and invariant transition matrix, a given and invariant observation matrix, and the coefficient gain of the current time;第一确定模块,用于确定所述当前时刻的用于所述两个滤波器中的每一个滤波器的定位数据预测值,其是基于所述待处理定位数据、所述当前时刻的用于该滤波器的辅助计算值和给定且不变的测量噪声的协方差而计算的。a first determining module, configured to determine a positioning data prediction value for each of the two filters at the current moment, which is based on the to-be-processed positioning data, the current moment The auxiliary calculated value of the filter is calculated from the covariance of the given and constant measurement noise.
- 如权利要求11所述的装置,其中,所述第一计算模块包括:The apparatus of claim 11 wherein said first computing module comprises:第七计算模块,用于计算针对所述两个滤波器各自的滤波参数 值,其中,针对所述两个滤波器中的每一个滤波器的滤波参数值是基于所述待处理定位数据、所述当前时刻的用于该滤波器的定位数据预测值和给定且不变的测量噪声的协方差而计算的;以及a seventh calculation module, configured to calculate a filter parameter value for each of the two filters, wherein a filter parameter value for each of the two filters is based on the to-be-processed positioning data, Calculating the predicted value of the positioning data for the filter at the current time and the covariance of the given and constant measurement noise;第二确定模块,用于基于针对所述两个滤波器各自的滤波参数值和所述当前时刻的所述两个滤波器各自的滤波结果占比,确定所述当前时刻的所述两个滤波器各自的被选择概率。a second determining module, configured to determine the two filters of the current moment based on respective filter parameter values of the two filters and respective filter result proportions of the two filters at the current moment The respective selected probabilities.
- 如权利要求8所述的装置,还包括:The apparatus of claim 8 further comprising:预处理模块,用于对所述接收的定位数据进行预处理,以得到所述待处理定位数据。And a pre-processing module, configured to perform pre-processing on the received positioning data to obtain the to-be-processed positioning data.
- 一种用于对定位数据滤波的处理设备,包括:A processing device for filtering positioning data, comprising:处理器;以及Processor;存储器,其存储有可执行指令,所述可执行指令当被执行时使得所述处理器执行权利要求1-7中的任意一个所述的方法。A memory, which stores executable instructions that, when executed, cause the processor to perform the method of any one of claims 1-7.
- 一种机器可读存储介质,其上具有可执行指令,当所述可执行指令被执行时,使得机器执行权利要求1-7中的任意一个所述的方法。A machine readable storage medium having executable instructions thereon that, when executed, cause a machine to perform the method of any one of claims 1-7.
- 一种定位设备,包括:A positioning device comprising:定位引擎,用于连续地计算目标对象的定位数据并输出所计算的定位数据;以及a positioning engine for continuously calculating positioning data of a target object and outputting the calculated positioning data;如权利要求15所述的处理设备。A processing apparatus according to claim 15.
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP18918812.1A EP3796028A4 (en) | 2018-05-17 | Method and device used for filtering positioning data | |
PCT/CN2018/087199 WO2019218291A1 (en) | 2018-05-17 | 2018-05-17 | Method and device used for filtering positioning data |
CN201880091126.0A CN111837048B (en) | 2018-05-17 | 2018-05-17 | Method and apparatus for filtering positioning data |
US17/055,494 US20210215488A1 (en) | 2018-05-17 | 2018-05-17 | Method and Device Used for Filtering Positioning Data |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2018/087199 WO2019218291A1 (en) | 2018-05-17 | 2018-05-17 | Method and device used for filtering positioning data |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2019218291A1 true WO2019218291A1 (en) | 2019-11-21 |
Family
ID=68539358
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/CN2018/087199 WO2019218291A1 (en) | 2018-05-17 | 2018-05-17 | Method and device used for filtering positioning data |
Country Status (3)
Country | Link |
---|---|
US (1) | US20210215488A1 (en) |
CN (1) | CN111837048B (en) |
WO (1) | WO2019218291A1 (en) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103197279A (en) * | 2013-03-12 | 2013-07-10 | 中国矿业大学 | Mobile target cooperative positioning system and positioning method |
CN104316058A (en) * | 2014-11-04 | 2015-01-28 | 东南大学 | Interacting multiple model adopted WSN-INS combined navigation method for mobile robot |
CN104833354A (en) * | 2015-05-25 | 2015-08-12 | 梁步阁 | Multibasic multi-module network integration indoor personnel navigation positioning system and implementation method thereof |
CN105357753A (en) * | 2015-10-16 | 2016-02-24 | 杭州电子科技大学 | Multimode fusion recursion iteration based indoor positioning method |
CN105527605A (en) * | 2015-12-31 | 2016-04-27 | 天津恒达文博科技有限公司 | Multimode hybrid indoor positioning method |
CN106500690A (en) * | 2016-09-22 | 2017-03-15 | 中国电子科技集团公司第二十二研究所 | A kind of indoor autonomic positioning method and device based on multi-modal fusion |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5325098A (en) * | 1993-06-01 | 1994-06-28 | The United States Of America As Represented By The Secretary Of The Navy | Interacting multiple bias model filter system for tracking maneuvering targets |
US7030809B2 (en) * | 2003-11-14 | 2006-04-18 | The United States Of America As Representd By The Secretary Of The Navy | Multiple model radar tracking filter and systems and methods employing same |
KR100926564B1 (en) * | 2007-08-21 | 2009-11-12 | 한국전자통신연구원 | Apparatus and method for determining the position |
US7705780B1 (en) * | 2007-12-20 | 2010-04-27 | The United States Of America As Represented By The Secretary Of The Navy | Electronic support measures (ESM) tracking system and method |
JP5266846B2 (en) * | 2008-04-01 | 2013-08-21 | セイコーエプソン株式会社 | POSITIONING METHOD, PROGRAM, AND POSITIONING DEVICE |
US20170060810A1 (en) * | 2012-12-13 | 2017-03-02 | Eagle Harbor Holdings, LLC. | System and method for the operation of an automotive vehicle system with modeled sensors |
CN104020480B (en) * | 2014-06-17 | 2016-07-06 | 北京理工大学 | A kind of satellite navigation method of the interactive multi-model UKF with adaptive factor |
CN104833357A (en) * | 2015-04-16 | 2015-08-12 | 中国科学院光电研究院 | Multisystem multi-model mixing interactive information fusion positioning method |
CN106441300B (en) * | 2016-09-08 | 2019-10-18 | 哈尔滨工程大学 | It is a kind of with adaptive collaborative navigation filtering method |
CN106646358A (en) * | 2016-12-27 | 2017-05-10 | 深圳信息职业技术学院 | Multi-error model IMM algorithm for indoor wireless positioning |
CN107704432A (en) * | 2017-07-28 | 2018-02-16 | 西安理工大学 | A kind of adaptive Interactive Multiple-Model method for tracking target of transition probability |
US11334070B2 (en) * | 2017-08-10 | 2022-05-17 | Patroness, LLC | Systems and methods for predictions of state of objects for a motorized mobile system |
-
2018
- 2018-05-17 WO PCT/CN2018/087199 patent/WO2019218291A1/en active Application Filing
- 2018-05-17 CN CN201880091126.0A patent/CN111837048B/en active Active
- 2018-05-17 US US17/055,494 patent/US20210215488A1/en active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103197279A (en) * | 2013-03-12 | 2013-07-10 | 中国矿业大学 | Mobile target cooperative positioning system and positioning method |
CN104316058A (en) * | 2014-11-04 | 2015-01-28 | 东南大学 | Interacting multiple model adopted WSN-INS combined navigation method for mobile robot |
CN104833354A (en) * | 2015-05-25 | 2015-08-12 | 梁步阁 | Multibasic multi-module network integration indoor personnel navigation positioning system and implementation method thereof |
CN105357753A (en) * | 2015-10-16 | 2016-02-24 | 杭州电子科技大学 | Multimode fusion recursion iteration based indoor positioning method |
CN105527605A (en) * | 2015-12-31 | 2016-04-27 | 天津恒达文博科技有限公司 | Multimode hybrid indoor positioning method |
CN106500690A (en) * | 2016-09-22 | 2017-03-15 | 中国电子科技集团公司第二十二研究所 | A kind of indoor autonomic positioning method and device based on multi-modal fusion |
Also Published As
Publication number | Publication date |
---|---|
EP3796028A1 (en) | 2021-03-24 |
US20210215488A1 (en) | 2021-07-15 |
CN111837048A (en) | 2020-10-27 |
CN111837048B (en) | 2024-05-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2018090773A1 (en) | Method and device thereof for matching track points captured by positioning system to map | |
US20240089896A1 (en) | Fingerprint data pre-process method for improving localization model | |
US20200234132A1 (en) | Compound model scaling for neural networks | |
CN109031261B (en) | Time difference estimation method and device | |
CN106569180B (en) | Prony method-based orientation estimation algorithm | |
TWI528783B (en) | Methods and systems for generating depth images and related computer products | |
WO2019218291A1 (en) | Method and device used for filtering positioning data | |
US9519618B2 (en) | System and method for determining distance between signals | |
RU2461019C1 (en) | Method of coordinate-connected identification using statistical evaluation of difference of spatial coordinates | |
CN112671679A (en) | Channel estimation method, device and storage medium applied to SIMO system | |
CN113325414A (en) | Object detection device and memory | |
WO2019239524A1 (en) | Path estimating device and portable information terminal | |
CN115113139A (en) | Sound source identification method and device based on microphone array and electronic equipment | |
JPS62203199A (en) | Pitch cycle extraction system | |
US11250319B1 (en) | Circuit architecture with biased randomization | |
CN114399555B (en) | Data online calibration method and device, electronic equipment and computer readable medium | |
WO2022061700A1 (en) | Method, apparatus, electronic device and readable storage medium for estimation of parameter of channel noise | |
CN116448105B (en) | Pose updating method and device, electronic equipment and storage medium | |
CN111435168A (en) | Positioning method and device | |
Rudenko | An optimal discrete nonlinear logical-dynamical filter-predictor | |
CN116380056B (en) | Inertial positioning method, inertial positioning device, electronic equipment and storage medium | |
JP5012168B2 (en) | Target state quantity estimation method | |
JP2009085610A (en) | Method and device for analyzing motion of target object | |
Stepanov et al. | Solution of map-aided navigation problem using polynomial filtering algorithm | |
Shen et al. | Enhanced visual odometry algorithm based on elite selection method and voting system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 18918812 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2018918812 Country of ref document: EP |
|
ENP | Entry into the national phase |
Ref document number: 2018918812 Country of ref document: EP Effective date: 20201217 |