This application is the U.S. National Stage of International Application Number PCT/EP2006/002272 filed on Mar. 7, 2006 which was published in English on Sep. 13, 2007 under International Publication Number WO 2007/101453.
The invention relates to a method of tracking a state of a mobile electronic device and to a mobile electronic device including processing apparatus arranged to perform the method.
One of the challenges in personal positioning is to provide accurate position information in situations where there are only a few measurement sources available that might have large errors with unusual distributions, particularly indoors or in urban areas, requiring the efficient numerical solution of the nonlinear filtering equations resulting from the fusion of these different measurement sources. In these cases, it is advantageous that the maximum amount of information be extracted from every measurement.
The behaviour of satellite-based systems such as GPS is unpredictable at best when used indoors in high-sensitivity mode. Local wireless networks, such as the cellular network, WLAN or Bluetooth offer some positioning capability but with inferior accuracy when compared to GPS. Other possible components of a mobile electronic device are the on-board sensors such as accelerometers, barometers or digital compasses.
Combining the various measurement sources is difficult because of different error characteristics, unpredictable distortions, systematic errors in measurements, strong nonlinearity, complex time dependencies, and missing data. It is not simple to model all the cases in a general way, let alone solve the models accurately. Even with correct models, the commonly used Kalman filter and its nonlinear extensions can fail without warning.
According to a first aspect of the invention, there is provided a method of tracking a state of a mobile electronic device, the method comprising iteratively performing the steps (actions) of
The state of the mobile electronic device may comprise the state variables including but not limited to position, velocity, acceleration, and clock error, whether alone or in combination.
The number of dimensions of the state space corresponds to the total number of dimensions of the state variables, with each cell including a number of dimensions equal to that of the state space. For example, the state space and the cells may be six-dimensional to represent position in three dimensions and velocity in three dimensions.
The invention provides a memory whereby all information is retained from measurement geometries that do not produce a unique position solution or that produce multiple solutions, and whereby the shape of the posterior distribution is retained without dropping any of its peaks.
The invention is faster to run than a particle filter, is more general than location fingerprint methods, and propagates the complete position distribution, thus being able to represent undetermined or multiple-solution systems accurately.
Preferably, the grid is a uniformly-spaced parallelepiped grid, in order to alleviate problems regarding the computation load of the method.
Step (i) in respect of one or more iterations may comprise obtaining measurement signalling and forming the grid based on the measurement signalling. A position estimate may be derived from measurement signalling comprising any of, for example, a range, a range difference or a planar measurement. A range measurement may be obtained from cellular base stations, WLAN or Bluetooth transmitters, and/or acoustic sensors, and may be in the form of a time delay, round-trip or signal strength measurement, for example. Other types of measurement signalling indicating position include but are not limited to angle of arrival measurements, maximum-minimum range windows, base sector information, and on-board barometers and digital compasses. Velocity can be measured using deltarange and heading measurements. Acceleration can be measured using on-board accelerometers.
It is to be understood that the details of the measurement signalling are not important to the invention, provided that the value(s) of the state variable(s) in question can be obtained or estimated using the measurement signalling, whether used alone or in conjunction with other measurement signalling.
Step (i) in respect of one or more of a second and subsequent iterations may comprise using the updated grid of step (iii) of a preceding iteration.
The one or more iterations may comprise the step of (iv) predicting the probability values of the grid of the subsequent iteration based on the updated grid and a motion model for the mobile electronic device to obtain a predicted grid.
Step (iv) may include rebounding the grid, and/or using the predicted grid in step (i) of the subsequent iteration.
Rebounding the grid may comprise moving a boundary of the grid to exclude cells having a probability value below the predetermined threshold, and/or moving the boundary to include cells having a probability value above the predetermined threshold. In some cases, cells exist beyond the boundary but have a probability value of zero. If, following any process, the probability value of such cells increases, the boundary is moved so as to include any such cells having probability values above the predetermined threshold. In some cases, no cells exist beyond the boundary. Following any process which results in alteration of probability values, the invention may comprise the step of defining temporary cells beyond the boundary, calculating probability values for these cells, and moving the boundary to include any such cells having probability values above the predetermined threshold.
Preferably, the motion model is linear, in order to alleviate problems regarding the computation load of the method.
One or more iterations may comprise the step of (v) calculating an expected value and a variance for the state of the mobile electronic device based on the updated grid.
According to a second aspect of the invention, there is provided a mobile electronic device including processing apparatus arranged to perform the method of the first aspect of the invention.
The present invention also comprises a computer program arranged to perform the method and a system in which the mobile electronic device of the present invention operates. The invention encompasses one or more aspects and embodiments in various combinations whether or not specifically mentioned (or claimed) in that combination.
In order that the invention may more readily be understood, a description is now given, by way of example only, reference being made to the accompanying drawings, in which:—
In the following description, like reference numerals refer to like features regardless as to which embodiment the features belong.
The method of the invention will now be described, using the following nomenclature.
Subscript k indexes the time instant
In this step, the state xk of the mobile electronic device is represented using a grid comprising a plurality of cells. Each cell represents a region in state space and has a probability value that the state xk of the mobile electronic device is within that region.
For example, the state xk may comprise the three-dimensional state variables position rk and velocity vk,
Each cell is then six-dimensional to represent six-dimensional regions of state space. However, for illustrate purposes,
The prior distribution 10 is approximated using a prior grid 12 consisting of a number of two-dimensional cells 14 of uniform size and shape. Each cell 14 represents a region on the surface of the earth and has a prior probability value that the mobile electronic device is positioned within that region.
It is to be understood that
The prior grid 12 includes a boundary 16 within which all cells 14 have a prior probability value above a predetermined threshold. Thus, the grid approximation of the prior distribution is truncated by the boundary 16 to represent a significant domain S, being a (simply connected) region in d, in which the prior probability values are non-negligible.
In the example of
Only cells 14 within the boundary 16 are defined in the memory 102 of the mobile electronic device. In a variant, the memory 102 defines cells beyond the boundary but with the prior probability value of these cells set to zero. In either case, the approximation by the prior grid 12 of the prior distribution 10 is truncated by the boundary 16 to facilitate computation.
The number of cells 14 in the prior grid 12 is a matter of design choice, in order to find a balance between computation load and accuracy. One extreme choice is to generate a large number of small cells. In this case, the approximation is asymptotically accurate even if the probability values are suboptimal, as is the case in the known point-mass filter, which uses only a density value being equivalent to that in the centre of a cell 14 according to the invention. Another extreme choice is to use a small number of large cells 14. It is then advantageous that the prior probability values be computed as accurately as possible. Most of the structure of the prior distribution 10 is lost when approximated with large cells 14. Optimally, the cells 14 should not be much smaller than the finest features of the prior distribution 10.
In this step, the time index k is set to k=1.
Step (ii)
In this step, measurement signalling is obtained via the transceiver modules 104a-d indicating values of one or more state variables.
Although in
The measurement signalling may comprise any of, for example, a range, a range difference or a planar measurement in order to obtain a position estimate.
Given the true position r, a range measurement to a station at position s can be written as h(r)=∥s−r∥. The associated measurement error v need not be normal, and is represented by an empirically-determined distribution that matches the real situation.
The biased range measurements obtained from the GPS system are treated as range differences. One of the stations is chosen as reference station and all the differences are formed with respect to it. If the reference station is at s0, the range difference measurement is h(r)=∥s−r∥−∥s0−r∥.
Finally, the planar measurement is h(r)=uTr, where u is a unit vector.
During this step, all available measurements are stacked into a vector yk and the corresponding measurement equations into a vector function hk(x).
As an example, consider the case with nd range difference measurements, nr range measurements, and np planar measurements. Then the measurement vector is y=[d1 . . . dnd r1 . . . rnr a1 . . . anp]T, and the measurement model is
If all the measurement errors have normal distributions, the measurement likelihood function 18 is
where Σ is the covariance matrix of the measurement errors v.
Step (iii)
In this step, the prior probability values of the prior grid 12 are updated based on the measurement signalling to produce a posterior grid 12′, and the posterior grid 12′ is rebounded.
The posterior probability values of the posterior grid 12′ are found by multiplying the prior probability value in each cell 14 with the total likelihood in the cell 14, found by integrating the likelihood function over the cell 14:
The posterior grid 12′ is rebounded with new boundary 16′ to include only cells 14′ having a probability value above the predetermined threshold. If a cell 14 within previous boundary 16 has a posterior probability value below the predetermined threshold, the new boundary 16′ is placed so as to exclude that cell 14.
Step (iv)
In this optional step, a predicted grid 12″ having cells 14″ is obtained based on the posterior grid 12′ of the current iteration and a motion model for the mobile electronic device. The predicted grid 12″ forms the prior grid 12 of the subsequent iteration.
The predicted prior probability value of a cell 14″ is found by summing all probabilities values in the current iteration weighted by the probabilities of transition to that cell 14″, according to the following equations. The predicted prior distribution 10′ is normalized after all probability values have been computed.
Denoting the volume of each cell 14″ with αk=|det Ek|, the predicted prior probability values πk|k−1(i) are computed by integrating the predictive pdf over the cell 14″:
Replacing pk−1|k−1 with its grid approximation yields
where Γk(i|j) is the transition probability from jth cell of the (k−1)th grid to ith cell of the kth grid.
In the interest of computational efficiency, a linear motion model is used, e.g. f(x)≡Tx. The predicted grid 12″ is formed by applying the motion model to the posterior grid 12′. The transition probability between the ith cell in the old grid and the jth cell of the new grid depends only on the difference i−j, and we can write Γk(i|j)=τk(i−j). The predicted prior probability values become
which is fast to compute as a d-dimensional discrete linear convolution.
Now the transition probability τk(i−j) is
This can be simplified to
where pw,i−j is shorthand for the modified process noise probability density function. Specifically, if wk˜N(0, Q), then
wk,i−j˜N(j−i−Ek−1(ek−Tek−1),(Ek−1)TQEk−1)
The integral then is just multinormal probability in a hyper-box and can be computed numerically.
If wk is non-Gaussian, the transition probabilities τk(i−j) can be computed using the cumulative distribution.
Following the application of the motion model, the boundary 16′ is moved to become boundary 16″ which includes all cells 14″ both within and beyond the previous boundary 16′ having a predicted probability value above the predetermined threshold.
In the case where cells 14″ existed beyond the previous boundary 16′ and had prior and posterior probability values of zero, the new boundary 16″ is placed to include any of these cells 14″ which have a predicted probability value above the predetermined threshold.
In the variant wherein no cells existed beyond the previous boundary 16′, new cells 14″ are added having a size, shape and orientation corresponding to that of existing cells 14′, and the new boundary 16″ is placed so as to include the new cells 14″. It is to be understood that the size, shape and/or orientation of the new cells 14″ need not coincide with those of the existing predicted grid 12″. It can readily be determined whether such non-existent cells would have a probability value above the predetermined threshold by defining a number of temporary cells 14″ beyond the previous boundary 16′ and calculating predicted probability values for the temporary cells 14″. Such temporary cells 14″ are continually defined and their probability values calculated until a point is reached where a shell of temporary cells 14″ having probability values below the threshold is created. The new boundary 16″ is then placed so as to include all temporary cells 14″ having probability values above the threshold.
Step (v)
In this step, an expected value and a variance for the state of the mobile electronic device are calculated based on the predicted grid 12″, according to the following equations.
Finally, the time index k is increased and the method repeated from Step (i).
It will be understood that the present invention uses a grid-mass approach to perform the method of tracking a state of a mobile electronic device.
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/EP2006/002272 | 3/7/2006 | WO | 00 | 1/21/2009 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2007/101453 | 9/13/2007 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
6542116 | Sahai et al. | Apr 2003 | B1 |
6889053 | Chang et al. | May 2005 | B1 |
7209752 | Myllymaki et al. | Apr 2007 | B2 |
20040072577 | Myllymaki et al. | Apr 2004 | A1 |
Number | Date | Country |
---|---|---|
2001313972 | Nov 2001 | JP |
2001313972 | Nov 2001 | JP |
WO 0239063 | May 2002 | WO |
WO 0239063 | May 2002 | WO |
Number | Date | Country | |
---|---|---|---|
20090233619 A1 | Sep 2009 | US |