METHOD AND POSITIONING ENGINE FOR DETERMINING A POSITION OF A MOBILE DEVICE

Abstract

An example method of determining a position of a mobile device includes, for each of a plurality of anchor points, receiving respective relative position information between the respective anchor point and the mobile device such that the received relative position information for the plurality of anchor points forms a set of position information, each relative position information including at least one of: a direction between the respective anchor point and the mobile device, a distance between the respective anchor point and the mobile device, or a direction and a distance between the respective anchor point and the mobile device. The method includes determining an estimated position of the mobile device based on the set of position information; defining a set of loci, each locus of the set of loci being based on one or more of the relative position information from the set of position information; determining, for each locus of the set of loci, a distance value between the estimated position of the mobile device and the respective locus; determining, for each locus of the set of loci, a weight factor as a function of the determined distance values; and determining a refined position of the mobile device based on the set of position information and the determined weight factors. A positioning engine for determining a position of a mobile device is disclosed as well.

Claims

1. A method for determining a position of a mobile device, the method comprising: for each of a plurality of anchor points, receiving respective relative position information between the respective anchor point and the mobile device such that the received relative position information for the plurality of anchor points forms a set of position information, each relative position information including at least one of: a direction between the respective anchor point and the mobile device; a distance between the respective anchor point and the mobile device; a direction and a distance between the respective anchor point and the mobile device; determining an estimated position of the mobile device based on the set of position information; defining a set of loci, each locus of the set of loci being based on one or more of the relative position information from the set of position information; determining, for each locus of the set of loci, a distance value between the estimated position of the mobile device and the respective locus; determining, for each locus of the set of loci, a weight factor w.sub.i as a function of the determined distance values; and determining a refined position of the mobile device based on the set of position information and the determined weight factors.

2. The method according to claim 1, wherein determining the estimated position of the mobile device is performed with a linear equation system solved with a Least-Squares approach; and determining the refined position of the mobile device is performed with the linear equation system solved with a weighted Least-Squares approach based on the determined weight factors.

3. The method according to claim 1, wherein the distance values are determined as squared distances between the estimated position of the mobile device and the respective locus.

4. The method according to claim 1, wherein the function determining the weight factor for each locus of the set of loci as a function of the determined distance values is monotonically decreasing or strictly decreasing with respect to the associated distance value of the respective locus.

5. The method according to claim 1, wherein the weight factor w.sub.i for each locus of the set of loci as a function of the determined distance values is defined as $w_i={\left[1-{\left(\frac{E_i}{E_{\mathrm{threshold}}+{.Math.}_{j=1}^M{E}_j}\right)}^{\mu }\right]}^v,$ wherein i denotes the associated locus; M denotes the number of loci; E.sub.j denotes the distance value for the locus j; E.sub.threshold denotes a distance threshold value; and μ, v are exponent values with ρ, v>0.

6. The method according to claim 1, wherein the weight factor w.sub.i for each locus of the set of loci as a function of the determined distance values is defined as $w_i={\left(\frac{E_{\mathrm{threshold}}+\min \left\{E_1,E_2,.Math.,E_i,.Math.,E_M\right\}}{E_{\mathrm{threshold}}+E_i}\right)}^v,$ wherein i denotes the associated locus; M denotes the number of loci; E.sub.j denotes the distance value for the locus j; E.sub.threshold denotes a distance threshold value; and v is an exponent value with v>0.

7. The method according to claim 1, wherein the weight factor w.sub.i for each locus of the set of loci as a function of the determined distance values is defined as $w_i=\{\begin{array}{c}{w}_{\mathrm{high}},E_i<E_{\mathrm{threshold}}\\ w_{\mathrm{low}},E_i\ge E_{\mathrm{threshold}}\end{array},$ wherein i denotes the associated locus; E.sub.j denotes the distance value for the locus i; E.sub.threshold denotes a distance threshold value; w.sub.high denotes a high weight factor; and w.sub.low denotes a low weight factor that is smaller than the high weight factor w.sub.high.

8. The method according to claim 1, wherein the refined position of the mobile device is determined further based on quality information for at least one of the plurality of anchor points.

9. The method according to claim 8, wherein the quality information for the at least one anchor point is determined from at least one of the following: a signal strength associated with the received relative position of the at least one anchor point; a number of antenna elements of the at least one anchor point; a confidence factor associated with the received relative position of the at least one anchor point; upper and/or lower bounds for the weight factor associated with the at least one anchor point.

10. The method according to claim 1, wherein the method is performed in an iterative fashion such that: in an initial iteration step the estimated position is determined based on the set of position information; and in each subsequent iteration step the refined position determined in a respective preceding iteration step is used as the estimated position for determining the distance values and the weight factors.

11. The method according to claim 1, wherein an absolute position of each of the plurality of anchor points is known.

12. The method according to claim 1, wherein the method is performed in a positioning engine.

13. A positioning engine for determining a position of a mobile device, the positioning engine comprising: a receiver configured for receiving from each of a plurality of anchor points respective relative position information between the respective anchor point and the mobile device such that the received relative position information for the plurality of anchor points forms a set of position information, each relative position information including at least one of: a direction between the respective anchor point and the mobile device; a distance between the respective anchor point and the mobile device; a direction and a distance between the respective anchor point and the mobile device; and a processing unit configured for: determining an estimated position of the mobile device based on the set of position information; defining a set of loci, each locus of the set of loci being based on one or more of the relative position information from the set of position information; determining, for each locus of the set of loci, a distance value between the estimated position of the mobile device and the respective locus; determining, for each locus of the set of loci, a weight factor as a function of the determined distance values; and determining a refined position of the mobile device based on the set of position information and the determined weight factors.

14. At least one tangible, non-transitory, machine-readable media storing one or more instructions that, when executed by one or more processors, cause the one or more processors to perform operations comprising: for each of a plurality of anchor points, receiving respective relative position information between the respective anchor point and the mobile device such that the received relative position information for the plurality of anchor points forms a set of position information, each relative position information including at least one of: a direction between the respective anchor point and the mobile device; a distance between the respective anchor point and the mobile device; a direction and a distance between the respective anchor point and the mobile device; determining an estimated position of the mobile device based on the set of position information; defining a set of loci, each locus of the set of loci being based on one or more of the relative position information from the set of position information; determining, for each locus of the set of loci, a distance value between the estimated position of the mobile device and the respective locus; determining, for each locus of the set of loci, a weight factor w.sub.i as a function of the determined distance values; and determining a refined position of the mobile device based on the set of position information and the determined weight factors.

15. (canceled)

Description

BRIEF DESCRIPTION OF DRAWINGS

[0028] The improved processing concept will be explained in more detail in the following with the aid of the drawings. Elements and functional blocks having the same or similar function bear the same reference numerals throughout the drawings. Hence their description is not necessarily repeated in following drawings.

[0029] In the drawings:

[0030] FIG. 1 shows a flowchart of a method for determining a position of a mobile device;

[0031] FIG. 2 shows an example of a positioning system;

[0032] FIG. 3 shows an example 3D view of anchor points and a mobile device;

[0033] FIG. 4 shows an example 3D view of an anchor point and a mobile device with a distance sphere;

[0034] FIG. 5 shows an example vector with a spherical coordinates definition;

[0035] FIG. 6 shows an example 3D view of an anchor point and a mobile device with a line locus;

[0036] FIG. 7 shows an example 3D view of an anchor point and a mobile device with a (relative) positional vector;

[0037] FIG. 8 shows an example 3D view of two anchor points and a mobile device with respective distance spheres;

[0038] FIGS. 9A and 9B show example 3D and 2D views of anchor points and a mobile device with respective loci; and

[0039] FIGS. 10 to 13 show examples of cumulative distribution functions of localization errors.

DETAILED DESCRIPTION

[0040] FIG. 1 shows a flow diagram of an example implementation of a method 100 for determining a position of a mobile device. The mobile device can be a tag that transmits or receives a radio frequency, RF, signal, like a Bluetooth direction finding signal, which includes a constant tone extension packet, CTE. Other RF signals like Wi-Fi signals, Ultra-wideband, UWB, or cellular signals could be used as an alternative, for example. Such signals are transmitted between the mobile device and a plurality of anchor points.

[0041] Referring now to FIG. 2, an example of a positioning system is shown comprising a positioning engine LPE that includes a processing unit PROC and a receiver RX. Furthermore, the positioning system includes a plurality of anchor points 1, 2, 3, 4, 5. FIG. 2 further shows a mobile device TG that further may be comprised by the positioning system. It should be noted that in some implementations the positioning engine LPE can be placed inside one of the anchor points 1-5 or inside the mobile device TG, or even in a network cloud. By transmitting respective signals between the mobile device TG and each of the anchor points 1-5 as described above, relative position information for each of the anchor points 1-5 can be determined by the respective anchor point and/or the mobile device TG. Such relative position information includes one of i) a direction between the respective anchor point and the mobile device, ii) a distance between the respective anchor point and the mobile device TG, and iii) a direction and distance between the respective anchor point and the mobile device TG. Respective measures for determining such relative position information are known to the skilled person and therefore not described in more detail here.

[0042] Referring back to FIG. 1, in step 101, for each of the plurality of anchor points 1-5 the respective relative position information between the respective anchor point and the mobile device TG is received, for example by the receiver RX of the positioning engine LPE, such that the received relative position information for the plurality of anchor points 1-5 forms a set of position information.

[0043] Further method steps 102 to 106 may be carried out by the processing unit PROC of the positioning engine LPE.

[0044] It should be noted that the number of five anchor points chosen in the example of FIG. 2 should not be limiting and a smaller or greater number of anchor points could be used without loss of generality. The lower limit of anchor points is e.g. two if direction is included in the relative position information, and e.g. four if only a distance is included in the relative position information received for an anchor point. Generally, the lower limit depends on the type of relative position information provided by the anchor points to be used, which in detail will be apparent to the skilled reader from the above description.

[0045] A direction may be defined as a directional vector or as a 3D angle of arrival, AoA, or 3D angle of departure, AoD.

[0046] Referring now to FIG. 3, an example 3D view of the anchor points 1-5 and a mobile device TG is shown, in particular in a 3D coordinate system. In this example, anchor point 1 and anchor point 2 are each able to provide relative position information including a distance between the anchor points 1, 2 and the mobile device TG. The mobile device TG is shown at its ground truth position. For anchor point 3, the relative position information includes both a direction and a distance between the anchor point 3 and the mobile device TG. For anchor points 4 and 5, the relative position information includes only a direction between the respective anchor points 4, 5 and the mobile device TG, e.g. derived from respective AoA measurements.

[0047] In this example the case is assumed where the mobile device TG is moving around a room and the anchor points 1-5 are responsible for measuring the distance and/or the AoA/AoD among them and the mobile device TG. A position of the anchor points 1-5 is assumed to be known. Furthermore, each measurement of distance and/or AoA/AoD is being conducted or transformed in such a way with respect to a global coordinate frame that characterizes the room under examination.

[0048] Referring now to FIG. 4, an example 3D view of an anchor point and a mobile device is shown. This anchor point 2, for example, measures only a distance. An anchor point that measures distance can be, for example, an UWB anchor point or a Bluetooth access point or a Wi-Fi router or any other device capable of estimating a distance between itself and the presumably moving target. However, it has to be assumed that due to AWGN, multipath, obstacles in the line of sight and other factors, the measured distance is erroneous. As shown in FIG. 4, by measuring a distance, an anchor defines a sphere, also called a distance sphere, where the center of the sphere is the anchor point 2 itself and the radius equals the measured distance.

[0049] Let us suppose that the Anchor A.sub.i is located at the point x.sub.i,y.sub.i,z.sub.i and measures a distance d.sub.i. Then, the equation of the distance sphere is given by equation (1), where every quantity is expressed with respect to the room-global coordinate system that is depicted in FIG. 3.

[00001]$\begin{array}{cc}\mathrm{Anchor}\mathrm{point}:A_i\left(x_i,y_i,z_i\right){\left(x-x_i\right)}^2+{\left(y-y_i\right)}^2+{\left(z-z_i\right)}^2=d_i^2& \left(1\right)\end{array}$

[0050] Referring now to FIG. 5, a definition of spherical coordinates is shown that is going to be used in this disclosure.

[0051] In mathematics, a spherical coordinate system is a coordinate system for three-dimensional space where the position of a point is specified by three numbers: the radial distance r of that point from a fixed origin, its polar angle θ measured from a fixed zenith direction, and the azimuthal angle φ of its orthogonal projection on a reference plane that passes through the origin and is orthogonal to the zenith, measured from a fixed reference direction on that plane.

[0052] The spherical coordinates vary at the following range:

[00002]$$\begin{gathered} \begin{array}{cc}r\ge 0 \\ 0\le \theta \le \pi \\ 0\le \phi <2\pi \mathrm{or}-\pi <\phi \le \pi & \left(2\right)\end{array} \end{gathered}$$

[0053] Referring now to FIG. 6, anchor point 4 is shown that measures a direction between itself and the mobile device TG.

[0054] For example, such an anchor point, after the appropriate coordinate transformations, provides two angles φ and θ which are the spherical coordinates of the target, except of the “r”. These two angles are measured with respect to the global coordinate axes that have been transferred to the anchor's position without changing its orientation.

[0055] The direction on which the target is located, relative to the anchor point's position is given by the directional vector {right arrow over (δ)}.sub.i which is defined in equation (3):

[00003]$\begin{array}{cc}\mathrm{Measured}\mathrm{angles}:{\phi }_i,{\theta }_i{\stackrel{.fwdarw.}{\delta }}_i=\left[\begin{array}{c}{\delta }_{ix}\\ {\delta }_{iy}\\ {\delta }_{iz}\end{array}\right]=\left[\begin{array}{c}\cos {\phi }_i.Math.\sin {\theta }_i\\ \sin {\phi }_i.Math.\sin {\theta }_i\\ \cos {\theta }_i\end{array}\right]& \left(3\right)\end{array}$

[0056] Directional vector {right arrow over (δ, )} defines completely a 3D straight line which contains the anchor and the tag, provided that no error has occurred.

[0057] Let us suppose that the tag and the anchor are located at the points T(x,y,x) and respectively. Then we can assert that

[00004]$$\begin{gathered} \begin{array}{cc}\stackrel{.fwdarw.}{A_{\mathrm{.Math.}}T}=\left[\begin{array}{c}x-x_i\\ y-y_i\\ z-z_i\end{array}\right],{\stackrel{.fwdarw.}{\delta }}_i=\left[\begin{array}{c}{\delta }_{ix}\\ {\delta }_{iy}\\ {\delta }_{iz}\end{array}\right] \\ \stackrel{.fwdarw.}{A_{\mathrm{.Math.}}T}//{\stackrel{.fwdarw.}{\delta }}_i.Math.\{\begin{array}{c}\frac{x-x_i}{y-y_i}=\frac{{\delta }_{\mathrm{ix}}}{{\delta }_{\mathrm{iy}}}\\ \frac{y-y_i}{z-z_i}=\frac{{\delta }_{\mathrm{iy}}}{{\delta }_{\mathrm{iz}}}\end{array}.Math.\{\begin{array}{c}{\delta }_{iy}x-{\delta }_{ix}y={\delta }_{iy}{x}_i-{\delta }_{ix}{y}_i\\ {\delta }_{iz}y-{\delta }_{iy}z={\delta }_{iz}{y}_i-{\delta }_{i{y}^{Z}i}\end{array}& \left(4\right)\end{array} \end{gathered}$$

[0058] The last equation (4) represents the aforementioned 3D straight line which is depicted in FIG. 6.

[0059] Referring now to FIG. 7, an example 3D view of anchor point 3 and the mobile device TG with a directional vector is shown. Anchor point 3 is able to measure both distance and AoA. For example, a Bluetooth access point which is equipped with an antenna array, is capable to measure both types of information.

[0060] In this case, the anchor point 3 is a combination of the previous scenarios and based on equation (3), this anchor point determines a relative positional vector that is pointing to the target, respectively to the mobile device TG.

[0061] Indeed, if we suppose that the anchor A.sub.i is located at the point (x.sub.i,y.sub.i,z.sub.i) and measures a distance d.sub.i and the two angles φ.sub.i and θ.sub.i, then we can derive the following equation:

[00005]$\begin{array}{cc}\begin{array}{cc}\begin{array}{c}\mathrm{Measured}\mathrm{distance}:\\ d_i\\ \mathrm{Measured}\mathrm{angles}:\\ {\phi }_i,{\theta }_i\end{array}& {\stackrel{.fwdarw.︀}{\Delta }}_i\end{array}=d_i.Math.{\stackrel{.fwdarw.︀}{\delta }}_i=\left[\begin{array}{c}{\Delta }_{\mathrm{ix}}\\ {\Delta }_{\mathrm{iy}}\\ {\Delta }_{\mathrm{iz}}\end{array}\right]=\left[\begin{array}{c}{d}_i.Math.\cos {\phi }_i.Math.\sin {\theta }_i\\ d_i.Math.\sin {\phi }_i.Math.\sin {\theta }_i\\ d_i.Math.\cos {\theta }_i\end{array}\right]& \left(5\right)\end{array}$

[0062] If there is zero impact from multipath effects, AWGN, etc., then the positional vector {right arrow over (Δ)}.sub.i, which can also be called a relative positional vector, should point exactly at the location of the target.

[0063] Referring back to FIG. 1, step 102, an estimated position of the mobile device TG is determined, e.g. with processing unit PROC, based on the set of position information. To this end, the information being measured by the anchor points 1 to 5 of this example is exploited. A well-known method is to use equations (1), (4), (5) in order to create a system of linear equations and to use an LS approach in order to solve it. This should be demonstrated using the example configuration of FIG. 3, where all types of anchor points are present. The following table summarizes the details of all the anchor points 1 to 5.

TABLE-US-00001 NO. TYPE COORDINATES MEASUREMENTS 1 Distance A.sub.1 (x.sub.1, y.sub.1, z.sub.1) d.sub.1 2 Distance A.sub.2 (x.sub.2, y.sub.2, z.sub.2) d.sub.2 3 Distance and direction A.sub.3 (x.sub.3, y.sub.3, z.sub.3) d.sub.3, φ.sub.3, θ.sub.3 4 direction A.sub.4 (x.sub.4, y.sub.4, z.sub.4) φ.sub.4, θ.sub.4 5 direction A.sub.5 (x.sub.5, y.sub.5, z.sub.5) φ.sub.5, θ.sub.5

[0064] Of particular interest are the anchor points 1 and 2, which measure distance and define spheres given by equation (1). In order to use these anchor points, one must combine a pair of them each time and create a useful linear equation. In the present example there are only two of them, so we have the following algebraic manipulations:

[00006]$$\begin{gathered} \begin{array}{cc}\left(1\right).Math.\{\begin{array}{c}{\left(x-x_1\right)}^2+{\left(y-y_1\right)}^2+{\left(z-z_1\right)}^2=d_1^2\\ {\left(x-x_2\right)}^2+{\left(y-y_2\right)}^2+{\left(z-z_2\right)}^2=d_2^2\end{array} \\ .Math.\{\begin{array}{c}\left(x^2-2x_{1}x+x_1^2\right)+\left(y^2-2y_{1}y+y_1^2\right)+\left(z^2-2z_{1}z+z_1^2\right)=d_1^2\\ \left(x^2-2x_{2}x+x_2^2\right)+\left(y^2-2y_{2}y+y_2^2\right)+\left(z^2-2z_{2}z+z_2^2\right)=d_2^2\end{array} \\ \stackrel{(-)}{.Math.}\begin{array}{c}2\left(x_2-x_1\right)x+2\left(y_2-y_1\right)y+2\left(z_2-z_1\right)z\\ =\left(x_2^2-x_1^2\right)+\left(y_2^2-y_1^2\right)+\left(z_2^2-z_1^2\right)-\left(d_2^2-d_1^2\right)\end{array}& \left(6\right)\end{array} \end{gathered}$$

[0065] The last equation (6), in general, represents a plane in the 3D space. Referring now to FIG. 8, this plane, in the case where the spheres of anchor points 1 and 2 are intersected, contains the circle consisting of the common points of the two spheres shown in FIG. 8.

[0066] Before combining all equations from all kind of anchors, we have to normalize the equations that represent planes in the 3D-space. Namely, we transform equation (6) as follows. First we define the scaling factor SF.sub.12 for the plane equation (6), defined by anchors 1 and 2, see equation (7), and then we normalize, see equation (8).

[00007]$\begin{array}{cc}{\mathrm{SF}}_{12}=2\sqrt{{\left(x_2-x_1\right)}^2+{\left(y_2-y_1\right)}^2+{\left(z_2-z_1\right)}^2}& \left(7\right)\end{array}$$\begin{array}{cc}\frac{2\left(x_2-x_1\right)}{S{F}_{12}}x+\frac{2\left(y_2-y_1\right)}{S{F}_{12}}y+\frac{2\left(z_2-z_1\right)}{S{F}_{12}}z=\frac{\left(x_2^2-x_1^2\right)+\left(y_2^2-y_1^2\right)+\left(z_2^2-z_1^2\right)-\left(d_2^2-d_1^2\right)}{S{F}_{12}}& \left(8\right)\end{array}$

[0067] So, combining all kind of anchors of our example, we get the following matrix equation (9) with the known coordinates of the anchors,

[00008]$A_i=\left[\begin{array}{c}{x}_i\\ y_i\\ z_i\end{array}\right],1\le i\le 5$

[0068] and the unknown coordinates of the target

[00009]$\begin{array}{cc}X=\left[\begin{array}{c}x\\ y\\ z\end{array}\right].& \left(9\right)\end{array}$$\underset{H}{\underbrace{\left[\begin{array}{ccc}\frac{2\left(x_2-x_1\right)}{{\mathrm{SF}}_{12}}& \frac{2\left(y_2-y_1\right)}{{\mathrm{SF}}_{12}}& \frac{2\left(z_2-z_1\right)}{{\mathrm{SF}}_{12}}\\ 1& 0& 0\\ 0& 1& 0\\ 0& 0& 1\\ {\delta }_{4y}& -{\delta }_{4x}& 0\\ 0& {\delta }_{4z}& -{\delta }_{4y}\\ {\delta }_{5y}& -{\delta }_{5x}& 0\\ 0& {\delta }_{5z}& -{\delta }_{5y}\end{array}\right]}}\underset{X}{\underbrace{\left[\begin{array}{c}x\\ y\\ z\end{array}\right]}}=$$\underset{B}{\underbrace{\left[\begin{array}{c}\frac{\left(x_2^2-x_1^2\right)+\left(y_2^2-y_1^2\right)+\left(z_2^2-z_1^2\right)-\left(d_2^2-d_1^2\right)}{{\mathrm{SF}}_{12}}\\ x_3+{\Delta }_{3x}\\ y_3+{\Delta }_{3y}\\ z_3+{\Delta }_{3z}\\ {\delta }_{4y}{x}_4-{\delta }_{4x}{y}_4\\ {\delta }_{4z}{y}_4-{\delta }_{4y}{z}_4\\ {\delta }_{5y}{x}_5-{\delta }_{5x}{y}_5\\ {\delta }_{5k}{y}_5-{\delta }_{5y}{z}_5\end{array}\right]}}$

[0069] In the example of equation (9), the first row results from the distance information from anchors 1 and 2, rows 2-4 result from direction and distance information from anchor 3, and rows 5-8 result from the direction information from anchors 4 and 5, respectively. This also becomes apparent from the indices used.

[0070] Referring back to FIG. 1, step 102, a LS solution using pseudo-inverse can be applied for determining the estimated position {circumflex over (X)} of the mobile device TG:

[00010]$\begin{array}{cc}HX=B.Math.\hat{X}=\left[{\left(H^{T}H\right)}^{-1}{H}^T\right]B& \left(10\right)\end{array}$

[0071] Equation (10) is solved by assuming that all anchor points and all equations in the matrix equation (9) are of equal importance and have the same reliability. In the real world, this is not true. Several sources of errors make the equations that form the matrix equation (9), less or more reliable.

[0072] One approach is to use different weights for each equation. For example, in our case we can define a weight matrix and find the solution by using Weighted Least Square, WLS, algorithm.

[0073] In general, the idea of WLS, tailored to our example, is being illustrated as described in the following. An 8×8 diagonal weight matrix, such that, in general, each equation (here: 8) of the matrix equation (9) has its own weight.

[00011]$W=\left[\begin{array}{cccccc}{w}_1& 0& 0& 0& .Math.& 0\\ 0& w_2& 0& 0& .Math.& 0\\ 0& 0& w_3& 0& .Math.& 0\\ 0& 0& 0& w_4& .Math.& 0\\ .Math.& .Math.& .Math.& .Math.& \ddots & .Math.\\ 0& 0& 0& 0& 0& w_8\end{array}\right]$

[0074] Usage of the weight matrix W results in

[00012]$\begin{array}{cc}\left(\mathrm{HX}=B\right)\stackrel{\mathrm{weighted}}{\stackrel{\mathrm{LS}\mathrm{solution}}{⟹}}{\hat{X}}_w=\left[{\left(H^T\mathrm{WH}\right)}^{-1}{H}^{T}W\right]B& \left(11\right)\end{array}$

[0075] Of course, there are some critical issues. The most important of them are the following: [0076] how to define the weights to correspond to the equation's reliability; and [0077] how to estimate the values of the weights without waste an enormous amount of computational resources.

[0078] An indoor environment with many targets to follow inside it is not suitable for statistical models. Furthermore, trying to use memory and/or statistical models is extremely resource consuming when the number of tags increases.

[0079] With the improved processing concept it is proposed defining the weights, according to the distance of the estimated position and the locus defined by each anchor point or pair of anchor points, as described at the previous paragraphs.

[0080] It has already been described that each kind of anchor (or group of anchors) determines a specific locus for the target. The equations that describe each locus are the rows of the matrices H and B of the matrix equation (9) as mentioned above.

[0081] In our example, the correspondence between the type of the anchor(s), the type of the locus that is generated of each anchor type and the number of the equations which describes it in the 3D space, is summarized at the following table

TABLE-US-00002 Number of Number of Type of Anchor anchors Locus equations Measuring distance 2 plane 1 Measuring AoA/AoD 1 line 2 Measuring distance + AoA/AoD 1 point 3

[0082] Hence referring back to FIG. 1, in step 103, a set of loci is defined, each locus of the set of loci being based on one or more of the relative position information from the set of position information, e.g. according to the above table.

[0083] Furthermore, in step 104, for each locus of the set of loci, a distance value between the estimated position of the mobile device (TG) and the respective locus is determined.

[0084] This will be described in more detail in the following for the different possible configurations.

[0085] Distance between a point and a plane in the 3D space

[0086] Let us suppose that we want to determine the distance between the point X.sub.0(x.sub.0,y.sub.0,z.sub.0) and the plane described by equation (8). The distance is given from the following with A.sub.1(x.sub.1,y.sub.1,z.sub.1) and A.sub.2(x.sub.2,y.sub.2,z.sub.2) being the positions of the anchor points 1 and 2 that measure distances d.sub.1, d.sub.2.

[0087] Assuming the following notations

[00013]$$\begin{gathered} C_x=\frac{2\left(x_2-x_1\right)}{S{F}_{12}},C_y=\frac{2\left(y_2-y_1\right)}{S{F}_{12}},C_z=\frac{2\left(z_2-z_1\right)}{S{F}_{12}}, \\ {C}_0=\frac{\left(x_2^2-x_1^2\right)+\left(y_2^2-y_1^2\right)+\left(z_2^2-z_1^2\right)}{S{F}_{12}}{C}_d=\frac{\left(d_2^2-d_1^2\right)}{S{F}_{12}} \end{gathered}$$

[0088] and the plane equation with respect to equation (8),

C.sub.xx+C.sub.yy+C.sub.zz=C.sub.0−C.sub.d,

[0089] a distance D.sub.plane between the point X.sub.0(x.sub.0,y.sub.0,z.sub.0) and the plane results to

[00014]$\begin{array}{cc}{D}_{\mathrm{plane}}=\frac{.Math.C_x{x}_0+C_y{y}_0+C_z{z}_0-C_0+C_d.Math.}{\sqrt{C_x^2+C_y^2+C_z^2}}& \left(12\right)\end{array}$

[0090] The quantities C.sub.x, C.sub.y, C.sub.z, C.sub.0, SF.sub.12 and √{square root over (C.sub.x.sup.2+C.sub.y.sup.2+C.sub.z.sup.2)} depend on the anchor points only. This observation allows us to predetermine them and simplify the computational effort of such a distance calculation, resulting in the following equation (13):

D.sub.plane=|C.sub.x′x.sub.0+C.sub.0C.sub.y′y.sub.0+C.sub.z′z.sub.0−C.sub.0′+C.sub.d(d.sub.2.sup.2−d.sub.1.sup.2)|  (13)

[0091] Herein the following predefined coefficients are used:

[00015]$$\begin{gathered} C_x^{\prime }=\frac{c_x}{\sqrt{c_x^2+c_y^2+c_z^2}},C_y^{\prime }=\frac{c_y}{\sqrt{c_x^2+c_y^2+c_z^2}},C_z^{\prime }=\frac{c_z}{\sqrt{c_x^2+c_y^2+c_z^2}}, \\ {C}_0^{\prime }=\frac{c_0}{\sqrt{c_x^2+c_y^2+c_z^2}},C_d^{\prime }=\frac{1}{{\mathrm{SF}}_{12}\sqrt{c_x^2+c_y^2+c_z^2}}, \end{gathered}$$

[0092] Distance Between Two Points in the 3D Space

[0093] Let us suppose that we want to determine the distance between the point X.sub.0(x.sub.0,y.sub.0,z.sub.0) and the point defined by the vector {right arrow over (Δ)}.sub.3 for anchor point 3 as described above. The distance is given from the following equations. With A.sub.3(x.sub.3,y.sub.3,z.sub.3) being the position of the anchor point 3, and measured distance d.sub.3 and measured angles φ.sub.3, θ.sub.3, the vector {right arrow over (Δ)}.sub.3 for anchor point 3 is defined as

[00016]${\stackrel{.fwdarw.}{\Delta }}_3=d_3.Math.{\stackrel{.fwdarw.}{\delta }}_3=\left[\begin{array}{c}{\Delta }_{3x}\\ {\Delta }_{3y}\\ {\Delta }_{3z}\end{array}\right]=\left[\begin{array}{c}{d}_3.Math.\cos {\phi }_3.Math.\sin {\theta }_3\\ d_3.Math.\sin {\phi }_3.Math.\sin {\theta }_3\\ d_3.Math.\cos {\theta }_3\end{array}\right].$

[0094] The distance D.sub.point between the two points therefore results in:

[00017]$\begin{array}{cc}{D}_{point}=\sqrt{{\left[x_0-\left(x_3+{\Delta }_{3x}\right)\right]}^2+{\left[y_0-\left(y_3+{\Delta }_{3y}\right)\right]}^2+{\left[z_0-\left(z_3+{\Delta }_{3z}\right)\right]}^2}& \left(14\right)\end{array}$

[0095] Distance Between a Point and a Line in the 3D Space

[0096] The distance between the point X.sub.0(x.sub.0,y.sub.0,z.sub.0) and the line defined by equation (4) is given by equation (15) below, using anchor point 4 of our example.

[0097] With A.sub.4(x.sub.4,y.sub.4,z.sub.4) being the position of the anchor point 4, and measured angles φ.sub.4, θ.sub.4, vector {right arrow over (δ)}.sub.4 and the vector {right arrow over (A.sub.4X.sub.0)} result to:

[00018]${\stackrel{.fwdarw.}{\delta }}_4=\left[\begin{array}{c}{\delta }_{4x}\\ {\delta }_{4y}\\ {\delta }_{4z}\end{array}\right]=\left[\begin{array}{c}\cos {\phi }_4.Math.\sin {\theta }_4\\ \sin {\phi }_4.Math.\sin {\theta }_4\\ \cos {\theta }_4\end{array}\right]\stackrel{.fwdarw.}{A_4{X}_0}=\left[\begin{array}{c}{x}_0-x_4\\ y_0-y_4\\ z_0-z_4\end{array}\right]$

[0098] The distance D.sub.line between the point and the line therefore results in:

[00019]$\begin{array}{cc}{D}_{\mathrm{line}}=\frac{.Math.\stackrel{.fwdarw.}{A_4{X}_0}\times {\stackrel{.fwdarw.}{\delta }}_4.Math.}{.Math.{\stackrel{.fwdarw.}{\delta }}_4.Math.}\stackrel{.Math.{\stackrel{.fwdarw.}{\delta }}_4.Math.=1}{⟹}{D}_{\mathrm{line}}=.Math.\stackrel{.fwdarw.}{A_4{X}_0}\times {\stackrel{.fwdarw.}{\delta }}_4.Math.& \left(15\right)\end{array}$

[0099] At the last step, to simplify the calculation of D.sub.line, we have exploited the fact that by definition∥{right arrow over (δ)}.sub.4∥=1. In some implementations, the distance values are determined as squared distances, e.g. squared geometrical distances, between the estimated position of the mobile device TG and the respective locus. The use of squared distances may reduce the computational effort of the determination since, for example, square root calculations can be avoided.

[0100] Referring now to step 105 in FIG. 1, the estimated position of the mobile device TG and the respective distances between that estimated position and the loci is used to determine whether a locus behaves as an outlier or not, i.e. whether the respective locus is reasonable with respect to estimated position. For example, referring to FIG. 9A and FIG. 9B, the respective loci for all five anchor points 1 to 5 are shown, in FIG. 9A in a 3D view and in FIG. 9B in a 2D view, resembling a top view of FIG. 9A. In particular, the two distance spheres of the anchor points 1 and 2 together with the resulting plane locus are shown, as well as the line loci of anchor points 4 and 5 and the point locus of anchor point 3.

[0101] If we look carefully at the room with the five anchor points 1 to 5, we will observe that with respect to the estimated position, called a draft estimation in FIGS. 9A and 9B, of the mobile device TG, the straight line locus, which is defined by anchor point 4, behaves as an outlier. Although anchor point 4 with the corresponding locus line has its own contribution on the determination of the estimated position, together with the other anchor points, it nevertheless can be seen that the LS solution of all the loci has a large distance from the locus of anchor point 4 and makes it suspicious for being an outlier.

[0102] Hence, referring back to step 105, the distances of the estimated LS position from all the four loci are used for producing the weights for each one of the rows of the weight matrix W that has been described above in conjunction with equation (11).

[0103] The weights are calculated per locus and not per row of the matrix equation (9).

[0104] This means that for our example, weight matrix W should have the following form for the present example:

[00020]$\begin{array}{cc}W=\left[\begin{array}{cccccccc}{w}_{12}& 0& 0& 0& 0& 0& 0& 0\\ 0& w_3& 0& 0& 0& 0& 0& 0\\ 0& 0& w_3& 0& 0& 0& 0& 0\\ 0& 0& 0& w_3& 0& 0& 0& 0\\ 0& 0& 0& 0& w_4& 0& 0& 0\\ 0& 0& 0& 0& 0& w_4& 0& 0\\ 0& 0& 0& 0& 0& 0& w_5& 0\\ 0& 0& 0& 0& 0& 0& 0& w_5\end{array}\right].Math.W=\mathrm{diag}\left(w_{12},w_3,w_3,w_3,w_4,w_4,w_5,w_5\right)& \left(16\right)\end{array}$

[0105] Derivation of Weights Based on the Distances

[0106] As already has been mentioned, the improved processing concept makes the weights dependent on the distance of the estimated position from each locus. The bigger the distance is, the less should be the reliability (and the weight) of the specific locus.

[0107] Let us assume that we treat a room with N anchors (N=5 in our example) of any type, which produce M different loci (M=4 in our example). For each locus L.sub.i, 1≤i≤M we calculate the distance D.sub.i according to the equations described above. We define a set of M functions f.sub.i: .sup.M.fwdarw. that maps the M respective values of D.sub.i to a set of M values of w.sub.I, such that

w.sub.i=f.sub.i(D.sub.1,D.sub.2, . . . ,D.sub.i, . . . D.sub.M),1≤i≤M  (17)

[0108] There are numerus candidate functions f.sub.i, some of which will be described in the following.

[0109] Furthermore, we can generalize the concept of the distance D.sub.i and use any monotonicaly increasing function of it, for example the squared D.sub.i as mentioned above. Let us denote as E.sub.i this generalized distance between the estimated position and each locus. For example, it could be:

E.sub.i=D.sub.i,E.sub.1=(D.sub.i).sup.2,E.sub.i=√{square root over (D.sub.i)}etc.

[0110] For example, the weight factor w.sub.i for each locus of the set of loci as a function of the determined distance values may be defined as

[00021]$\begin{array}{cc}{w}_i={\left[1-{\left(\frac{E_i}{E_{\mathrm{threshold}}+{.Math.}_{j=1}^M{E}_j}\right)}^{\mu }\right]}^v,& \left(18\right)\end{array}$

[0111] wherein [0112] i denotes the associated locus; [0113] M denotes the number of loci; [0114] E.sub.j denotes the distance value for the locus j, e.g. the locus associated with index j; [0115] E.sub.threshold denotes a distance threshold value; and [0116] μ, v are exponent values with ρ, v>0.

[0117] In an alternative, the weight factor w.sub.i for each locus of the set of loci as a function of the determined distance values may be defined as

[00022]$\begin{array}{cc}{w}_i={\left(\frac{E_{\mathrm{threshold}}+\min \left\{E_1,E_2,.Math.,E_i,.Math.,E_M\right\}}{E_{thr\mathrm{eshold}}+E_i}\right)}^v,& \left(19\right)\end{array}$

[0118] wherein [0119] i denotes the associated locus; [0120] M denotes the number of loci; [0121] E.sub.j denotes the distance value for the locus j, e.g. the locus associated with index j; [0122] E.sub.threshold denotes a distance threshold value; and [0123] v is an exponent value with v>0.

[0124] In a further alternative, the weight factor w.sub.i for each locus of the set of loci as a function of the determined distance values is defined as

[00023]$\begin{array}{cc}{w}_i=\{\begin{array}{c}{w}_{\mathrm{high}},E_i<E_{\mathrm{threshold}}\\ w_{\mathrm{low}},E_i\ge E_{\mathrm{threshold}}\end{array},& \left(20\right)\end{array}$

[0125] wherein [0126] i denotes the associated locus; [0127] E.sub.i denotes the distance value for the locus i; [0128] E.sub.threshold denotes a distance a threshold value; [0129] w.sub.high denotes a high weight factor; and [0130] w.sub.low denotes a low weight factor that is smaller than the high weight factor w.sub.high.

[0131] In an example W.sub.high may have a value close to 1 or equal to 1, whereas w.sub.low may have a value close to 0 or equal to 0.

[0132] The weights that are being generated from the above formulas are in the range 0≤w.sub.i≤1.

[0133] The value E.sub.threshold, where applicable, is a threshold defined from the designer and it expresses the distance limit below which the weight approaches the value “1”.

[0134] Also, exponents μ, v, are choice of the designer and they define the dependence of the weights on the distances and their ranges are, for example ¼≤μ≤1, 1≤v≤4.

[0135] After the weight factors have been determined in step 105, in step 106 a refined position is determined based on the set of position information and the determined weight factors, e.g. by the WLS approach defined in equation (11), using the weight factor of the form described in equation (16).

[0136] Optionally, the method may be performed in an iterative fashion. For example, after the refined position has been determined, in a next iteration step it is continued at step 104 by determining distance values from the loci to the refined position of the mobile device TG. For example, in an initial iteration step the estimated position is determined based on the set of position information, and in each subsequent iteration step the refined position determined in a respective preceding iteration step is used as the estimated position for determining the distance values and the weight factors. The number of iterations may be predetermined and/or the iteration stops when some exit criterion is fulfilled.

[0137] Referring now to FIGS. 10 to 13, several examples of cumulative distribution functions, CDF, of localization errors with respect to corresponding ground truth positions according to the improved processing concept are shown. In these FIGS. 10 to 13, the “draft” line refers to the estimated position of the mobile device, the 1.sup.st iteration refers to the refined position with the first application of the weight factors, and the 2.sup.nd iteration refers to the refined position with the second application of the weight factors.

[0138] For example, the CDF shown in FIG. 10 corresponds to weight factors being determined according to equation (18) with μ=½ and v=2. It can be seen that the probability for smaller localization errors can be severely improved with a single iteration and further improved with a second iteration, as described above. The CDF of FIG. 10 corresponds to a scenario where the mobile device TG is moving around the room, which for example is a typical office environment.

[0139] Simulating the same scenario but using the formula of equation (19) with v=2, we get the performance results shown in FIG. 11.

[0140] For both approaches,

E.sub.threshold=0.1

has been used. We can observe that the improvement of the confidence level of e.g. 90% is more than 0.5 m.

[0141] If we repeat the previous two measurements in the same office environment, but the mobile device follows the path that always one or two of the anchor points are in a non-line-of-sight condition or suffer a strong multipath, then the improvement is even more evident, as can be seen in FIGS. 12 and 13. In particular, FIG. 12 is based on equation (18) for the weight calculation and FIG. 13 is based on equation (19) for the weight calculation.

[0142] In addition to the weight factors as described above, in some implementations the refined position of the mobile device TG may be determined further based on quality information for at least one of the plurality of anchor points. For example, this quality information can be expressed in one or more further weight matrices that are applied to the WLS algorithm.

[0143] For example, the quality information for the at least one anchor point is determined from at least one of the following: [0144] a signal strength, e.g. RSSI, associated with the received relative position of the at least one anchor point; [0145] a number of antenna elements of the at least one anchor point; a higher number increases accuracy; [0146] a confidence factor associated with the received relative position of the at least one anchor point; [0147] upper and/or lower bounds for the weight factor associated with the at least one anchor point.

[0148] Various embodiments of the improved processing concept can be implemented in the form of logic in software or hardware or a combination of both. The logic may be stored in a computer readable or machine-readable storage medium as a set of instructions adapted to direct a processor of a computer system to perform a set of steps disclosed in embodiments of the improved processing concept. The logic may form part of a computer program product adapted to direct an information-processing device to automatically perform a set of steps disclosed in embodiments of the improved processing concept.

[0149] The specification and drawings are, accordingly, to be regarded in an illustrative rather than a restrictive sense. However, it will be evident that various modifications and changes may be made thereunto without departing from the scope of the invention as set forth in the claims.

LIST OF REFERENCE SIGNS

[0150] 100 method for determining a position of a mobile device [0151] 101-106 steps [0152] 1-5 anchor points [0153] TG mobile device [0154] RX receiver [0155] PROC processing unit [0156] LPE positioning engine