CN103471589A - Method for identifying walking mode and tracing track of pedestrian in room - Google Patents

Method for identifying walking mode and tracing track of pedestrian in room Download PDF

Info

Publication number
CN103471589A
CN103471589A CN2013104404550A CN201310440455A CN103471589A CN 103471589 A CN103471589 A CN 103471589A CN 2013104404550 A CN2013104404550 A CN 2013104404550A CN 201310440455 A CN201310440455 A CN 201310440455A CN 103471589 A CN103471589 A CN 103471589A
Authority
CN
China
Prior art keywords
pedestrian
walking mode
indoor
hmm
probability
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.)
Granted
Application number
CN2013104404550A
Other languages
Chinese (zh)
Other versions
CN103471589B (en
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.)
Wuhan University WHU
Original Assignee
Wuhan University WHU
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 Wuhan University WHU filed Critical Wuhan University WHU
Priority to CN201310440455.0A priority Critical patent/CN103471589B/en
Publication of CN103471589A publication Critical patent/CN103471589A/en
Application granted granted Critical
Publication of CN103471589B publication Critical patent/CN103471589B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

The invention discloses a method for identifying a walking mode and tracing a track of a pedestrian in a room. The method comprises the steps: firstly, defining a walking mode of the pedestrian in the room by using directions and speeds as the classifying basis according to the characteristic of a terrain under an indoor environment; then establishing a mathematical modeling for the indoor walking mode by applying a hidden Markov model (HMM) through using acquired acceleration sensor and geomagnetic sensor data; because of the interference of a metal object and the influence of body joggling in the walking process, a track primarily obtained by an indoor positioning system through dead reckoning possibly has large errors, and in the method, calculating the probability of each walking mode by using a viterbi algorithm of the HMM, and finding one group of walking modes with highest possibility; finally, matching an original location to a corresponding walking mode according to an identification result of the walking mode so as to correct an original track, and obtain a walking correcting track of the pedestrian in the room. According to the method, the precision of indoor positioning and track tracing can be remarkably improved.

Description

A kind of method of indoor pedestrian's walking mode identification and trajectory track
Technical field
The present invention relates to indoor pedestrian location and trajectory track field based on inertial sensor, relate in particular to that a kind of indoor pedestrian's walking mode based on implicit Markov model is identified and the method for trajectory track.
Background technology
Indoor positioning based on inertial sensor is under indoor environment, calculates step number and the course angle of pedestrian's walking by the data of the acceleration transducer that configures in the acquisition and processing mobile phone and geomagnetic sensor.In conjunction with the reckoning principle, on the basis of a position, according to the step number in the travel time section and course angle, extrapolate pedestrian's current location on known.Again by continuous seamless obtain pedestrian's current indoor location, can obtain pedestrian's track.
In pedestrian's trajectory track system based on inertial sensor, can calculate the step number of pedestrian's walking in conjunction with gait recognition method by gathering the acceleration transducer data.Pedestrian's course angle can be by the geomagnetic sensor data acquisition gathered.The step number that utilization is obtained and course angle can be obtained indoor pedestrian's position comparatively accurately in conjunction with the reckoning principle.But, because Geomagnetic signal is very easy to be subject to the impact in metal object and other geomagnetic noise sources, the geomagnetic sensor data of collection can produce larger error due to these chaff interferences.And the pedestrian while independently locating rocking also of health can produce and disturb the collection of geomagnetic sensor and acceleration transducer data.Moreover, these errors can be accumulated along with the growth of orientation distance, and this cumulative errors has affected indoor positioning based on inertial sensor and the precision of trajectory track system greatly.
In order to improve the precision of indoor pedestrian location and trajectory track system, the researchist proposed a lot of indoor orientation methods based on inertial sensor, what in them, have processes and filters inertial sensor data from macroscopic view, although reduced to a certain extent the impact of partly disturbing, fundamentally do not improved the precision of location.Some methods propose by adding for example WiFi of extra positioning equipment, and gyroscope etc. carry out the auxiliary positioning error of proofreading and correct.This method has significantly improved precision, but the extra positioning equipment added has increased substantially the cost of location, greatly reduces the availability of native system.
How under the prerequisite of not adding extras, successfully manage the interference of environmental factor and the impact of body-sway motion, accurately identify the abnormity point of indoor track, and revise the track of originally makeing mistakes, significantly improve the method for indoor positioning and trajectory track precision, be the advanced subject of industry research always.
Summary of the invention
Fundamental purpose of the present invention is to propose and realizes a kind of inertial sensor that utilizes mobile phone, carries out the identification of indoor pedestrian's walking mode, thereby realizes the method for indoor positioning and trajectory track accurately.The method can, under the prerequisite of not adding extras, successfully manage the interference of environmental factor and the impact of body-sway motion; The method can also accurately identify the abnormity point of indoor track, and the track abnormity point of originally makeing mistakes is revised, and significantly improves the precision of indoor positioning and trajectory track.
The technical solution adopted in the present invention is: a kind of method of indoor pedestrian's walking mode identification and trajectory track, it is characterized in that, and comprise the following steps:
Step 1: utilize acceleration transducer and geomagnetic sensor with adaptive sample frequency image data, obtain indoor pedestrian's initial position data;
Step 2: the more lower position data of utilizing this pedestrian in reckoning algorithm counting chamber;
Step 3: repeat described step 1 and step 2, by recording room one skilled in the art's position data constantly, obtain indoor this pedestrian's run trace;
Step 4: the implicit Markov model of setting up walking mode according to the characteristic of the general run trace of indoor common pedestrian;
Step 5: then the walking mode that identifies indoor this pedestrian according to the implicit Markov model of setting up and sensor observed reading matches indoor this pedestrian's run trace indoor this pedestrian's who identifies walking mode;
Step 6: adopted the method for abnormity point identification, deletion and bad block reparation to be revised the run trace after mating, obtained indoor this pedestrian's walking correction track.
As preferably, described in step 1, utilize acceleration transducer and geomagnetic sensor with adaptive sample frequency image data, its specific implementation comprises following sub-step:
Step 1.1: input three position angle h of pedestrian's walking constantly continuously d, h d-1, h d-2; Wherein, d, d-1, d-2 is three continuous moment of carrying out data acquisition;
Step 1.2: calculate three continuous position angles between any two about the derivative of time
Figure BDA0000387593020000021
h d - 1 ′ = Δh Δd = h d - 1 - h d - 2 ;
Step 1.3: the second derivative between computer azimuth angle;
Figure BDA0000387593020000023
Step 1.4: judgement second derivative h d' ' whether be less than minimum tolerance value ε;
If h d' ' be less than ε, pedestrian's walking states is in stable state, and now degree of will speed up sensor and geomagnetic sensor are made as the low frequency image data;
If h d' ' be greater than ε, pedestrian's walking states is in non-steady state, and now degree of will speed up sensor and geomagnetic sensor are made as the high-frequency image data.
As preferably, the more lower position data of utilizing reckoning algorithm counting chamber one skilled in the art described in step 2, its indoor pedestrian's more lower position is:
(x *,y *)=(x+sl×sc×cos?h,y+sl×sc+sin?h);
Wherein: sl is pedestrian's step-length, and pedestrian's step-length obtains by estimation algorithm; Sc is the step number that the pedestrian walks, step number is that the Z axis acceleration figure obtained according to acceleration transducer calculates, in the process made a move due to pedestrian's normal row, it is a sine wave that the Z axis acceleration is worth curve, so the step number of by the number that detects Z axis acceleration sine wave, adding up the pedestrian; (x, y) is pedestrian's initial coordinate, (x *, y *) be the coordinate of pedestrian's more lower position; H is that the ,Gai position angle, position angle that the pedestrian walks obtains by geomagnetic sensor, and the position angle got is pedestrian's direction of advancing and the angle of magnetic north.
As preferably, the characteristic according to the general run trace of indoor common pedestrian described in step 4 is set up the implicit Markov model of walking mode, and its specific implementation comprises following sub-step:
Step 4.1: define indoor pedestrian's walking mode Hidden Markov Model (HMM), this model comprises these four parameters of implicit state, observed reading, state transition probability and output probability, and wherein, implicit state is corresponding to described indoor pedestrian's walking mode; Observed reading is the acceleration transducer of collection and the data of geomagnetic sensor; State transition probability is indoor occupant from a walking mode excessively to the probability of another one walking mode; Output probability is for a given observed reading, corresponding to the probability of certain walking states;
Step 4.2: according to described indoor pedestrian's walking characteristics, the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of instantiation.
As preferably, the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of the described instantiation of step 4.2, the instantiation method of the implicit state of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode is: at first indoor pedestrian's walking mode is classified according to direction of travel and the speed of travel; Wherein direction of travel is usingd to 15 degree as interval, 360 degree are divided into to 24 direction sections, the angle of supposing indoor pedestrian's direction of travel is θ, and the direction section under it is so
Figure BDA0000387593020000024
because of indoor normal walking speed scope, at 0.5m/s-2m/s, then the speed of travel being divided three classes, is respectively (0.5m/s-1m/s), middling speed (1m/s-1.5m/s), fast (1.5m/s-2m/s) at a slow speed; According to the direction of described walking and the speed of walking, walking mode can be divided into altogether 72 kinds, every kind of corresponding direction section of walking mode and a speed type.
As preferably, the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of the described instantiation of step 4.2, the instantiation method of the observed reading of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode is: by the pedestrian is divided into to several equal time intervals at the capable time made a move, gather an observed reading every an equal time period, described observed reading is arranged in to observation vector according to time sequencing; Wherein, described observed reading is three-dimensional vectorial O=(acce, Δ hd, spd), and acce means pedestrian's z-axle acceleration, the azimuthal variation amount that Δ hd means the pedestrian, the speed of travel that spd means the pedestrian.
As preferably, the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of the described instantiation of step 4.2, the instantiation method of the output probability of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode comprises following sub-step:
Step 4.2.1: the present invention is by capable corresponding three observational variables the method that it is averaged of making a move with each interior walking mode of multi collect indoor occupant, set up a standard fingerprint base for each walking mode, each fingerprint base comprises a walking mode s jwith sequence of observations v icorresponding relation, this corresponding relation is expressed as a bivector (s j, v i);
Step 4.2.2: a given sequence of observations v i, search each walking mode s in fingerprint base jcorresponding standard observation value sequence v j;
Step 4.2.3: calculate given observed reading v ithe standard observation value v corresponding with each walking mode jbetween Euclidean distance;
Step 4.2.3: finally with the zero-mean Gaussian function, calculate each observed reading v iwith corresponding state s jbetween emission probability.
As preferably, the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of the described instantiation of step 4.2, the instantiation method of the state transition probability of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode is: described Hidden Markov Model (HMM) state transition probability is divided into direction transition probability and speed transition probability;
The direction transition probability means that the pedestrian transfers to the probability of the residing direction of another one state from a residing direction of state, if the pedestrian transfers to state j, i from state i heading, j headingmean respectively the residing direction section of state i and state j, direction transition probability P headingthe computing formula of (i, j) is as follows:
P heading ( i , j ) = θ 2 n , n = | i heading - j heading | ,
Wherein θ means to work as i heading=j headingthe time the direction transition probability of pedestrian's Hidden Markov Model (HMM);
Because of P heading(i, j) meets constraint condition
The probability sum of the direction that likely shifts be 1, therefore the value that by this constraint condition, can calculate θ is about 0.334; If the pedestrian transfers to state j, i from state i speed, j speedmean respectively state i and the residing speed type of state j, speed transition probability P speedthe computing formula of (i, j) is as follows:
P speed ( i , j ) = ω 2 n , n = | i speed - j speed | ,
Wherein ω means to work as i speed=j speedthe time the direction transition probability of pedestrian's Hidden Markov Model (HMM);
Because of P speed(i, j) meets following constraint condition
Σ j = 1 k P speed ( i , j ) = 1 ,
The probability sum of the speed that likely shifts be 1, therefore can calculate ω by this constraint condition, be 0.5;
, for a Hidden Markov Model (HMM) λ=(A, B, π), state transition probability matrix A is:
a ij=P heading(i,j)×P speed(i,j),
Wherein, a ijmean the state transition probability of Hidden Markov Model (HMM), B means the output probability matrix of Hidden Markov Model (HMM), and π means the original state probability matrix of Hidden Markov Model (HMM).
As preferably, the walking mode that identifies indoor this pedestrian according to the implicit Markov model of setting up and sensor observed reading described in step 5, its specific implementation comprises following sub-step:
Step 5.1: the sequence of observations O that inputs any walking mode i, i=1,2 ... n;
Step 5.2: set up Hidden Markov Model (HMM) λ=(A, B, the π) of indoor pedestrian's walking mode, wherein:
π=[π 1,π 2,...,π N];
Wherein, a ijthe state transition probability that means Hidden Markov Model (HMM), b j(i) mean the output probability of Hidden Markov Model (HMM), N means the status number of implicit Er Kefu model, π jthe original state probability that means Hidden Markov Model (HMM);
Step 5.3: Hidden Markov Model (HMM) λ=(A, B, the π) for pedestrian's walking mode of setting up, calculate with viterbi algorithm the probability that all possible walking states is corresponding, then by sequence, find out maximum probability wherein:
δ 1(j)=π jb j(o 1) 1≤j≤N
δ t(j)=max it-1(j)a ijb i(o t)) 2≤t≤T,1≤k≤N;
Wherein, T means the time of the walking cost of this walking mode, calculates t constantly in state S jmaximum probability δ t (j);
Step 5.4: judgement t is the state S in maximum probability constantly jprobability δ t (j) be greater than fixing threshold value p (TH)?
If: continue to carry out following step 5.5,
If not: finish identification;
Step 5.5: state corresponding to maximum probability that record calculates at every turn, for recalling state each time; Maximum probability δ for a viterbi algorithm computation process t-1(i) and one state transition probability a ij, traceback information ψ t(j) computing formula is as follows:
ψ t(j)=arg?max it-1(i)a ij] 2≤t≤T,1≤j≤N;
Step 5.6: utilize described traceback information ψ t(j), with back-track algorithm, identify pedestrian's walking mode q t * , t = T - 1 , T - 2 , . . . , 1 , Its iterative process is as follows:
q T * = S N
q t * = ψ t + 1 ( q t + 1 * ) , t = T - 1 , T - 2 , . . . , 1 .
As preferably, described p (TH) gets 0.6.
As preferably, the employing described in step 6 method of abnormity point identification, deletion and the bad block reparation run trace after to coupling revised, its specific implementation comprises following sub-step:
Step 6.1: the sequence of observations O that inputs any one walking mode i, i=1,2 ... n; Hidden Markov Model (HMM) λ=(A, B, the π) of indoor pedestrian's walking mode of setting up; Wherein, A means the state transition probability matrix of Hidden Markov Model (HMM), and B means the output probability matrix of Hidden Markov Model (HMM), and π means the original state probability matrix of Hidden Markov Model (HMM).
Step 6.2: set a moving window that length is k for the sequence of observations, the sequence of observations that is n by length is divided into the short sequence that length is k;
Step 6.3: moving window moves a unit at every turn backward, wherein, and the number of times C=(n-k+1) that moving window moves altogether;
Step 6.4: judge whether moving window arrives sequence of observations end,
If so, monitoring finishes;
If not, continue to carry out following step;
Step 6.5: the maximum probability δ t (j) of walking mode that calculates the short sequence at this moving window place with viterbi algorithm:
δ 1(j)=π jb j(O 1) 1≤j≤N
δ t ( j ) = max i ( δ t - 1 ( j ) a ij b iO t ) , 2 ≤ t ≤ T , 1 ≤ k ≤ N ;
Wherein, a ijthe state transition probability that means Hidden Markov Model (HMM), b j(i) mean the output probability of Hidden Markov Model (HMM), N means the status number of implicit Er Kefu model, π jthe original state probability that means Hidden Markov Model (HMM), T means the time of the walking cost of this walking mode;
Step 6.6: judgement maximum probability δ t (j) and threshold values p (TH) size of setting;
If maximum rating probability δ t (j) is greater than this threshold value, this time short sequence is normal point, returns and continues to carry out described step 6.3;
If maximum rating probability δ t (j) is less than this threshold value, this time short sequence is abnormity point, continues to carry out following step;
Step 6.7: this short sequence is carried out to abnormity point and delete and the bad block reparation, the method for its bad block reparation is first to delete original abnormity point, then passes through the method for curve point of position matching in the abnormity point of deleting, then returns and carry out described step 6.3.
The present invention has following innovation point:
(1) in traditional indoor positioning technology, generally adopt the location fingerprint location, or adopt based on signal attenuation distance model localization method, these methods are not only located large but also positioning precision is lower; In recent years, the researchist proposed to adopt the indoor orientation method based on inertial sensor, and this is a kind of autonomous, continuous indoor positioning technology, and positioning precision is high and stable.But the indoor locating system that is based on inertial sensor works long hours and can produce cumulative errors, greatly the precision of impact location; For the cumulative errors that the location technology reduced based on inertial sensor exists, the present invention, from the angle of microcosmic, identifies the slight change that indoor pedestrian often makes a move;
(2) in the indoor positioning technology based on inertial sensor, sensing data easily is subject to the interference of environment, and self also has fluctuation, and these factors can cause the type one skilled in the art's of calculating the serious deviation of trajectory generation.Technology before is to adopt the method for filtered sensor data to eliminate exceptional value, although this method has been eliminated some errors to a certain extent, does not fundamentally solve the problem of geomagnetic noise and shake.The technology also had is carried out correction error by adding extra auxiliary positioning equipment, although this method has improved positioning precision, need to pay higher location cost.The present invention, by set up the fine-grained model based on implicit Markov for the walking mode of indoor occupant, identifies the pattern of indoor walking, thereby revises the track of walking.Experimental results show that the method has significantly improved the precision of indoor positioning;
(3) this transmission adopts adaptive sensor data acquisition frequency, can dynamically adjust the frequency of sampling according to different indoor environments, than the collecting method of fixed frequency, has significantly lowered the energy consumption of sensor;
(4) way that the present invention proposes is simple and easy to realize, without any need for extra positioning equipment, and very high robustness and reliability are arranged, be applicable to various indoor environments.
The accompanying drawing explanation
Fig. 1: be method flow diagram of the present invention.
Fig. 2: be the method flow diagram of adaptive frequency data acquisition of the present invention.
Fig. 3: be reckoning principle schematic of the present invention.
Fig. 4: be the implicit view of the implicit Markov model of walking mode of the present invention.
Fig. 5: be the method flow diagram of walking mode identification of the present invention.
Fig. 6: be the method flow diagram of abnormity point identification of the present invention, deletion and bad block reparation.
Embodiment
Below with reference to the drawings and specific embodiments, the present invention is further elaborated.
Ask for an interview Fig. 1, the technical solution adopted in the present invention is: a kind of method of indoor pedestrian's walking mode identification and trajectory track comprises the following steps:
Step 1: utilize acceleration transducer and geomagnetic sensor with adaptive sample frequency image data, obtain indoor pedestrian's initial position data;
Step 2: the more lower position data of utilizing this pedestrian in reckoning algorithm counting chamber;
Step 3: repeated execution of steps 1 and step 2, by recording room one skilled in the art's position data constantly, obtain indoor this pedestrian's run trace;
Step 4: the implicit Markov model of setting up walking mode according to the characteristic of the general run trace of indoor common pedestrian;
Step 5: then the walking mode that identifies indoor this pedestrian according to the implicit Markov model of setting up and sensor observed reading matches indoor this pedestrian's run trace indoor this pedestrian's who identifies walking mode;
Step 6: adopted the method for abnormity point identification, deletion and bad block reparation to be revised the run trace after mating, obtained indoor this pedestrian's walking correction track.
Ask for an interview Fig. 2, in step 1, utilize acceleration transducer and geomagnetic sensor with adaptive sample frequency image data, its specific implementation comprises following sub-step:
Step 1.1: input three position angle h of pedestrian's walking constantly continuously d, h d-1, h d-2; Wherein, d, d-1, d-2 is three continuous moment of carrying out data acquisition;
Step 1.2: calculate three continuous position angles between any two about the derivative of time
Figure BDA0000387593020000061
h d - 1 ′ = Δh Δd = h d - 1 - h d - 2 ;
Step 1.3: the second derivative between computer azimuth angle;
Figure BDA0000387593020000063
Step 1.4: judgement second derivative h d' ' whether be less than minimum tolerance value ε;
If h d' ' be less than ε, pedestrian's walking states is in stable state, and now degree of will speed up sensor and geomagnetic sensor are made as the low frequency image data;
If h d' ' be greater than ε, pedestrian's walking states is in non-steady state, and now degree of will speed up sensor and geomagnetic sensor are made as the high-frequency image data.
Ask for an interview Fig. 3, utilize reckoning algorithm counting chamber one skilled in the art's more lower position data in step 2, its indoor pedestrian's more lower position is:
(x *,y *)=(x+sl×sc×cos?h,y+sl×sc+sin?h);
Wherein: sl is pedestrian's step-length, and pedestrian's step-length obtains by estimation algorithm; Sc is the step number that the pedestrian walks, step number is that the Z axis acceleration figure obtained according to acceleration transducer calculates, in the process made a move due to pedestrian's normal row, it is a sine wave that the Z axis acceleration is worth curve, so the step number of by the number that detects Z axis acceleration sine wave, adding up the pedestrian; (x, y) is pedestrian's initial coordinate, (x *, y *) be the coordinate of pedestrian's more lower position; H is that the ,Gai position angle, position angle that the pedestrian walks obtains by geomagnetic sensor, and the position angle got is pedestrian's direction of advancing and the angle of magnetic north.
Set up the implicit Markov model of walking mode in step 4 according to the characteristic of the general run trace of indoor common pedestrian, its specific implementation comprises following sub-step:
Step 4.1: define indoor pedestrian's walking mode Hidden Markov Model (HMM), this model comprises these four parameters of implicit state, observed reading, state transition probability and output probability, and wherein, implicit state is corresponding to indoor pedestrian's walking mode; Observed reading is the acceleration transducer of collection and the data of geomagnetic sensor; State transition probability is indoor occupant from a walking mode excessively to the probability of another one walking mode; Output probability is for a given observed reading, corresponding to the probability of certain walking states;
Step 4.2: according to indoor pedestrian's walking characteristics, the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of instantiation; The instantiation method of the implicit state of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode is: at first indoor pedestrian's walking mode is classified according to direction of travel and the speed of travel; Wherein direction of travel is usingd to 15 degree as interval, 360 degree are divided into to 24 direction sections, the angle of supposing indoor pedestrian's direction of travel is θ, and the direction section under it is so
Figure BDA0000387593020000071
because of indoor normal walking speed scope, at 0.5m/s-2m/s, then the speed of travel being divided three classes, is respectively (0.5m/s-1m/s), middling speed (1m/s-1.5m/s), fast (1.5m/s-2m/s) at a slow speed; According to the direction of walking and the speed of walking, walking mode can be divided into altogether 72 kinds, every kind of corresponding direction section of walking mode and a speed type;
The instantiation method of the observed reading of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode is: by the pedestrian is divided into to several equal time intervals at the capable time made a move, gather an observed reading every an equal time period, observed reading is arranged in to observation vector according to time sequencing; Wherein, observed reading be three-dimensional vectorial O=(acce, Δ hd, spd), acce means pedestrian's z-axle acceleration, the azimuthal variation amount that Δ hd means the pedestrian, the speed of travel that spd means the pedestrian;
The instantiation method of the output probability of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode comprises following sub-step:
Step 4.2.1: the present invention is by capable corresponding three observational variables the method that it is averaged of making a move with each interior walking mode of multi collect indoor occupant, set up a standard fingerprint base for each walking mode, each fingerprint base comprises a walking mode s jwith sequence of observations v icorresponding relation, this corresponding relation is expressed as a bivector (s j, v i);
Step 4.2.2: the sequence of observations v of given HMM ican be expressed as v i=[O 1, O 2..., O n], find corresponding states s by searching fingerprint base jthe standard value sequence
Figure BDA0000387593020000072
calculating observation value sequence v iand v jbetween Euclidean distance, known according to the definition of observed reading, for sequence of observations v i, v jin each observed quantity O nand O n *, n=1,2 ... N,, be all a tri-vector that comprises three observational componentses;
O n=(acce n,Δhd n,spd n),
O n *=(acce n *,Δhd n *,spd n *),n=1,2,…N
O nand O n *between Euclidean distance dis (O n, O n *) computing method are as follows:
dis ( O n , O n * ) = ( acce n - acce n * ) 2 + ( Δhd n - Δhd n * ) 2 + ( apd n - apd n * ) 2
So given observed reading v iwith standard observation value v jbetween Euclidean distance can be expressed as:
dis ( v i , v j ) = Σ n = 1 N dis ( O n , O n * ) 2 = Σ n = 1 N ( acce n - acce n * ) 2 + ( Δhd n - Δhd n * ) 2 + ( spd n - spd n * ) 2
Step 4.2.3: to Euclidean distance dis (v i, v j) ask the zero-mean Gaussian function to calculate each observed reading v iwith corresponding state s jbetween emission probability, formula is as follows:
b j ( i ) = P ( o t = v i | q t = s j ) = g ( dis ( v i , v j ) ) = e - dis ( v i - v j ) 2 2 δ 2 ;
The instantiation method of the state transition probability of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode is: the Hidden Markov Model (HMM) state transition probability is divided into direction transition probability and speed transition probability;
The direction transition probability means that the pedestrian transfers to the probability of the residing direction of another one state from a residing direction of state, if the pedestrian transfers to state j, i from state i heading, j headingmean respectively the residing direction section of state i and state j, direction transition probability P headingthe computing formula of (i, j) is as follows:
P heading ( i , j ) = θ 2 n , n = | i heading - j heading | ,
Wherein θ means to work as i heading=j headingthe time the direction transition probability of pedestrian's Hidden Markov Model (HMM);
Because of P heading(i, j) meets constraint condition
Figure BDA0000387593020000082
The probability sum of the direction that likely shifts be 1, therefore the value that by this constraint condition, can calculate θ is about 0.334; If the pedestrian transfers to state j, i from state i speed, j speedmean respectively state i and the residing speed type of state j, speed transition probability P speedthe computing formula of (i, j) is as follows:
P speed ( i , j ) = ω 2 n , n = | i speed - j speed | ,
Wherein ω means to work as i speed=j speedthe time the direction transition probability of pedestrian's Hidden Markov Model (HMM);
Because of P speed(i, j) meets following constraint condition
Σ j = 1 k P speed ( i , j ) = 1 ,
The probability sum of the speed that likely shifts be 1, therefore can calculate ω by this constraint condition, be 0.5;
, for a Hidden Markov Model (HMM) λ=(A, B, π), state transition probability matrix A is:
Figure BDA0000387593020000085
a ij=P heading(i,j)×P speed(i,j),
Wherein, a ijmean the state transition probability of Hidden Markov Model (HMM), B means the output probability matrix of Hidden Markov Model (HMM), and π means the original state probability matrix of Hidden Markov Model (HMM).
Ask for an interview Fig. 4, the implicit Markov model HMM schematic diagram of instantiation walking mode, it is a kind ofly with probabilistic method, to describe non-static state (be the statistics of signal over time) signal source model.HMM is comprised of two correlated processes:
(1) inherence, sightless Markov chain, comprise limited state, state-transition matrix and an original state probability distribution;
(2) the output probability density function collection be associated with each state of Markov chain.
Usually, a HMM can mean by following tlv triple:
λ=(A,B,π);
The hidden Markov process characteristic can be by the incompatible sign of following parameter set:
(1) implicit state (hidden states), the implicit state key reaction in implicit Markov model the residing state of object, in the present invention, be exactly indoor pedestrian's walking mode.Ask for an interview Fig. 4, defined the pattern of indoor walking according to characteristics the present invention of indoor pedestrian's walking.The present invention classifies indoor walking mode according to direction of travel and the speed of travel.Wherein direction of travel is usingd to 15 degree as interval, 360 degree are divided into to 24 direction sections, if the angle of direction of travel is θ, the direction section under it is so
Figure BDA0000387593020000086
due to indoor normal walking speed scope, greatly about 0.5m/s-2m/s, the present invention can be divided three classes the speed of travel accordingly, is respectively (0.5m/s-1m/s), middling speed (1m/s-1.5m/s), fast (1.5m/s-2m/s) at a slow speed.According to direction and the speed of walking, walking mode can be divided into altogether 72 kinds, direction section of every kind of correspondence and a speed type so;
(2) observed reading (observables) is in order to reflect the characteristics of indoor pedestrian's walking comprehensively, the present invention chooses the z axle acceleration of pedestrian's acceleration transducer in the capable time made a move, and the azimuthal variation amount of geomagnetic sensor and the speed of travel are as observed reading.Observed reading can be expressed as the vectorial O=(acce, Δ hd, spd) of a three-dimensional, means respectively z-axle acceleration that acceleration sensing records, pedestrian's that geomagnetic sensor records azimuthal variation amount and pedestrian's the speed of travel.Select the z axle acceleration to be because indoor pedestrian when the speed with different and direction walking, the amplitude that health teetertotters is also different, and the z axle acceleration can reflect the variation of the acceleration of pedestrian's vertical direction fully.Two amounts in the corresponding implicit state of position angle and speed, position angle can record by geomagnetic sensor, and the speed of travel can calculate by pedestrian's estimating step length and walking cycle.The time that the present invention makes a move row is divided into several equal time intervals, every an equal time period, gathers an observed reading, then observed reading is arranged in to observation vector according to time sequencing.For example, suppose that the time that pedestrian's row makes a move is T, the time that row is made a move is divided into N the equal time interval, and the moment of pick-up transducers data is so
Figure BDA0000387593020000091
the sensing data constantly collected at i is O i.The observation sequence v gathered so kcan be expressed as one by O ithe N dimension group v formed k=[O 1, O 2... O n].For each observed reading O i, the observed reading of the capable time that makes a move of indoor pedestrian of choosing comprises: pedestrian's z-axle acceleration, pedestrian's azimuthal variation amount and pedestrian's the speed of travel, observed reading O so ican be expressed as a tri-vector O i=(acce, Δ hd, spd);
(3) original state probability: refer to first state q 1get s=[s actually 1, s 2..., s n] in which probability, it forms 1 * N vector π, π i=p (q 1=s i) and π=[π 1, π 2..., π n], we set π 1=1 (π i=0, i ≠ 1), suppose that HMM is from first state;
(4) transition probability (transition probability) a ij=P (q t+1=s j| q t=s i): by state s itransfer to state s jprobability (to first-order Markov process).Due to the total possible state of N kind, therefore total N * N possible value.They are become to A=[a with matrix formulation ij] and
Figure BDA0000387593020000092
the present invention is divided into direction transition probability p by state transition probability headingwith speed transition probability p speed;
The direction transition probability means that the pedestrian transfers to the probability of the residing direction of another one state from a residing direction of state, if the pedestrian transfers to state j, i from state i heading, j headingmean respectively the residing direction section of state i and state j, direction transition probability P headingthe computing formula of (i, j) is as follows:
P heading ( i , j ) = θ 2 n , n = | i heading - j heading | ,
Wherein θ means to work as i heading=j headingthe time the direction transition probability of pedestrian's Hidden Markov Model (HMM);
Because of P heading(i, j) meets constraint condition
Figure BDA0000387593020000094
The probability sum of the direction that likely shifts be 1, therefore the value that by this constraint condition, can calculate θ is about 0.334;
If the pedestrian transfers to state j, i from state i speed, j speedmean respectively state i and the residing speed type of state j, speed transition probability P speedthe computing formula of (i, j) is as follows:
P speed ( i , j ) = ω 2 n , n = | i speed - j speed | ,
Wherein ω means to work as i speed=j speedthe time the direction transition probability of pedestrian's Hidden Markov Model (HMM);
Because of P speed(i, j) meets following constraint condition
Σ j = 1 k P speed ( i , j ) = 1
The probability sum of the speed that likely shifts be 1, therefore can calculate ω by this constraint condition, be 0.5;
, for a Hidden Markov Model (HMM) λ=(A, B, π), state transition probability matrix A is:
Figure BDA0000387593020000101
a ij=P heading(i,j)×P speed(i,j),
Wherein, a ijmean the state transition probability of Hidden Markov Model (HMM), B means the output probability matrix of Hidden Markov Model (HMM), and π means the original state probability matrix of Hidden Markov Model (HMM);
(5) output probability (emission probability) b j(i)=P (o t=v i| q t=s j): at state s jv is observed in lower generation iprobability.If possible observation in total M, form N * Metzler matrix B=[b ij] and
Figure BDA0000387593020000102
in order to weigh the degree of closeness of each sequence of observations and each state, the present invention is by capable corresponding three observational variables the method that it is averaged of making a move with each interior walking mode of multi collect indoor occupant, set up a standard fingerprint base for each walking mode, each fingerprint base comprises a walking states s jwith sequence of observations v icorresponding relation, fingerprint base can be expressed as a bivector (s j, v i).The sequence of observations vi of HMM can be expressed as v i=[O 1, O 2..., O n], corresponding states s in fingerprint base jthe standard value sequence be
Figure BDA0000387593020000103
according to above the definition about observed reading is known, for each the observed quantity O in the sequence of observations nand O n *, n=1,2 ... N,, be all a tri-vector that comprises three observational componentses.
On=(acce n,Δhd n,spd n),
On *=(acce n *,Δhd n *,spd n *),n=1,2,…N
The present invention adopts Euclidean distance to weigh two distances between variable, On and On *between Euclidean distance dis (O n, O n *) computing method are as follows:
Figure BDA0000387593020000104
Euclidean distance between so given observed reading vi and standard observation value vj can be expressed as:
Figure BDA0000387593020000106
Finally use Euclidean distance dis (v i, v j) ask the method for zero-mean Gaussian function to calculate the output probability between each observed reading vi and corresponding state sj, formula is as follows:
Figure BDA0000387593020000107
b j ( i ) = P ( o t = v i | q t = s j ) = g ( dis ( v i , v j ) ) = e - dis ( v i - v j ) 2 2 δ 2 .
Ask for an interview Fig. 5, the walking mode that identifies indoor this pedestrian according to the implicit Markov model of setting up and sensor observed reading in step 5, its specific implementation comprises following sub-step:
Step 5.1: the sequence of observations O that inputs any walking mode i, i=1,2 ... n;
Step 5.2: set up Hidden Markov Model (HMM) λ=(A, B, the π) of indoor pedestrian's walking mode wherein
Figure BDA0000387593020000111
π=[π 1,π 2,...,π N];
Wherein, a ijthe state transition probability that means Hidden Markov Model (HMM), b j(i) mean the output probability of Hidden Markov Model (HMM), N means the status number of implicit Er Kefu model, π jthe original state probability that means Hidden Markov Model (HMM);
Step 5.3: Hidden Markov Model (HMM) λ=(A, B, the π) for pedestrian's walking mode of setting up, calculate with viterbi algorithm the probability that all possible walking states is corresponding, then by sequence, find out maximum probability wherein:
δ 1(j)=π jb j(o 1) 1≤j≤N
δ t(j)=max it-1(j)a ijb i(o t)) 2≤t≤T,1≤k≤N;
Wherein, T means the time of the walking cost of this walking mode, calculates t constantly in state S jmaximum probability δ t (j);
Step 5.4: judgement t is the state S in maximum probability constantly jprobability δ t (j) be greater than fixing threshold value p (TH)?
If: continue to carry out following step 5.5,
If not: finish identification;
Wherein, the p of the present embodiment (TH) gets 0.6;
Step 5.5: state corresponding to maximum probability that record calculates at every turn, for recalling state each time; Maximum probability δ for a viterbi algorithm computation process t-1(i) and one state transition probability a ij, traceback information ψ t(j) computing formula is as follows:
ψ t(j)=arg?max it-1(i)a ij] 2≤t≤T,1≤j≤N;
Step 5.6: utilize traceback information ψ t(j), with back-track algorithm, identify pedestrian's walking mode its iterative process is as follows:
q T * = S N
q t * = ψ t + 1 ( q t + 1 * ) , t = T - 1 , T - 2 , . . . , 1 .
Ask for an interview Fig. 6, in step 6, adopted the method for abnormity point identification, deletion and bad block reparation to be revised the run trace after mating, its specific implementation comprises following sub-step:
Step 6.1: the sequence of observations O that inputs any one walking mode i, i=1,2 ... n; Hidden Markov Model (HMM) λ=(A, B, the π) of indoor pedestrian's walking mode of setting up; Wherein, A means the state transition probability matrix of Hidden Markov Model (HMM), and B means the output probability matrix of Hidden Markov Model (HMM), and π means the original state probability matrix of Hidden Markov Model (HMM).
Step 6.2: set a moving window that length is k for the sequence of observations, the sequence of observations that is n by length is divided into the short sequence that length is k;
Step 6.3: moving window moves a unit at every turn backward, wherein, and the number of times C=(n-k+1) that moving window moves altogether;
Step 6.4: judge whether moving window arrives sequence of observations end,
If so, monitoring finishes;
If not, continue to carry out following step;
Step 6.5: the maximum probability δ t (j) of walking mode that calculates the short sequence at this moving window place with viterbi algorithm:
δ 1(j)=π jb j(O 1) 1≤j≤N
δ t ( j ) = max i ( δ t - 1 ( j ) a ij b iO t ) , 2 ≤ t ≤ T , 1 ≤ k ≤ N ;
Wherein, a ijthe state transition probability that means Hidden Markov Model (HMM), b j(i) mean the output probability of Hidden Markov Model (HMM), N means the status number of implicit Er Kefu model, π jthe original state probability that means Hidden Markov Model (HMM), T means the time of the walking cost of this walking mode;
Step 6.6: judgement maximum probability δ t (j) and threshold values p (TH) size of setting;
If maximum rating probability δ t (j) is greater than this threshold value, this time short sequence is normal point, returns and continues execution step 6.3;
If maximum rating probability δ t (j) is less than this threshold value, this time short sequence is abnormity point, continues to carry out following step;
Step 6.7: this short sequence is carried out to abnormity point and delete and the bad block reparation, the method for its bad block reparation is first to delete original abnormity point, then passes through the method for curve point of position matching in the abnormity point of deleting, then returns to execution step 6.3.
Above specific embodiment has been described in detail purpose of the present invention, technical scheme and beneficial effect.Institute's foregoing that it should be understood that, only for specific embodiments of the invention, is not limited to the present invention.All within spirit of the present invention and principle, any modification of making, be equal to and replace and improvement etc., within all should being included in protection scope of the present invention.

Claims (11)

1. the method for indoor pedestrian's walking mode identification and trajectory track, is characterized in that, comprises the following steps:
Step 1: utilize acceleration transducer and geomagnetic sensor with adaptive sample frequency image data, obtain indoor pedestrian's initial position data;
Step 2: the more lower position data of utilizing this pedestrian in reckoning algorithm counting chamber;
Step 3: repeat described step 1 and step 2, by recording room one skilled in the art's position data constantly, obtain indoor this pedestrian's run trace;
Step 4: the implicit Markov model of setting up walking mode according to the characteristic of the general run trace of indoor common pedestrian;
Step 5: then the walking mode that identifies indoor this pedestrian according to the implicit Markov model of setting up and sensor observed reading matches indoor this pedestrian's run trace indoor this pedestrian's who identifies walking mode;
Step 6: adopted the method for abnormity point identification, deletion and bad block reparation to be revised the run trace after mating, obtained indoor this pedestrian's walking correction track.
2. the method for indoor pedestrian's walking mode identification according to claim 1 and trajectory track, it is characterized in that: described in step 1, utilize acceleration transducer and geomagnetic sensor with adaptive sample frequency image data, its specific implementation comprises following sub-step:
Step 1.1: input three position angle h of pedestrian's walking constantly continuously d, h d-1, h d-2; Wherein, d, d-1, d-2 is three continuous moment of carrying out data acquisition;
Step 1.2: calculate three continuous position angles between any two about the derivative of time
Figure FDA0000387593010000011
h d - 1 ′ = Δh Δd = h d - 1 - h d - 2 ;
Step 1.3: the second derivative between computer azimuth angle;
Figure FDA0000387593010000013
Step 1.4: judgement second derivative h d' ' whether be less than minimum tolerance value ε;
If h d' ' be less than ε, pedestrian's walking states is in stable state, and now degree of will speed up sensor and geomagnetic sensor are made as the low frequency image data;
If h d' ' be greater than ε, pedestrian's walking states is in non-steady state, and now degree of will speed up sensor and geomagnetic sensor are made as the high-frequency image data.
3. the method for indoor pedestrian's walking mode identification according to claim 1 and trajectory track, it is characterized in that: the more lower position data of utilizing reckoning algorithm counting chamber one skilled in the art described in step 2, its indoor pedestrian's more lower position is: (x *, y *)=(x+sl * sc * cos h, y+sl * sc+sin h);
Wherein: sl is pedestrian's step-length, and pedestrian's step-length obtains by estimation algorithm; Sc is the step number that the pedestrian walks, step number is that the Z axis acceleration figure obtained according to acceleration transducer calculates, in the process made a move due to pedestrian's normal row, it is a sine wave that the Z axis acceleration is worth curve, so the step number of by the number that detects Z axis acceleration sine wave, adding up the pedestrian; (x, y) is pedestrian's initial coordinate, (x *, y *) be the coordinate of pedestrian's more lower position; H is that the ,Gai position angle, position angle that the pedestrian walks obtains by geomagnetic sensor, and the position angle got is pedestrian's direction of advancing and the angle of magnetic north.
4. the method for indoor pedestrian's walking mode identification according to claim 1 and trajectory track, it is characterized in that: the characteristic according to the general run trace of indoor common pedestrian described in step 4 is set up the implicit Markov model of walking mode, and its specific implementation comprises following sub-step:
Step 4.1: define indoor pedestrian's walking mode Hidden Markov Model (HMM), this model comprises these four parameters of implicit state, observed reading, state transition probability and output probability, and wherein, implicit state is corresponding to described indoor pedestrian's walking mode; Observed reading is the acceleration transducer of collection and the data of geomagnetic sensor; State transition probability is indoor occupant from a walking mode excessively to the probability of another one walking mode; Output probability is for a given observed reading, corresponding to the probability of certain walking states;
Step 4.2: according to described indoor pedestrian's walking characteristics, the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of instantiation.
5. the method for indoor pedestrian's walking mode identification according to claim 4 and trajectory track, it is characterized in that: the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of the described instantiation of step 4.2, the instantiation method of the implicit state of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode is: at first indoor pedestrian's walking mode is classified according to direction of travel and the speed of travel; Wherein direction of travel is usingd to 15 degree as interval, 360 degree are divided into to 24 direction sections, the angle of supposing indoor pedestrian's direction of travel is θ, and the direction section under it is so because of indoor normal walking speed scope, at 0.5m/s-2m/s, then the speed of travel being divided three classes, is respectively (0.5m/s-1m/s), middling speed (1m/s-1.5m/s), fast (1.5m/s-2m/s) at a slow speed; According to the direction of described walking and the speed of walking, walking mode can be divided into altogether 72 kinds, every kind of corresponding direction section of walking mode and a speed type.
6. the method for indoor pedestrian's walking mode identification according to claim 4 and trajectory track, it is characterized in that: the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of the described instantiation of step 4.2, the instantiation method of the observed reading of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode is: by the pedestrian is divided into to several equal time intervals at the capable time made a move, gather an observed reading every an equal time period, described observed reading is arranged in to observation vector according to time sequencing; Wherein, described observed reading is three-dimensional vectorial O=(acce, Δ hd, spd), and acce means pedestrian's z-axle acceleration, the azimuthal variation amount that Δ hd means the pedestrian, the speed of travel that spd means the pedestrian.
7. the method for indoor pedestrian's walking mode identification according to claim 4 and trajectory track, it is characterized in that: the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of the described instantiation of step 4.2, the instantiation method of the output probability of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode comprises following sub-step:
Step 4.2.1: the present invention is by capable corresponding three observational variables the method that it is averaged of making a move with each interior walking mode of multi collect indoor occupant, set up a standard fingerprint base for each walking mode, each fingerprint base comprises a walking mode s jwith sequence of observations v icorresponding relation, this corresponding relation is expressed as a bivector (s j, v i);
Step 4.2.2: a given sequence of observations v i, search each walking mode s in fingerprint base jcorresponding standard observation value sequence v j;
Step 4.2.3: calculate given observed reading v ithe standard observation value v corresponding with each walking mode jbetween Euclidean distance;
Step 4.2.3: finally with the zero-mean Gaussian function, calculate each observed reading v iwith corresponding state s jbetween emission probability.
8. the method for indoor pedestrian's walking mode identification according to claim 4 and trajectory track, it is characterized in that: the Hidden Markov Model (HMM) of the indoor pedestrian's walking mode of the described instantiation of step 4.2, the instantiation method of the state transition probability of the Hidden Markov Model (HMM) of its indoor pedestrian's walking mode is: described Hidden Markov Model (HMM) state transition probability is divided into direction transition probability and speed transition probability;
The direction transition probability means that the pedestrian transfers to the probability of the residing direction of another one state from a residing direction of state, if the pedestrian transfers to state j, i from state i heading, j headingmean respectively the residing direction section of state i and state j, direction transition probability P headingthe computing formula of (i, j) is as follows:
P heading ( i , j ) = θ 2 n , n = | i heading - j heading | ,
Wherein θ means to work as i heading=j headingthe time the direction transition probability of pedestrian's Hidden Markov Model (HMM);
Because of P heading(i, j) meets constraint condition
Figure FDA0000387593010000023
The probability sum of the direction that likely shifts be 1, therefore the value that by this constraint condition, can calculate θ is about 0.334; If the pedestrian transfers to state j, i from state i speed, j speedmean respectively state i and the residing speed type of state j, speed transition probability P speedthe computing formula of (i, j) is as follows:
P speed ( i , j ) = ω 2 n , n = | i speed - j speed | ,
Wherein ω means to work as i speed=j speedthe time the direction transition probability of pedestrian's Hidden Markov Model (HMM);
Because of P speed(i, j) meets following constraint condition
Σ j = 1 k P speed ( i , j ) = 1 ,
The probability sum of the speed that likely shifts be 1, therefore can calculate ω by this constraint condition, be 0.5;
, for a Hidden Markov Model (HMM) λ=(A, B, π), state transition probability matrix A is:
Figure FDA0000387593010000032
a ij=P heading(i,j)×P speed(i,j),
Wherein, a ijmean the state transition probability of Hidden Markov Model (HMM), B means the output probability matrix of Hidden Markov Model (HMM), and π means the original state probability matrix of Hidden Markov Model (HMM).
9. the method for indoor pedestrian's walking mode identification according to claim 1 and trajectory track, it is characterized in that: the walking mode that the implicit Markov model according to foundation described in step 5 and sensor observed reading identify indoor this pedestrian, its specific implementation comprises following sub-step:
Step 5.1: the sequence of observations O that inputs any walking mode i, i=1,2 ... n;
Step 5.2: set up Hidden Markov Model (HMM) λ=(A, B, the π) of indoor pedestrian's walking mode, wherein:
Figure FDA0000387593010000033
π=[π 1,π 2,...,π N];
Wherein, a ijthe state transition probability that means Hidden Markov Model (HMM), b j(i) mean the output probability of Hidden Markov Model (HMM), N means the status number of implicit Er Kefu model, π jthe original state probability that means Hidden Markov Model (HMM);
Step 5.3: Hidden Markov Model (HMM) λ=(A, B, the π) for pedestrian's walking mode of setting up, calculate with viterbi algorithm the probability that all possible walking states is corresponding, then by sequence, find out maximum probability wherein:
δ 1(j)=π jb j(o 1) 1≤j≤N
δ t(j)=max it-1(j)a ijb i(o t)) 2≤t≤T,1≤k≤N;
Wherein, T means the time of the walking cost of this walking mode, calculates t constantly in state S jmaximum probability δ t (j);
Step 5.4: judgement t is the state S in maximum probability constantly jprobability δ t (j) be greater than fixing threshold value p (TH)?
If: continue to carry out following step 5.5,
If not: finish identification;
Step 5.5: state corresponding to maximum probability that record calculates at every turn, for recalling state each time; Maximum probability δ for a viterbi algorithm computation process t-1(i) and one state transition probability a ij, traceback information ψ t(j) computing formula is as follows:
ψ t(j)=arg?max it-1(i)a ij] 2≤t≤T,1≤j≤N;
Step 5.6: utilize described traceback information ψ t(j), with back-track algorithm, identify pedestrian's walking mode q t * , t = T - 1 , T - 2 , . . . , 1 , Its iterative process is as follows:
q T * = S N
q t * = ψ t + 1 ( q t + 1 * ) , t = T - 1 , T - 2 , . . . , 1 .
10. the method for indoor pedestrian's walking mode identification according to claim 6 and trajectory track, it is characterized in that: described p (TH) gets 0.6.
11. the method for indoor pedestrian's walking mode identification according to claim 1 and trajectory track, it is characterized in that: the employing described in step 6 abnormity point identification, deletion and bad block reparation method to the coupling after run trace revised, its specific implementation comprises following sub-step:
Step 6.1: the sequence of observations O that inputs any one walking mode i, i=1,2 ... n; Hidden Markov Model (HMM) λ=(A, B, the π) of indoor pedestrian's walking mode of setting up; Wherein, A means the state transition probability matrix of Hidden Markov Model (HMM), and B means the output probability matrix of Hidden Markov Model (HMM), and π means the original state probability matrix of Hidden Markov Model (HMM).
Step 6.2: set a moving window that length is k for the sequence of observations, the sequence of observations that is n by length is divided into the short sequence that length is k;
Step 6.3: moving window moves a unit at every turn backward, wherein, and the number of times C=(n-k+1) that moving window moves altogether;
Step 6.4: judge whether moving window arrives sequence of observations end,
If so, monitoring finishes;
If not, continue to carry out following step;
Step 6.5: the maximum probability δ t (j) of walking mode that calculates the short sequence at this moving window place with viterbi algorithm:
δ 1(j)=π jb j(O 1) 1≤j≤N
δ t ( j ) = max i ( δ t - 1 ( j ) a ij b iO t ) , 2 ≤ t ≤ T , 1 ≤ k ≤ N ;
Wherein, a ijthe state transition probability that means Hidden Markov Model (HMM), b j(i) mean the output probability of Hidden Markov Model (HMM), N means the status number of implicit Er Kefu model, π jthe original state probability that means Hidden Markov Model (HMM), T means the time of the walking cost of this walking mode;
Step 6.6: judgement maximum probability δ t (j) and threshold values p (TH) size of setting;
If maximum rating probability δ t (j) is greater than this threshold value, this time short sequence is normal point, returns and continues to carry out described step 6.3;
If maximum rating probability δ t (j) is less than this threshold value, this time short sequence is abnormity point, continues to carry out following step;
Step 6.7: this short sequence is carried out to abnormity point and delete and the bad block reparation, the method for its bad block reparation is first to delete original abnormity point, then passes through the method for curve point of position matching in the abnormity point of deleting, then returns and carry out described step 6.3.
CN201310440455.0A 2013-09-25 2013-09-25 The method of the identification of a kind of indoor pedestrian's walking mode and trajectory track Active CN103471589B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310440455.0A CN103471589B (en) 2013-09-25 2013-09-25 The method of the identification of a kind of indoor pedestrian's walking mode and trajectory track

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310440455.0A CN103471589B (en) 2013-09-25 2013-09-25 The method of the identification of a kind of indoor pedestrian's walking mode and trajectory track

Publications (2)

Publication Number Publication Date
CN103471589A true CN103471589A (en) 2013-12-25
CN103471589B CN103471589B (en) 2015-10-21

Family

ID=49796540

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310440455.0A Active CN103471589B (en) 2013-09-25 2013-09-25 The method of the identification of a kind of indoor pedestrian's walking mode and trajectory track

Country Status (1)

Country Link
CN (1) CN103471589B (en)

Cited By (38)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103945531A (en) * 2014-05-12 2014-07-23 哈尔滨工业大学 Method for WLAN indoor positioning Radio Map updating based on information entropy
CN104007416A (en) * 2014-05-30 2014-08-27 成都旗客科技有限公司 Indoor location error correcting method
CN105136143A (en) * 2015-07-29 2015-12-09 哈尔滨工业大学 IMU data-based user indoor movement track matching method
CN105184382A (en) * 2015-07-14 2015-12-23 成都乐动信息技术有限公司 Optimization method of trajectory and device
CN105277171A (en) * 2014-07-16 2016-01-27 中国移动通信集团公司 Altitude height recording method, recording device and terminal
CN105865445A (en) * 2016-03-29 2016-08-17 全感(苏州)智能技术有限公司 Inertial navigation indoor positioning system and use method thereof
CN105910601A (en) * 2016-05-31 2016-08-31 天津大学 Indoor geomagnetic positioning method based on hidden Markov model
CN105928512A (en) * 2016-04-26 2016-09-07 杭州欣晟达信息技术有限公司 Geomagnetic field-based indoor positioning method
CN105973224A (en) * 2016-04-26 2016-09-28 杭州荣旗科技有限公司 Indoor navigation method
CN106205213A (en) * 2014-12-30 2016-12-07 江苏理工学院 A kind of boats and ships trajectory predictions method
CN106250515A (en) * 2016-08-04 2016-12-21 复旦大学 Miss path restoration methods based on historical data
WO2016206119A1 (en) * 2015-06-26 2016-12-29 Intel Corporation Technologies for pedestrian dead reckoning
CN106448064A (en) * 2016-09-12 2017-02-22 四川长虹电器股份有限公司 Drowning early warning system and method based on intelligent mobile equipment
CN104197936B (en) * 2014-09-10 2017-04-12 湖南格纳微信息科技有限公司 Indoor positioning method based on building regular structure information
CN107330085A (en) * 2017-07-03 2017-11-07 上海世脉信息科技有限公司 Judgement identification and the antidote of sensor error position are fixed under big data environment
CN107339992A (en) * 2017-08-24 2017-11-10 武汉大学 A kind of method of the semantic mark of the indoor positioning and terrestrial reference of Behavior-based control
CN107421527A (en) * 2017-07-17 2017-12-01 中山大学 A kind of indoor orientation method based on Magnetic Field and motion sensor
CN107506780A (en) * 2017-07-04 2017-12-22 上海谦尊升网络科技有限公司 A kind of mode identification method under the conditions of multiple features
CN107818300A (en) * 2017-10-18 2018-03-20 河海大学 A kind of gait denoising method based on HMM
CN108537101A (en) * 2018-01-05 2018-09-14 浙江大学 A kind of pedestrian's localization method based on state recognition
CN108801263A (en) * 2018-05-31 2018-11-13 北京辰安科技股份有限公司 pedestrian navigation positioning system and method
CN109003458A (en) * 2018-08-09 2018-12-14 河海大学常州校区 Crossing vehicle violation based on three axis geomagnetic sensors monitors system and method
CN109612458A (en) * 2018-10-26 2019-04-12 南京航空航天大学 The method for realizing user location tracking in mountain area environment using mobile phone air pressure and acceleration transducer
CN109998551A (en) * 2019-04-11 2019-07-12 北京航空航天大学 A kind of gait phase analysis method of segmented local peak detection
CN110245707A (en) * 2019-06-17 2019-09-17 吉林大学 Human body walking posture vibration information recognition methods and system based on scorpion positioning
CN110426037A (en) * 2019-08-08 2019-11-08 扆亮海 A kind of pedestrian movement track real time acquiring method under enclosed environment
CN110502121A (en) * 2019-07-24 2019-11-26 江苏大学 A kind of frame dummy keyboard and its Introduced Malaria algorithm for thering is sense of touch height to distinguish rate
CN110738095A (en) * 2019-08-23 2020-01-31 珠海格力电器股份有限公司 behavior analysis method and device
CN110766154A (en) * 2019-09-18 2020-02-07 北京邮电大学 Pedestrian track inference method, device, equipment and storage medium
CN110796040A (en) * 2019-10-15 2020-02-14 武汉大学 Pedestrian identity recognition method based on multivariate spatial trajectory correlation
CN111174784A (en) * 2020-01-03 2020-05-19 重庆邮电大学 Visible light and inertial navigation fusion positioning method for indoor parking lot
CN111307154A (en) * 2020-02-27 2020-06-19 南京大学 Indoor pedestrian tracking system based on magnet array scanning and working method thereof
CN111781592A (en) * 2020-06-12 2020-10-16 中国船舶重工集团公司第七二四研究所 Rapid automatic starting method based on fine-grained characteristic analysis
CN111854791A (en) * 2020-07-21 2020-10-30 北京卡路里信息技术有限公司 Motion trajectory determination method and device, terminal equipment and storage medium
CN112146658A (en) * 2020-09-17 2020-12-29 深圳市自由空间标识有限公司 Intelligent guiding method, device and system
WO2021136193A1 (en) * 2019-12-31 2021-07-08 苏州欧普照明有限公司 Illumination apparatus capable of automatically adjusting illumination direction
CN113109853A (en) * 2021-03-12 2021-07-13 上海卫星工程研究所 Satellite attitude variable frequency calculation output method and system based on double-frequency and double-mode design
CN113408333A (en) * 2021-04-27 2021-09-17 上海工程技术大学 Method for distinguishing pedestrian traffic behaviors in subway station based on video data

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2002037827A2 (en) * 2000-10-30 2002-05-10 Naval Postgraduate School Method and apparatus for motion tracking of an articulated rigid body
KR20090087633A (en) * 2008-02-13 2009-08-18 성균관대학교산학협력단 Method and system generating object location trace model and recongnizing a pattern of object location trace
CN101886927A (en) * 2010-06-25 2010-11-17 武汉大学 Three-dimensional motion tracking system and method based on inertial sensor and geomagnetic sensor
CN101954191A (en) * 2010-08-25 2011-01-26 颜小洋 Intelligent entertainment mobile robot
US20120053944A1 (en) * 2010-08-31 2012-03-01 Cuneyt Oncel Tuzel Method for Determining Compressed State Sequences

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2002037827A2 (en) * 2000-10-30 2002-05-10 Naval Postgraduate School Method and apparatus for motion tracking of an articulated rigid body
KR20090087633A (en) * 2008-02-13 2009-08-18 성균관대학교산학협력단 Method and system generating object location trace model and recongnizing a pattern of object location trace
CN101886927A (en) * 2010-06-25 2010-11-17 武汉大学 Three-dimensional motion tracking system and method based on inertial sensor and geomagnetic sensor
CN101954191A (en) * 2010-08-25 2011-01-26 颜小洋 Intelligent entertainment mobile robot
US20120053944A1 (en) * 2010-08-31 2012-03-01 Cuneyt Oncel Tuzel Method for Determining Compressed State Sequences

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
渠晋等: "《加速度计/磁强计无陀螺捷联惯导姿态解算研究》", 《电光与控制》 *

Cited By (58)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103945531A (en) * 2014-05-12 2014-07-23 哈尔滨工业大学 Method for WLAN indoor positioning Radio Map updating based on information entropy
CN104007416A (en) * 2014-05-30 2014-08-27 成都旗客科技有限公司 Indoor location error correcting method
CN104007416B (en) * 2014-05-30 2016-06-01 成都旗客科技有限公司 A kind of correction method of indoor positioning error
CN105277171B (en) * 2014-07-16 2019-01-01 中国移动通信集团公司 A kind of recording method of height above sea level, recording device and terminal
CN105277171A (en) * 2014-07-16 2016-01-27 中国移动通信集团公司 Altitude height recording method, recording device and terminal
CN104197936B (en) * 2014-09-10 2017-04-12 湖南格纳微信息科技有限公司 Indoor positioning method based on building regular structure information
CN106205213A (en) * 2014-12-30 2016-12-07 江苏理工学院 A kind of boats and ships trajectory predictions method
WO2016206119A1 (en) * 2015-06-26 2016-12-29 Intel Corporation Technologies for pedestrian dead reckoning
US11199421B2 (en) 2015-06-26 2021-12-14 Intel Corporation Technologies for pedestrian dead reckoning
US10393540B2 (en) 2015-06-26 2019-08-27 Intel Corporation Technologies for pedestrian dead reckoning
CN107636420A (en) * 2015-06-26 2018-01-26 英特尔公司 Technology for pedestrian's dead reckoning
JP2018524553A (en) * 2015-06-26 2018-08-30 インテル・コーポレーション Pedestrian dead reckoning technology
CN105184382A (en) * 2015-07-14 2015-12-23 成都乐动信息技术有限公司 Optimization method of trajectory and device
CN105184382B (en) * 2015-07-14 2018-12-28 成都乐动信息技术有限公司 The optimization method and device of motion profile
CN105136143B (en) * 2015-07-29 2017-09-29 哈尔滨工业大学 User's indoor sport path matching method based on IMU data
CN105136143A (en) * 2015-07-29 2015-12-09 哈尔滨工业大学 IMU data-based user indoor movement track matching method
CN105865445A (en) * 2016-03-29 2016-08-17 全感(苏州)智能技术有限公司 Inertial navigation indoor positioning system and use method thereof
CN105928512A (en) * 2016-04-26 2016-09-07 杭州欣晟达信息技术有限公司 Geomagnetic field-based indoor positioning method
CN105973224A (en) * 2016-04-26 2016-09-28 杭州荣旗科技有限公司 Indoor navigation method
CN105910601B (en) * 2016-05-31 2019-01-18 天津大学 A kind of indoor ground magnetic positioning method based on Hidden Markov Model
CN105910601A (en) * 2016-05-31 2016-08-31 天津大学 Indoor geomagnetic positioning method based on hidden Markov model
CN106250515B (en) * 2016-08-04 2020-05-12 复旦大学 Missing path recovery method based on historical data
CN106250515A (en) * 2016-08-04 2016-12-21 复旦大学 Miss path restoration methods based on historical data
CN106448064A (en) * 2016-09-12 2017-02-22 四川长虹电器股份有限公司 Drowning early warning system and method based on intelligent mobile equipment
CN107330085B (en) * 2017-07-03 2020-07-17 上海世脉信息科技有限公司 Method for judging, identifying and correcting error position of fixed sensor in big data environment
CN107330085A (en) * 2017-07-03 2017-11-07 上海世脉信息科技有限公司 Judgement identification and the antidote of sensor error position are fixed under big data environment
CN107506780A (en) * 2017-07-04 2017-12-22 上海谦尊升网络科技有限公司 A kind of mode identification method under the conditions of multiple features
CN107421527A (en) * 2017-07-17 2017-12-01 中山大学 A kind of indoor orientation method based on Magnetic Field and motion sensor
CN107339992A (en) * 2017-08-24 2017-11-10 武汉大学 A kind of method of the semantic mark of the indoor positioning and terrestrial reference of Behavior-based control
CN107339992B (en) * 2017-08-24 2020-01-24 武汉大学 Indoor positioning and landmark semantic identification method based on behaviors
CN107818300A (en) * 2017-10-18 2018-03-20 河海大学 A kind of gait denoising method based on HMM
CN108537101A (en) * 2018-01-05 2018-09-14 浙江大学 A kind of pedestrian's localization method based on state recognition
CN108537101B (en) * 2018-01-05 2022-03-25 浙江大学 Pedestrian positioning method based on state recognition
CN108801263A (en) * 2018-05-31 2018-11-13 北京辰安科技股份有限公司 pedestrian navigation positioning system and method
CN109003458A (en) * 2018-08-09 2018-12-14 河海大学常州校区 Crossing vehicle violation based on three axis geomagnetic sensors monitors system and method
CN109612458A (en) * 2018-10-26 2019-04-12 南京航空航天大学 The method for realizing user location tracking in mountain area environment using mobile phone air pressure and acceleration transducer
CN109998551B (en) * 2019-04-11 2020-09-11 北京航空航天大学 Gait phase analysis method for sectional type local peak detection
CN109998551A (en) * 2019-04-11 2019-07-12 北京航空航天大学 A kind of gait phase analysis method of segmented local peak detection
CN110245707A (en) * 2019-06-17 2019-09-17 吉林大学 Human body walking posture vibration information recognition methods and system based on scorpion positioning
CN110245707B (en) * 2019-06-17 2022-11-11 吉林大学 Human body walking posture vibration information identification method and system based on scorpion positioning
CN110502121A (en) * 2019-07-24 2019-11-26 江苏大学 A kind of frame dummy keyboard and its Introduced Malaria algorithm for thering is sense of touch height to distinguish rate
CN110502121B (en) * 2019-07-24 2023-02-17 江苏大学 Frame type virtual keyboard with touch sense and high recognition resolution and input correction algorithm thereof
CN110426037A (en) * 2019-08-08 2019-11-08 扆亮海 A kind of pedestrian movement track real time acquiring method under enclosed environment
CN110738095A (en) * 2019-08-23 2020-01-31 珠海格力电器股份有限公司 behavior analysis method and device
CN110766154A (en) * 2019-09-18 2020-02-07 北京邮电大学 Pedestrian track inference method, device, equipment and storage medium
CN110796040A (en) * 2019-10-15 2020-02-14 武汉大学 Pedestrian identity recognition method based on multivariate spatial trajectory correlation
CN110796040B (en) * 2019-10-15 2022-07-05 武汉大学 Pedestrian identity recognition method based on multivariate spatial trajectory correlation
WO2021136193A1 (en) * 2019-12-31 2021-07-08 苏州欧普照明有限公司 Illumination apparatus capable of automatically adjusting illumination direction
CN111174784A (en) * 2020-01-03 2020-05-19 重庆邮电大学 Visible light and inertial navigation fusion positioning method for indoor parking lot
CN111307154A (en) * 2020-02-27 2020-06-19 南京大学 Indoor pedestrian tracking system based on magnet array scanning and working method thereof
CN111307154B (en) * 2020-02-27 2023-02-21 南京大学 Indoor pedestrian tracking system based on magnet array scanning and working method thereof
CN111781592A (en) * 2020-06-12 2020-10-16 中国船舶重工集团公司第七二四研究所 Rapid automatic starting method based on fine-grained characteristic analysis
CN111781592B (en) * 2020-06-12 2023-12-22 中国船舶集团有限公司第七二四研究所 Rapid automatic starting method based on fine granularity characteristic analysis
CN111854791A (en) * 2020-07-21 2020-10-30 北京卡路里信息技术有限公司 Motion trajectory determination method and device, terminal equipment and storage medium
CN112146658A (en) * 2020-09-17 2020-12-29 深圳市自由空间标识有限公司 Intelligent guiding method, device and system
CN113109853A (en) * 2021-03-12 2021-07-13 上海卫星工程研究所 Satellite attitude variable frequency calculation output method and system based on double-frequency and double-mode design
CN113408333A (en) * 2021-04-27 2021-09-17 上海工程技术大学 Method for distinguishing pedestrian traffic behaviors in subway station based on video data
CN113408333B (en) * 2021-04-27 2022-10-11 上海工程技术大学 Method for distinguishing pedestrian traffic behaviors in subway station based on video data

Also Published As

Publication number Publication date
CN103471589B (en) 2015-10-21

Similar Documents

Publication Publication Date Title
CN103471589B (en) The method of the identification of a kind of indoor pedestrian's walking mode and trajectory track
CN108759833B (en) Intelligent vehicle positioning method based on prior map
Zhao et al. A robust laser-inertial odometry and mapping method for large-scale highway environments
CN110095127B (en) Hidden Markov model map matching method based on segmentation
CN105716604A (en) Mobile robot indoor positioning method and system based on geomagnetic sequences
CN109186610B (en) Robust BSLAM method for AUV terrain matching navigation
CN106123890A (en) A kind of robot localization method of Fusion
CN110488842B (en) Vehicle track prediction method based on bidirectional kernel ridge regression
CN111536967A (en) EKF-based multi-sensor fusion greenhouse inspection robot tracking method
CN104864871A (en) Indoor positioning and path leading method based on mobile terminal inertial navigation
CN108387236B (en) Polarized light SLAM method based on extended Kalman filtering
CN112762957B (en) Multi-sensor fusion-based environment modeling and path planning method
CN107421527A (en) A kind of indoor orientation method based on Magnetic Field and motion sensor
CN114964212B (en) Multi-machine collaborative fusion positioning and mapping method oriented to unknown space exploration
JP2007322391A (en) Own vehicle position estimation device
CN106028446A (en) Indoor parking lot location method
Kaess et al. Concurrent filtering and smoothing
CN103630147A (en) Zero-speed detection method for individually autonomous navigation system based on hidden Markov model (HMM)
CN111123953B (en) Particle-based mobile robot group under artificial intelligence big data and control method thereof
CN111399021A (en) Navigation positioning method
Ding et al. OGI-SLAM2: A hybrid map SLAM framework grounded in inertial-based SLAM
Jiang et al. 3D SLAM based on NDT matching and ground constraints for ground robots in complex environments
CN111761583B (en) Intelligent robot motion positioning method and system
CN111951341A (en) Closed loop detection improvement method based on RGB-D SLAM
CN112612034A (en) Pose matching method based on laser frame and probability map scanning

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant