CN107339989A - A kind of pedestrian's indoor orientation method based on particle filter - Google Patents

A kind of pedestrian's indoor orientation method based on particle filter Download PDF

Info

Publication number
CN107339989A
CN107339989A CN201710493018.3A CN201710493018A CN107339989A CN 107339989 A CN107339989 A CN 107339989A CN 201710493018 A CN201710493018 A CN 201710493018A CN 107339989 A CN107339989 A CN 107339989A
Authority
CN
China
Prior art keywords
mrow
mtd
msup
mtr
msub
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201710493018.3A
Other languages
Chinese (zh)
Inventor
华驰
王恩亮
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu Vocational College of Information Technology
Original Assignee
Jiangsu Vocational College of Information Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Jiangsu Vocational College of Information Technology filed Critical Jiangsu Vocational College of Information Technology
Priority to CN201710493018.3A priority Critical patent/CN107339989A/en
Publication of CN107339989A publication Critical patent/CN107339989A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/165Navigation; 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

The invention discloses a kind of pedestrian's indoor orientation method based on particle filter, this method is a kind of collection RSS measurements, the fusion frame model that mems accelerometer and cartographic information mutually merge with particle filter, a mems accelerometer and cartographic information are added in alignment system, walking distance is estimated based on the motion model of zero crossing algorithm, it is used to integrate the nonlinear transformations from mems accelerometer and building map using particle filter, avoid the accumulated error as caused by sensor noise, the blending algorithm is compared with Kalman filtering, it is significantly improved on the average value and standard deviation of evaluated error, estimation result relative to wrong step-length is in robustness.The result of emulation experiment and actual test shows that this method is significantly improved compared with Kalman filtering on the average value and standard deviation of evaluated error.

Description

A kind of pedestrian's indoor orientation method based on particle filter
Technical field
The present invention relates to a kind of pedestrian's indoor orientation method based on particle filter, belong to pedestrian's Camera calibration technology Field.
Background technology
Positioning and navigation system are in personal security, assets and personnel tracking, intelligently guiding, location aware multimedia service etc. Huge success is achieved in extensive use based on location-based service (LBS).Generally, these systems can be divided into three groups:Satellite Alignment system, communications localization system and sensor alignment system.
For example famous GPS of global position system, the Big Dipper, Galileo system, it is primarily adapted for use in outdoor positioning.However, work as When being positioned indoors under environment, satellite system is subject to the decay of building and wall, reflection and refraction.
Communications localization system utilizes existing communication network infrastructure, such as WLAN (WLAN), ultra wide band (UWB) Or DECT network, use received signal strength (RSS), arrival time (TOA), reaching time-difference (TDOA) and angle of arrival (AOA) It is that can dispose that outdoor can also be deployed in indoors the advantages of communications localization system to calculate the position of user.It is in addition, logical The communication network that letter alignment system uses need not additionally complete the construction of hardware, and cost of installation and maintenance is than relatively low.It is but logical Letter alignment system is vulnerable to the puzzlement of the noise characteristic of wireless channel and multipath distortion, causes the reduction of positioning precision.
Sensor alignment system senses the relevant informations such as absolute position, such as magnetic transducing using various sensor specials Device, laser sensor, ultrasonic wave, infrared sensor, inertial sensor etc., wherein inertial sensor are mainly used to sensing the feedback of position phase Close the change of information.Because inertial sensor can only provide relative information, they usually require to be combined with other alignment systems Complete positioning.For example, GPS/INS solutions correct the accumulated error of inertial sensor using GPS as manager, it is another Aspect, inertial navigation system (INS) can also improve GPS performance, particularly such as in building or other cause gps signal In the case of temporary block, traditional inertial navigation system is huge and costly, and which has limited they and indoor locating system It is integrated.
However, emerging MEMS technology causes the inertial sensor of low cost and small size to become a reality.One example is Mems accelerometer, its price can be successfully integrated into mobile device less than current 1 dollar.
The content of the invention
The defects of the present invention seeks to exist for prior art, provides fixed in a kind of pedestrian room based on particle filter Position method, this method provide a kind of fusion frame model based on particle filter, one is added in alignment system Mems accelerometer and cartographic information, it is used to integrating using particle filter non-from mems accelerometer and building map Linear information, avoid the accumulated error as caused by sensor noise.
The present invention to achieve the above object, adopts the following technical scheme that:A kind of pedestrian's indoor positioning based on particle filter Method, this method use following steps:A kind of pedestrian's indoor orientation method based on particle filter, it is characterised in that this method Comprise the following steps that:
Step 1:Increase a mems accelerometer and cartographic information in typical WLAN pedestrian's alignment system;
Step 2:It is pattern match or K- arest neighbors (KNN) algorithm using location algorithm in based on RSS system, draws basic Location model, the algorithm mainly include following two steps:
(1) in off-line case, the receiving power vector of multiple access points (AP) at calibration point is measured, and is recorded For the fingerprint of calibration point,
(2) in on-line case, the fingerprint of the power vector of reception and calibration point is carried out using the distance metric in equation (1) Compare, finally selection with the average value of K calibration point of the immediate distance of receiving power vector as final predicted value,
Wherein,For access point q measurement power, Pq(x) it is q-th of element of the fingerprint at calibration point x, Q is AP number Amount;
Step 3:Pedestrian's step number and step number distance are determined to obtain walking distance, such as based on mems accelerometer and motion model Shown in formula (2):
D=Step_Size × Num_Steps (2)
Wherein, step number is counted using zero crossing algorithm, because each step of vertical acceleration signal all will extend over zero line twice, institute With when the counting for the quantity that complete zero cross point, and by itself divided by 2, obtain the current walking step number of pedestrian;
Using formula (3) material calculation:
Wherein, AmaxFor each step peak acceleration of pedestrian, AminFor each step minimum acceleration of pedestrian, C is steady state value, the value from Obtained in the ambulation training data of different pedestrians;
Step 4:Nonlinear transformations from mems accelerometer and building map are integrated using particle filter;
A, the indoor positioning algorithms based on elementary particle filtering algorithm realize that step is as follows:
Particle filter uses formula (4) direct estimation Z (k) state value and x (k) posterior probability density function pdf, its In, xi(k) be posterior probability ith sample point or particle, wi(k) be particle weights;
The particle filter comprises the following steps:
Initialization:Initialize pdf functions:P (x (0)) is to N number of particle { xi(0), i=1...N } sampled,
Prediction samples:For each particle xi(k), from pdf state transition equations p (x (k+1) | xi(k) new particle is obtained in) xi(k+1),
Importance sampling:For each new particle xi(k+1) w, is calculatedi(k+1)=p (z (k+1) | xi(k+1)), normalization and again Sampling:By weight normalization and final resampling, in resampling steps, the particle of low weight is deleted, and repeat that there is height The particle of weight so that each particle has identical weight;
B, it is only used for the particle filter of RSS measurements:
For original each particleNew particle x can be obtained from formula (5)i(k+ 1):
Assuming that the motion of pedestrian is dominated by the inertia being superimposed by Gauss acceleration noise, i.e., a is sampled from normal distributionx(k) And ay(k) weight of new particle, is calculated using equation (6), it is herein assumed that the position estimated by the pattern match based on RSS is to enclose Around the Gaussian Profile of actual position;
C, RSS measurements and mems accelerometer and particle filter merge:
, it is necessary to which invocation step three obtains the walking distance d (k) between two RSS samples when using mems accelerometer, because Sigmoidal function is needed for walking distance d (k), so using formula (7) prediction samples equation:
Wherein di(k) from normal distributionIn sampled, be walking distance d (k) and standard deviationBe averaged Value, due to θi(k) unknown, we can complete sampling from being uniformly distributed in (0~2p), and complete particle using formula (6) and weigh Re-computation, based on formula (6) and (7), merge mems accelerometer using particle filter and RSS is measured;
D, RSS measurements, mems accelerometer and cartographic information merge with particle filter:
Using particle filter fusion RSS, mems accelerometer and cartographic information, (such as worn by deleting impossible particle Cross the particle of wall) carry out improved estimator, by weighting, equation (6) can be improved to equation (8), and equation (8) is proposed grain Subfilter Optimized model.
The beneficial effect that the present invention reaches is:The present invention propose a kind of collection RSS measurements, mems accelerometer and cartographic information with The fusion frame model that particle filter mutually merges, a mems accelerometer and map letter are added in alignment system Breath, estimates walking distance based on the motion model of zero crossing algorithm, is used to integrate from MEMS acceleration using particle filter The nonlinear transformations of degree meter and building map, avoid the accumulated error as caused by sensor noise, the blending algorithm and card Kalman Filtering is compared, and is significantly improved on the average value and standard deviation of evaluated error, relative to the estimation knot of wrong step-length Fruit is in robustness.
Brief description of the drawings
Fig. 1 is the indoor tracking frame model figure of the present invention;
Fig. 2 is test trails figure of the present invention under eight kinds of test modes;
Fig. 3 is present invention comparison figure of standard deviation and simulation average value under simulation status;
Fig. 4 is that the present invention tests the result figure using different step-lengths in simulation status Imitating;
Fig. 5 is emulation experiment of the present invention and authentic testing comparative result figure.
Embodiment
The embodiment of the present invention is described further below in conjunction with the accompanying drawings.
As Figure 1-5, the technical solution adopted in the present invention is:A kind of pedestrian indoor positioning side based on particle filter Method, this method use following steps:A kind of pedestrian's indoor orientation method based on particle filter, it is characterised in that this method has Body step is as follows:
Step 1:Increase a mems accelerometer and cartographic information in typical WLAN pedestrian's alignment system;
Step 2:It is pattern match or K- arest neighbors (KNN) algorithm using location algorithm in based on RSS system, draws basic Location model, the algorithm mainly include following two steps:
(1) in off-line case, the receiving power vector of multiple access points (AP) at calibration point is measured, and is recorded For the fingerprint of calibration point,
(2) in on-line case, the fingerprint of the power vector of reception and calibration point is carried out using the distance metric in equation (1) Compare, finally selection with the average value of K calibration point of the immediate distance of receiving power vector as final predicted value,
Wherein,For access point q measurement power, Pq(x) it is q-th of element of the fingerprint at calibration point x, Q is AP number Amount;
Step 3:Pedestrian's step number and step number distance are determined to obtain walking distance, such as based on mems accelerometer and motion model Shown in formula (2):
D=Step_Size × Num_Steps (2)
Wherein, step number is counted using zero crossing algorithm, because each step of vertical acceleration signal all will extend over zero line twice, institute With when the counting for the quantity that complete zero cross point, and by itself divided by 2, obtain the current walking step number of pedestrian;
Using formula (3) material calculation:
Wherein, AmaxFor each step peak acceleration of pedestrian, AminFor each step minimum acceleration of pedestrian, C is steady state value, the value from Obtained in the ambulation training data of different pedestrians.
Comparative maturity, miniaturization, cheap mems accelerometer are widely used current MEMS technology, MEMS acceleration Meter is the device for measuring the acceleration of mobile object.In theory, a kind of method is by being integrated to acceleration signal Calculate and obtain translational speed and distance, but for indoor walking, because acceleration is small, institute in this way the defects of be can hardly By translational speed, distance and sensor noise, offset drifts and tilt variation data are separated.Another method is detection walking Distance, when people walk, its locomotory mechanism, normal acceleration periodically fluctuates, and this cyclical signal represents people's step Row distance, therefore, we obtain walking distance using pedestrian's step number and step number distance is determined, such as formula (2) and formula (3) institute Show.
Step 4:Nonlinear transformations from mems accelerometer and building map are integrated using particle filter;
Indoors in alignment system, when pedestrian is by consecutive tracking, due to its mobility, the fluctuation of RSS measured values can be caused, this The reduction of location data precision will be caused, smooth motion trajectories can be helped by particle filter optimization and estimation can be reduced Error, frequency of use is higher for Kalman filter in target following, but be its operation the shortcomings that Kalman filter according to Rely in linear model, and what linear model was substantially not present in practical application;Extended Kalman filter (EKF) and nothing Limit Kalman filter (UKF) solves nonlinear estimation problem by the way that nonlinear model is converted into linear model, but EKF Or UKF is for solving the problems, such as that part nonlinear system is also relatively difficult;Currently, because particle filter is special based on covering Caro samples, and has and handles the non-linear and characteristic of non-gaussian estimation problem, so can be with such as walking using particle filter All kinds of nonlinear transformations such as row distance and cartographic information are integrated.
A, the indoor positioning algorithms based on elementary particle filtering algorithm realize that step is as follows:
Particle filter uses formula (4) direct estimation Z (k) state value and x (k) posterior probability density function pdf, its In, xi(k) be posterior probability ith sample point or particle, wi(k) be particle weights;
The particle filter comprises the following steps:
Initialization:Initialize pdf functions:P (x (0)) is to N number of particle { xi(0), i=1...N } sampled, prediction samples:It is right In each particle xi(k), from pdf state transition equations p (x (k+1) | xi(k) new particle x is obtained in)i(k+1),
Importance sampling:For each new particle xi(k+1) w, is calculatedi(k+1)=p (z (k+1) | xi(k+1)), normalization and again Sampling:By weight normalization and final resampling, in resampling steps, the particle of low weight is deleted, and repeat that there is height The particle of weight so that each particle has identical weight;
View of the above, it will be seen that for particle filter, pdf state transition equations p (x (k+1) | xi(k)) and pdf is defeated Go out density function p (z (k+1) | xi(k+1)) should possess the function of being predicted sampling and weight calculation, pdf functions are not herein Necessarily need to have Gaussian characteristics.
B, it is only used for the particle filter of RSS measurements:
For original each particleNew particle x can be obtained from formula (5)i(k+ 1):
Assuming that the motion of pedestrian is dominated by the inertia being superimposed by Gauss acceleration noise, i.e., a is sampled from normal distributionx(k) And ay(k) weight of new particle, is calculated using equation (6), it is herein assumed that the position estimated by the pattern match based on RSS is to enclose Around the Gaussian Profile of actual position;
C, RSS measurements and mems accelerometer and particle filter merge:
, it is necessary to which invocation step three obtains the walking distance d (k) between two RSS samples when using mems accelerometer, because Sigmoidal function is needed for walking distance d (k), so using formula (7) prediction samples equation:
Wherein di(k) from normal distributionIn sampled, be walking distance d (k) and standard deviationBe averaged Value, due to θi(k) unknown, we can complete sampling from being uniformly distributed in (0~2p), and complete particle using formula (6) and weigh Re-computation, based on formula (6) and (7), merge mems accelerometer using particle filter and RSS is measured;
D, RSS measurements, mems accelerometer and cartographic information merge with particle filter:
Using particle filter fusion RSS, mems accelerometer and cartographic information, (such as worn by deleting impossible particle Cross the particle of wall) carry out improved estimator, by weighting, equation (6) can be improved to equation (8), and equation (8) is proposed grain Subfilter Optimized model.
Building map is another highly useful information source, because substantial amounts of position can be extracted from fabric structure information Put related data, such as the distance between floor, wall, the position of door or elevator, for tracking problem, the information helps to subtract The uncertainty of few foot path.Using particle filter, RSS, accelerometer and cartographic information can be merged, by deleting not Possible particle carrys out improved estimator (such as through the particle of wall), passes through weighting, it is proposed that particle filter Optimized model.
The experimental result of particle filter Optimized model and analysis:In order to preferably assess different filtering technique and particle The performance of filter optimization model, we are tested in simulated environment and actual WLAN environment respectively.
1st, simulation test
The transmission of wireless signals model of multiple wall obstacles is have selected in emulation experiment environment, based on the modeling office RSS in environment is distributed, and 5 AP are contained in the transmission of wireless signals model, and AP position is marked with asterisk in Fig. 4, ginseng Examination point is used to carry out initial estimation, then using different filtering with 1 meter of resolution ratio uniform design first by KNN algorithms Device carrys out smooth track and reduces site error.
In order to improve the coverage rate of test and accuracy, eight different foot paths are have selected in testing, such as Fig. 2 institutes Show the roundabout walking of straight line (test 1), kept straight on (test 2) with variable velocity, walk (test 3) is turned to 90 °, turned to and gone with 180 ° (test 4) is walked, walk (test 5) is turned to 45 °, is walked in an annular (test 6 and 7) and random walk (test 8), simulation The average value and standard deviation of middle evaluated error are as shown in figure 3, algorithm parameter for details see attached table 1.
Indoor pedestrian's walk test result of the actual WLAN environment of table 1
Algorithm types Mean error (m) Standard deviation (m)
KNN 6.44 6.84
Kalman Filter(KF) 5.81 4.07
Particle Filter(PF) 5.57 3.9
PF+Accelerometer 4.54 3.52
PF+Accelerometer+Map 4.30 2.80
It was found from being analyzed from simulation result as shown in Figure 3, when only considering RSS measurements, particle filter and Kalman filtering Device performance is suitable, and after walking distance information is combined, experimental result, which has, to be significantly improved;When only cartographic information is added to During RSS information, also there is certain improvement;Particle filter, accelerometer, cartographic information, walking distance etc. are added to same Simulation result in model averagely lifts more than 40% than KNN result, and 30% is averagely lifted than Kalman filtered results.
In emulation experiment, we are performed in test 8 with different step-lengths, intend the step-size estimation of simulation mistake, and Fig. 4 is provided Mean error when using different step-lengths in test 8, test result indicates that, 10-20% step error will not cause And the deviation of best orientation precision is excessive.
2nd, indoor pedestrian's walk test of actual WLAN environment
Using all algorithms in real RSS and acceleration analysis checking text, test environment is identical with described in simulation, step Row track is identical with the track simulated in test 8, acceleration information by motion model algorithm process, and identified walking away from From as shown in Figure 4.
Indoor pedestrian's walk test result of the WLAN environment of reality is compared with simulation test result, as shown in figure 5, Compared using filtering algorithm-Kalman filter or particle filter-arest neighbors positioning based on RSS, positioning precision can be with Improve about 10%.When particulate filter obtains extraneous information from acceleration transducer and building map, about 25% can be obtained Further optimization lifting.
The present invention proposes a kind of collection RSS measurements, mems accelerometer and cartographic information and mutually merged with particle filter Fusion frame model, a mems accelerometer and cartographic information are added in alignment system, based on zero crossing algorithm Motion model estimate walking distance, be used to integrating from mems accelerometer and building map using particle filter Nonlinear transformations, the accumulated error as caused by sensor noise is avoided, the blending algorithm is being estimated compared with Kalman filtering It is significantly improved on the average value and standard deviation of error, the estimation result relative to wrong step-length is in robustness.
The foregoing is only presently preferred embodiments of the present invention, be not intended to limit the invention, it is all the present invention spirit and Within principle, any modification, equivalent substitution and improvements made etc., it should be included in the scope of the protection.

Claims (1)

1. a kind of pedestrian's indoor orientation method based on particle filter, it is characterised in that this method comprises the following steps that:
Step 1:Increase a mems accelerometer and cartographic information in typical WLAN pedestrian's alignment system;
Step 2:It is pattern match or K- arest neighbors (KNN) algorithm using location algorithm in based on RSS system, draws basic Location model, the algorithm mainly include following two steps:
(1) in off-line case, the receiving power vector of multiple access points (AP) at calibration point is measured, and is recorded For the fingerprint of calibration point,
(2) in on-line case, the fingerprint of the power vector of reception and calibration point is carried out using the distance metric in equation (1) Compare, finally selection with the average value of K calibration point of the immediate distance of receiving power vector as final predicted value,
<mrow> <mi>d</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mn>1</mn> <mi>Q</mi> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>q</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>Q</mi> </munderover> <mo>{</mo> <msup> <mrow> <mo>(</mo> <msup> <msub> <mi>P</mi> <mi>q</mi> </msub> <mi>m</mi> </msup> <mo>-</mo> <msub> <mi>P</mi> <mi>q</mi> </msub> <mo>(</mo> <mi>x</mi> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>}</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
Wherein,For access point q measurement power, Pq(x) it is q-th of element of the fingerprint at calibration point x, Q is AP quantity;
Step 3:Pedestrian's step number and step number distance are determined to obtain walking distance, such as based on mems accelerometer and motion model Shown in formula (2):
D=Step_Size × Num_Steps (2)
Wherein, step number is counted using zero crossing algorithm, because each step of vertical acceleration signal all will extend over zero line twice, institute With when the counting for the quantity that complete zero cross point, and by itself divided by 2, obtain the current walking step number of pedestrian;
Using formula (3) material calculation:
<mrow> <mi>S</mi> <mi>t</mi> <mi>e</mi> <mi>p</mi> <mo>_</mo> <mi>S</mi> <mi>i</mi> <mi>z</mi> <mi>e</mi> <mo>&amp;ap;</mo> <mroot> <mrow> <msub> <mi>A</mi> <mi>max</mi> </msub> <mo>-</mo> <msub> <mi>A</mi> <mi>min</mi> </msub> </mrow> <mn>4</mn> </mroot> <mo>&amp;times;</mo> <mi>C</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
Wherein, AmaxFor each step peak acceleration of pedestrian, AminFor each step minimum acceleration of pedestrian, C is steady state value, the value from Obtained in the ambulation training data of different pedestrians;
Step 4:Nonlinear transformations from mems accelerometer and building map are integrated using particle filter;
A, the indoor positioning algorithms based on elementary particle filtering algorithm realize that step is as follows:
Particle filter uses formula (4) direct estimation Z (k) state value and x (k) posterior probability density function pdf, its In, xi(k) be posterior probability ith sample point or particle, wi(k) be particle weights;
<mrow> <mi>p</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>|</mo> <mi>Z</mi> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>&amp;ap;</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>N</mi> </munderover> <msup> <mi>w</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mi>&amp;delta;</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>-</mo> <msup> <mi>x</mi> <mi>i</mi> </msup> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
The particle filter comprises the following steps:
Initialization:Initialize pdf functions:P (x (0)) is to N number of particle { xi(0), i=1...N } sampled,
Prediction samples:For each particle xi(k), from pdf state transition equations p (x (k+1) | xi(k) new particle is obtained in) xi(k+1), importance sampling:For each new particle xi(k+1) w, is calculatedi(k+1)=p (z (k+1) | xi(k+1)),
Normalization and resampling:By weight normalization and final resampling, in resampling steps, the particle of low weight is deleted, And repeat the particle with high weight so that each particle has identical weight;
B, it is only used for the particle filter of RSS measurements:
For original each particleNew particle x can be obtained from formula (5)i(k+ 1):
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msup> <mi>x</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mi>y</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <msup> <mi>v</mi> <mi>i</mi> </msup> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <msup> <mi>v</mi> <mi>i</mi> </msup> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>&amp;Delta;</mi> <mi>t</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>&amp;Delta;</mi> <mi>t</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msup> <mi>x</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mi>y</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <msup> <mi>v</mi> <mi>i</mi> </msup> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <msup> <mi>v</mi> <mi>i</mi> </msup> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mfrac> <mrow> <msup> <mi>&amp;Delta;t</mi> <mn>2</mn> </msup> </mrow> <mn>2</mn> </mfrac> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <mrow> <msup> <mi>&amp;Delta;t</mi> <mn>2</mn> </msup> </mrow> <mn>2</mn> </mfrac> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>&amp;Delta;</mi> <mi>t</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>&amp;Delta;</mi> <mi>t</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mi>y</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
Assuming that the motion of pedestrian is dominated by the inertia being superimposed by Gauss acceleration noise, i.e., a is sampled from normal distributionx(k) and ay(k) weight of new particle, is calculated using equation (6), it is herein assumed that the position estimated by the pattern match based on RSS is to surround The Gaussian Profile of actual position;
<mrow> <msup> <mi>w</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>=</mo> <mi>p</mi> <mrow> <mo>(</mo> <mi>z</mi> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mn>1</mn> </mrow> <mo>)</mo> <mo>|</mo> <msup> <mi>x</mi> <mi>i</mi> </msup> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mn>1</mn> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mn>1</mn> <mrow> <msqrt> <mrow> <mn>2</mn> <mi>&amp;pi;</mi> </mrow> </msqrt> <mi>&amp;sigma;</mi> </mrow> </mfrac> <msup> <mi>e</mi> <mrow> <mo>&amp;lsqb;</mo> <mfrac> <mrow> <msup> <mrow> <mo>(</mo> <msup> <mi>x</mi> <mi>i</mi> </msup> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mn>1</mn> </mrow> <mo>)</mo> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mi>R</mi> <mi>S</mi> <mi>S</mi> </mrow> </msub> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mn>1</mn> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msup> <mi>y</mi> <mi>i</mi> </msup> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mn>1</mn> </mrow> <mo>)</mo> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>R</mi> <mi>S</mi> <mi>S</mi> </mrow> </msub> <mo>(</mo> <mrow> <mi>k</mi> <mo>+</mo> <mn>1</mn> </mrow> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> <mrow> <mn>2</mn> <msup> <mi>&amp;sigma;</mi> <mn>2</mn> </msup> </mrow> </mfrac> <mo>&amp;rsqb;</mo> </mrow> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
C, RSS measurements and mems accelerometer and particle filter merge
, it is necessary to which invocation step three obtains the walking distance d (k) between two RSS samples when using mems accelerometer, because Sigmoidal function is needed for walking distance d (k), so using formula (7) prediction samples equation:
<mrow> <msup> <mi>x</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msup> <mi>x</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mi>y</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msup> <mi>x</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>d</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <msup> <mi>cos&amp;theta;</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mi>y</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>d</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <msup> <mi>sin&amp;theta;</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
Wherein di(k) from normal distributionIn sampled, be walking distance d (k) and standard deviationBe averaged Value, due to θi(k) unknown, we can complete sampling from being uniformly distributed in (0~2 π), and complete particle using formula (6) and weigh Re-computation, based on formula (6) and (7), merge mems accelerometer using particle filter and RSS is measured;
D, RSS measurements, mems accelerometer and cartographic information merge with particle filter:
Using particle filter fusion RSS, mems accelerometer and cartographic information, (such as worn by deleting impossible particle Cross the particle of wall) carry out improved estimator, by weighting, equation (6) can be improved to equation (8), and equation (8) is proposed grain Subfilter Optimized model
<mrow> <msup> <mi>w</mi> <mi>i</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mn>0</mn> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mi>i</mi> <mi>f</mi> <mi> </mi> <mi>n</mi> <mi>e</mi> <mi>w</mi> <mi> </mi> <mi>p</mi> <mi>a</mi> <mi>r</mi> <mi>t</mi> <mi>i</mi> <mi>c</mi> <mi>l</mi> <mi>e</mi> <mi> </mi> <mi>c</mi> <mi>r</mi> <mi>o</mi> <mi>s</mi> <mi>s</mi> <mi>e</mi> <mi>s</mi> <mi> </mi> <mi>w</mi> <mi>a</mi> <mi>l</mi> <mi>l</mi> <mi>s</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msqrt> <mrow> <mn>2</mn> <mi>&amp;pi;</mi> </mrow> </msqrt> <mi>&amp;sigma;</mi> </mrow> </mfrac> <msup> <mi>e</mi> <mrow> <mo>&amp;lsqb;</mo> <mfrac> <mrow> <msup> <mrow> <mo>(</mo> <msup> <mi>x</mi> <mi>i</mi> </msup> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>x</mi> <mrow> <mi>R</mi> <mi>S</mi> <mi>S</mi> </mrow> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msup> <mi>y</mi> <mi>i</mi> </msup> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>y</mi> <mrow> <mi>R</mi> <mi>S</mi> <mi>S</mi> </mrow> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> <mrow> <mn>2</mn> <msup> <mi>&amp;sigma;</mi> <mn>2</mn> </msup> </mrow> </mfrac> <mo>&amp;rsqb;</mo> </mrow> </msup> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mi>o</mi> <mi>t</mi> <mi>h</mi> <mi>e</mi> <mi>r</mi> <mi>w</mi> <mi>i</mi> <mi>s</mi> <mi>e</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow> 2
CN201710493018.3A 2017-06-23 2017-06-23 A kind of pedestrian's indoor orientation method based on particle filter Pending CN107339989A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710493018.3A CN107339989A (en) 2017-06-23 2017-06-23 A kind of pedestrian's indoor orientation method based on particle filter

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710493018.3A CN107339989A (en) 2017-06-23 2017-06-23 A kind of pedestrian's indoor orientation method based on particle filter

Publications (1)

Publication Number Publication Date
CN107339989A true CN107339989A (en) 2017-11-10

Family

ID=60221553

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710493018.3A Pending CN107339989A (en) 2017-06-23 2017-06-23 A kind of pedestrian's indoor orientation method based on particle filter

Country Status (1)

Country Link
CN (1) CN107339989A (en)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107990900A (en) * 2017-11-24 2018-05-04 江苏信息职业技术学院 A kind of particle filter design methods of pedestrian's indoor positioning data
CN108089180A (en) * 2017-12-18 2018-05-29 江苏添仂智能科技有限公司 Based on UWB sensors as back indicator to the localization method of GPS and inertial navigation system the suspension type rail vehicle corrected
CN108322888A (en) * 2018-01-30 2018-07-24 重庆大学 A kind of indoor orientation method of mobile terminal
CN109298389A (en) * 2018-08-29 2019-02-01 东南大学 Indoor pedestrian based on multiparticle group optimization combines position and orientation estimation method
CN109451425A (en) * 2018-12-06 2019-03-08 奇点新源国际技术开发(北京)有限公司 A kind of localization method and device based on single anchor point
CN109870716A (en) * 2017-12-01 2019-06-11 北京京东尚科信息技术有限公司 Localization method and positioning device and computer readable storage medium
CN110333479A (en) * 2019-07-09 2019-10-15 东华大学 It is a kind of based on the wireless location method for improving particle filter under complex indoor environment
CN111623765A (en) * 2020-05-18 2020-09-04 清华大学 Indoor positioning method and system based on multi-mode data
CN112781591A (en) * 2019-11-06 2021-05-11 深圳市优必选科技股份有限公司 Robot positioning method and device, computer readable storage medium and robot
CN113155131A (en) * 2021-04-14 2021-07-23 浙江工业大学 Particle filter-based iBeacon and PDR fusion indoor positioning method

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103175529A (en) * 2013-03-01 2013-06-26 上海美迪索科电子科技有限公司 Pedestrian inertial positioning system based on indoor magnetic field feature assistance
US8504292B1 (en) * 2011-05-05 2013-08-06 Bentley Systems, Incorporated Indoor localization based on ultrasound sensors
US20140171114A1 (en) * 2012-12-14 2014-06-19 Apple Inc. Location determination using fingerprint data
CN103925923A (en) * 2014-05-07 2014-07-16 南京大学 Geomagnetic indoor positioning system based on self-adaptive particle filter algorithm
CN104061934A (en) * 2014-06-10 2014-09-24 哈尔滨工业大学 Pedestrian indoor position tracking method based on inertial sensor

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8504292B1 (en) * 2011-05-05 2013-08-06 Bentley Systems, Incorporated Indoor localization based on ultrasound sensors
US20140171114A1 (en) * 2012-12-14 2014-06-19 Apple Inc. Location determination using fingerprint data
CN103175529A (en) * 2013-03-01 2013-06-26 上海美迪索科电子科技有限公司 Pedestrian inertial positioning system based on indoor magnetic field feature assistance
CN103925923A (en) * 2014-05-07 2014-07-16 南京大学 Geomagnetic indoor positioning system based on self-adaptive particle filter algorithm
CN104061934A (en) * 2014-06-10 2014-09-24 哈尔滨工业大学 Pedestrian indoor position tracking method based on inertial sensor

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
WANG, H等: "WLAN-Based pedestrian tracking using particle filters and low-cost MEMS sensors", 《WORKSHOP ON POSITIONING NAVIGATION AND COMMUNICATION》 *

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107990900A (en) * 2017-11-24 2018-05-04 江苏信息职业技术学院 A kind of particle filter design methods of pedestrian's indoor positioning data
CN109870716A (en) * 2017-12-01 2019-06-11 北京京东尚科信息技术有限公司 Localization method and positioning device and computer readable storage medium
CN108089180A (en) * 2017-12-18 2018-05-29 江苏添仂智能科技有限公司 Based on UWB sensors as back indicator to the localization method of GPS and inertial navigation system the suspension type rail vehicle corrected
CN108322888A (en) * 2018-01-30 2018-07-24 重庆大学 A kind of indoor orientation method of mobile terminal
CN108322888B (en) * 2018-01-30 2020-05-12 重庆大学 Indoor positioning method of mobile terminal
CN109298389B (en) * 2018-08-29 2022-09-23 东南大学 Indoor pedestrian combination pose estimation method based on multi-particle swarm optimization
CN109298389A (en) * 2018-08-29 2019-02-01 东南大学 Indoor pedestrian based on multiparticle group optimization combines position and orientation estimation method
CN109451425A (en) * 2018-12-06 2019-03-08 奇点新源国际技术开发(北京)有限公司 A kind of localization method and device based on single anchor point
CN110333479A (en) * 2019-07-09 2019-10-15 东华大学 It is a kind of based on the wireless location method for improving particle filter under complex indoor environment
CN112781591A (en) * 2019-11-06 2021-05-11 深圳市优必选科技股份有限公司 Robot positioning method and device, computer readable storage medium and robot
CN111623765A (en) * 2020-05-18 2020-09-04 清华大学 Indoor positioning method and system based on multi-mode data
CN113155131A (en) * 2021-04-14 2021-07-23 浙江工业大学 Particle filter-based iBeacon and PDR fusion indoor positioning method
CN113155131B (en) * 2021-04-14 2022-06-17 浙江工业大学 Particle filter-based iBeacon and PDR fusion indoor positioning method

Similar Documents

Publication Publication Date Title
CN107339989A (en) A kind of pedestrian&#39;s indoor orientation method based on particle filter
EP2673593B1 (en) Method and device for indoor positioning
CN104501796B (en) A kind of interior WLAN/MEMS merges across floor 3-dimensional localization method
CN107990900A (en) A kind of particle filter design methods of pedestrian&#39;s indoor positioning data
Wang et al. WLAN-based pedestrian tracking using particle filters and low-cost MEMS sensors
Sun et al. Indoor positioning tightly coupled Wi-Fi FTM ranging and PDR based on the extended Kalman filter for smartphones
Renaudin et al. Indoor navigation of emergency agents
Zhang et al. A localization database establishment method based on crowdsourcing inertial sensor data and quality assessment criteria
CN105043380A (en) Indoor navigation method based on a micro electro mechanical system, WiFi (Wireless Fidelity) positioning and magnetic field matching
CN105588566A (en) Indoor positioning system and method based on Bluetooth and MEMS (Micro-Electro-Mechanical Systems) fusion
CN104977006A (en) Indoor positioning method based on fuzzy theory and multi-sensor fusion
CN104796866A (en) Indoor positioning method and device
CN104215238A (en) Indoor positioning method of intelligent mobile phone
Seitz et al. A hidden markov model for pedestrian navigation
Liu et al. Indoor localization using smartphone inertial sensors
Suski et al. Using a map of measurement noise to improve UWB indoor position tracking
CN111829516B (en) Autonomous pedestrian positioning method based on smart phone
CN109211229A (en) A kind of personnel&#39;s indoor orientation method based on mobile phone sensor and WiFi feature
Wen et al. An indoor localization and tracking system using successive weighted RSS projection
CN108801267B (en) Indoor anchor-free positioning method integrating multiple sensors
Tarrío et al. Fusion of RSS and inertial measurements for calibration-free indoor pedestrian tracking
Seco et al. RFID-based centralized cooperative localization in indoor environments
Hafner et al. Evaluation of smartphone-based indoor positioning using different Bayes filters
CN104202818A (en) Floor identification method based on building open edge distance weighting
Ehrlich et al. Pedestrian localisation inside buildings based on multi-sensor smartphones

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
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20171110