# Patent

## Title
Real-time system and method for improving the accuracy of the computed location of mobile subscribers in a wireless ad-hoc network using a low speed central processing unit

## Abstract

A system and method for improving the accuracy in computing the location of a mobile subscriber device connected in a wireless network. The system and method employ a predictive filter, including a measurement weight algorithm to decrease standard deviation error, to correctly determine a location of a mobile subscriber device. The predictive filter requires lower levels of computation, which allows for real-time processing on low-speed central processing units commonly used in wireless networks.

## Background
The present invention claims benefit under 35 U.S.C. § 119(e) from U.S. Provisional Patent Application Ser. No. 60/453,965 of John M. Belcea, filed on Mar. 13, 2003, the entire content of which is incorporated herein by reference.


BACKGROUND OF THE INVENTION
1. Field of the Invention
The present invention relates to a system and method for accurately computing the location of a mobile subscriber device connected in a wireless network. More particularly, the present invention relates to the use of a predictive filter, including a measurement weight algorithm to decrease standard deviation error, to more correctly determine the location of a mobile subscriber.
2. Description of the Related Art
Wireless communications networks, such as mobile wireless telephone networks, have become increasingly prevalent over the past decade. These wireless communications networks are commonly referred to as “cellular networks”, because the network infrastructure is arranged to divide the service area into a plurality of regions called “cells”. A terrestrial cellular network includes a plurality of interconnected base stations, or base nodes, that are distributed geographically at designated locations throughout the service area. Each base node includes one or more transceivers that are capable of transmitting and receiving electromagnetic signals, such as radio frequency (RF) communications signals, to and from mobile user nodes, such as wireless telephones, located within the coverage area. The communications signals include, for example, voice data that has been modulated according to a desired modulation technique and transmitted as data packets. As can be appreciated by one skilled in the art, network nodes transmit and receive data packet communications in a multiplexed format, such as time-division multiple access (TDMA) format, code-division multiple access (CDMA) format, or frequency-division multiple access (FDMA) format, which enables a single transceiver at the base node to communicate simultaneously with several mobile nodes in its coverage area.
In recent years, a type of mobile communications network known as an “ad-hoc” network has been developed to address the needs of multiple mobile device communication beyond traditional infrastructure coverage. In this type of network, each user terminal (hereinafter “mobile node”) is capable of operating as a base station or router for other mobile nodes within the network, thus eliminating the need for a fixed infrastructure of base stations. Accordingly, data packets being sent from a source mobile node to a destination mobile node are typically routed through a number of intermediate mobile nodes before reaching the destination node.
More sophisticated ad-hoc networks are also being developed which, in addition to enabling mobile nodes to communicate with each other as in conventional ad-hoc networks, further enable the mobile nodes to access fixed networks and communicate with other types of user terminals, such as those on the public switched telephone network (PSTN) and the Internet. Details of these advanced types of ad-hoc networks are described in U.S. patent application Ser. No. 09/897,790 entitled “Ad Hoc Peer-to-Peer Mobile Radio Access System Interfaced to the PSTN and Cellular Networks”, filed on Jun. 29, 2001, in U.S. patent application Ser. No. 09/815,157 entitled “Time Division Protocol for an Ad-Hoc, Peer-to-Peer Radio Network Having Coordinating Channel Access to Shared Parallel Data Channels with Separate Reservation Channel”, filed on Mar. 22, 2001, in U.S. patent application Ser. No. 09/815,164 entitled “Prioritized-Routing for an Ad-Hoc, Peer-to-Peer, Mobile Radio Access System”, filed on Mar. 22, 2001, in U.S. patent application Ser. No. 09/988,001 entitled “A System and Method for Computing the Location of a Mobile Terminal in a Wireless Communications Network”, filed on Nov. 16, 2001, and in U.S. Pat. Nos. 6,453,168 and 6,665,333, the entire content of each being incorporated herein by reference.
The mobile nodes of such networks may assume any number of random positions within the network, making exact node location determinations when needed difficult. For computing node geographical coordinates in such ad-hoc wireless networks, algorithms in use at individual nodes in typical networks use the “Time Of Arrival” (TOA) measurement technique. As can be appreciated by one skilled in the art, a TOA measurement provides the distance between mobile nodes and wireless routers, which are used as references, for computing the mobile node position. The measurements are based upon signal propagation times, specifically the time a signal needs for traveling at the speed of light between a mobile node and fixed stations.
Due to various propagation factors, the modem that makes the TOA measurement does not receive direct signals all the time, but may also receive a number of secondary signals. Such modems, through the use of antennas and associated signal processing, serve to transmit and receive various data packets with the assistance of specific supporting elements in the physical layer, such as modulation, coding, and framing, and also the MAC and radio resource management layers. Each includes an apparatus to estimate position and velocity using either the Time Of Arrival (TOA) of signals received by the modem, their Phase Of Arrival (POA), their Strength Of Arrival (SOA), their Frequency Of Arrival (FOA), or a combination of such techniques.
Since secondary signals are reflections of the direct signal, each secondary signal travels a longer distance and therefore has a longer transmission path. In most cases, the measurement modem can identify and separate direct signals from secondary signals, and provide a correct propagation time. However, in some cases the direct signal may be too weak when compared with reflected signals to accomplish this. In such cases, the modem is not able to determine the correct propagation time.
The precision of range measurement in indoor areas, or in areas with very tall buildings, is often very poor due to propagation conditions specific for these types of environments. As a result, typical methods for computing the location of a mobile terminal based on propagation ranges measured in “urban canyons” or inside buildings produce very inaccurate results.
Several systems and methods can be used to improve the precision of the computation of mobile terminal position calculations within environments, such as a city, and inside buildings. For example, these systems and methods can consider information obtained from a large number of references (routers) on which to base the computation. These systems and methods can also increase their sampling frequency, and/or implement predictive filters to attempt to improve location accuracy.
In order to reach the required level of precision, these systems and methods need to sacrifice other services. For example, systems and methods that use more than four reference points (e.g., terminals) or frequent sampling to perform these types of “location services” operations require additional bandwidth and processing time. Since bandwidth is limited, implementing this technique will result in a decrease in the bandwidth available for other services provided by the wireless network. The situation can be somewhat improved by considering a more efficient protocol for performing the time-of-flight (TOF) query on the signals transmitted to and from the reference points. However, tests show that increasing the number of reference points to more than eight does not provide substantial improvement of accuracy. Increasing the sampling frequency for range measurement also requires more bandwidth that is thus made unavailable for other services.
As an alternative to increasing the number of reference points or sampling frequency, it is possible to implement a predictive filter to improve the accuracy of location services operations performed inside buildings. Accordingly, a need exists for a system and method to implement a predictive filter to improve the precision of mobile terminal position calculations within certain environments, such as in a city and inside a building.
SUMMARY OF THE INVENTION
An object of the present invention is to provide a system and method for improving the accuracy of computing the location of a mobile subscriber device connected in a wireless network employed in certain environments, such as in a city or inside a building.
Another object of the present invention is to provide a system and method for providing a predictive filter that can be implemented as a linear model of subscriber device movement and can include a weight algorithm to reduce effects of non-current position data, to thus increase the accuracy in computing the location of a subscriber device.
Another object of the present invention is to provide a system and method for providing a predictive filter that includes an algorithm to decrease standard deviation error, to thus increase the accuracy in computing the location of a subscriber device.
Another object of the present invention is to provide a system and method for providing a predictive filter that requires lower level computation which allows for real-time processing on low-speed central processing units (CPUs) commonly employed in devices operating in wireless networks.
Another object of the present invention is to provide a system and method for using a predictive filter that can be implemented in hardware or software on a CPU of a mobile terminal, on a host CPU, or on a remote server.
These and other objects are substantially achieved by providing a system and method for using a predictive filter to correctly determine the position of a subscriber device where typical propagation range measurement techniques are subject to errors. The predictive filter is implemented as a liner model of subscriber device movement and determines subscriber device position using computed subscriber device movement characteristics. The filter includes a weight factor algorithm to reduce effects of erroneous data and a “forget” factor which reduces the weight of older data in position calculations, thus allowing for real-time processing on low speed central processing units.
Specifically, the above and other objects are substantially achieved by a system and method for determining a location of a mobile communication device in a communication network, in particular, a wireless ad-hoc peer-to-peer communication network. The system and method perform the operations of estimating a location of the mobile communication device based on measured data representing respective distances between the mobile communication device and a plurality of reference points, and modifying the estimated location, using a predictive filter including a forget factor which treats older measured data less significantly than newer measured data in estimating the location, to generate a modified estimated location representative of the location of the mobile communication device. The forget factor can have a value between 0 and 1. The modifying operation predicts movement of the mobile communication device on three axes of coordinates and uses the predictive filter to adjust the predicted movement to ascertain the modified estimated location.
More particularly, the modifying operation predicts the movement using equations including variables representing the starting position of the mobile communication device and variables representing the moving speed of the mobile communication device, as modified by the predictive filter. The equations include three systems of equations, each system pertaining to a respective axis of movement and employing the forget factor to adjust the estimated starting position coordinate for that respective axis and speed of movement along that respective axis.



BRIEF DESCRIPTION OF THE DRAWINGS
These and other objects, advantages and novel features of the invention will be more readily appreciated from the following detailed description when read in conjunction with the accompanying drawings, in which:
FIG. 1 is a block diagram of an example of an ad-hoc wireless communications network including a plurality of nodes employing an embodiment of the present invention;
FIG. 2 is a block diagram of an example of a wireless node, or subscriber device, as shown in FIG. 1;
FIG. 3 is a plot illustrating an example of reported positions of a subscriber device in an ad-hoc wireless communications network as shown in FIG. 1;
FIG. 4 is a plot illustrating an example of values shown in FIG. 3 which have been filtered by a predictive filter according to an embodiment of the present invention; and
FIG. 5 is a plot illustrating an example of the time variation of the filter precision in accordance with an embodiment of the present invention.



DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
The system and method described below implements a predictive filter to improve the quality of location services operations performed in an ad-hoc network. In particular, the system and method employing the filter operates to compute locations of a mobile subscriber device connected in a wireless network, and is adapted to improve performance even under adverse conditions typically present during network operations inside and around obstructions, such as buildings. The filter can be implemented on a central processing unit (CPU) of a mobile subscriber device. The filter can also be employed on a host CPU, or on a remote server, which typically have more available CPU time.
As discussed above, when the propagation of radio waves is subject to interference due to, for example, the presence of obstructions such as wall or buildings, the correct value of the distance between a mobile subscriber device and fixed references cannot be correctly evaluated. In such conditions, the relative location of the mobile subscriber device with respect to fixed references is computed with very large errors. The system and method according to the embodiments of the invention described below improves the quality of location services operations to substantially increase the precision of the computed location of a mobile subscriber device.
FIG. 1 is a block diagram illustrating an example of an ad-hoc packet-switched wireless communications network 100 employing an embodiment of the present invention. Specifically, the network 100 includes a plurality of mobile wireless user terminals 102-1 through 102-n (referred to generally as nodes 102, mobile nodes 102 or subscriber devices), and can, but is not required to, include a fixed network 104 having a plurality of access points 106-1, 106-2, . . . 106-n (referred to generally as nodes 106 or access points 106), for providing subscriber devices 102 with access to the fixed network 104. The fixed network 104 can include, for example, a core local access network (LAN), and a plurality of servers and gateway routers, to provide network nodes with access to other networks, such as other ad-hoc networks, the public switched telephone network (PSTN) and the Internet. The network 100 further can include a plurality of fixed routers 107-1 through 107-n (referred to generally as nodes 107, fixed routers 107, or wireless routers 107) for routing data packets between other nodes 102, 106 or 107. Because they are not mobile, routers 107 are preferred for use as reference nodes for mobile node position measurements. It is noted that for purposes of this discussion, the nodes discussed above can be collectively referred to as “nodes 102, 106 and 107”, or simply “nodes”.
As can be appreciated by one skilled in the art, the nodes 102, 106 and 107 are capable of communicating with each other directly, or via one or more other nodes 102, 106 or 107 operating as a router or routers for packets being sent between nodes, as described in U.S. Pat. No. 5,943,322 to Mayor, which is incorporated herein by reference, and in U.S. patent application Ser. Nos. 09/897,790, 09/815,157 and 09/815,164 which are referenced above.
As shown in FIG. 2, each node 102, 106 and 107 has a transceiver including a transmitter and a receiver, which collectively can be referred to as a modem 108. As shown in FIG. 2, each node 102, 106 and 107 includes a modem 108 which is coupled to an antenna 110 and is capable of receiving and transmitting signals, such as packetized signals, to and from other nodes 102, 106 and 107, under the control of a controller 112. The packetized data signals can include, for example, voice, data or multimedia information, and packetized control signals, including node update information.
Each node 102, 106 and 107 further includes a memory 114, such as a random access memory (RAM), that is capable of storing, among other things, routing information pertaining to itself and other nodes in the network 100. The nodes 102, 106 and 107 exchange their respective routing information, referred to as routing advertisements or routing table information, with each other via a broadcasting mechanism periodically, for example, when a new node enters the network 100, or when existing nodes in the network 100 move.
As further shown in FIG. 2, certain nodes, especially mobile nodes 102, can include a host 116 which may consist of any number of devices, such as a notebook computer terminal, mobile telephone unit, mobile data unit, or any other suitable device. Each node 102, 106 and 107 also includes the appropriate hardware and software to perform Internet Protocol (IP) and Address Resolution Protocol (ARP), the purposes of which can be readily appreciated by one skilled in the art. The appropriate hardware and software to perform transmission control protocol (TCP) and user datagram protocol (UDP) may also be included.
The modem 108 of each node also includes the capability to identify, differentiate and measure the arrival time of signals received at a node 102, 106 and 107, both via direct paths and reflected paths, from other nodes of the network. Algorithms in use at each node can use a “Time Of Arrival” (TOA) measurement technique as known to those skilled in the art, and may provide the distance between nodes for computing individual node positions. The measurements are based upon signal propagation times, specifically, the time a signal needs for traveling at the speed of light between a mobile node and fixed node, used as a reference.
As can be appreciated by those skilled in the art, the measurement of direct path signal arrival times is useful for identifying and measuring distances between nodes, such as between a subscriber device 102 and a wireless router 107. The precision of this distance measurement has a direct impact on the accuracy of the geographical position determination of the mobile node as computed by a device, such as a “location service” module.
As shown in FIGS. 1 and 2, each node 102, 106 and 107 has the capability to distinguish and identify signals received via a direct path from signals received via a reflected path. However, such identification of direct path signals is very difficult or almost impossible when adverse conditions prevent one node from communicating with another node in a direct path. For example, the communication between two nodes located in a building with concrete floors is often subject to signal reflection, as well as diffraction and diffusion via objects located inside and outside the building. In these environments, the signals received via reflected paths could be much stronger than the signals received via the direct path, since the direct signal may be attenuated by passing through concrete floors or objects which absorb the signal. Unfortunately, such large level differences between the direct and secondary or reflected signals make the identification of the direct signal almost impossible in some cases. Furthermore, when a mobile node enters a temporary “shadow” of an obstruction, it can communicate with other nodes only through reflected signals. Although such communication does not dramatically affect the quality of data transferred in the network, the measurement of direct signal arrival time for use in distance measurements becomes impossible. Although historical data may be used to provide a distance estimate, the estimated accuracy will rely heavily upon the accuracy of the historical data maintained at the node, which may or may not be reliable.
As noted above, when the propagation of radio waves is subjected to interference, the correct value of the distance between a mobile subscriber device and fixed references cannot be correctly evaluated. In such conditions, the relative location of the mobile subscriber device with respect to fixed references is computed with very large errors. However, as will now be described, the use of a predictive filter according to an embodiment of the present invention greatly improves the quality of location services operations, thus substantially increasing the precision of the computed position of a subscriber device.
A predictive filter can be implemented in hardware or software on a mobile node, or subscriber device central processing unit (CPU), to assist in the computation of locations of a subscriber device connected in a wireless network. In the examples presented below, the subscriber device can move inside buildings or in densely populated areas at very slow speeds. To correctly find the position of the subscriber device inside a building, a model of the subscriber device movement is considered.
One example of the filter in accordance with an embodiment of the present invention employs a linear model, or algorithm, of the movement of the subscriber device as shown in equation set (1), where the projections of the movement on the three axes of coordinates are independent. In equation set (1), all values except the time t, are unknown. The estimate of the real position (x′, y′, z′) of the subscriber device is computed from a starting at point (x0, y0, z0) and assumes that the mobile moves at constant speed (Vx, Vy, Vz).

x′=x0+Vx*t

y′=y0+Vy*t

z′=z0+Vz*t  (1)

The location services operations use current range estimate to provide positions (x, y, z) that are affected by errors as shown below in equation set (2).

x=x′+εx

y=y′+εy

z=z′+εz  (2)

Equation set (2) shows the relationship between the computed position of the mobile terminal (x, y, z) and the real position (x′, y′, z′). In the example, if the errors (εx, εy, εz) are randomly distributed, three systems of equations can be written as shown below in equation set (3).




  
    
      
        {
        
          
            
              
                
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      n
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      x
                      i
                    
                  
                  =
                  
                    
                      
                        x
                        0
                      
                      ⁢
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        1
                      
                    
                    +
                    
                      
                        V
                        x
                      
                      *
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          t
                          i
                        
                      
                    
                  
                
              
            
            
              
                
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      n
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        t
                        i
                      
                      ⁢
                      
                        x
                        i
                      
                    
                  
                  =
                  
                    
                      
                        x
                        0
                      
                      ⁢
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          t
                          i
                        
                      
                    
                    +
                    
                      
                        V
                        x
                      
                      *
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          t
                          i
                          2
                        
                      
                    
                  
                
              
            
          
          ⁢
          
            

          
          ⁢
          
            {
            
              
                
                  
                    
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          y
                          i
                        
                      
                      =
                      
                        
                          
                            y
                            0
                          
                          ⁢
                          
                            
                              ∑
                              
                                i
                                =
                                1
                              
                              n
                            
                            ⁢
                            
                              
                            
                            ⁢
                            1
                          
                        
                        +
                        
                          
                            V
                            y
                          
                          *
                          
                            
                              ∑
                              
                                i
                                =
                                1
                              
                              n
                            
                            ⁢
                            
                              
                            
                            ⁢
                            
                              t
                              i
                            
                          
                        
                      
                    
                  
                
                
                  
                    
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          
                            t
                            i
                          
                          ⁢
                          
                            y
                            i
                          
                        
                      
                      =
                      
                        
                          
                            y
                            0
                          
                          ⁢
                          
                            
                              ∑
                              
                                i
                                =
                                1
                              
                              n
                            
                            ⁢
                            
                              
                            
                            ⁢
                            
                              t
                              i
                            
                          
                        
                        +
                        
                          
                            V
                            y
                          
                          *
                          
                            
                              ∑
                              
                                i
                                =
                                1
                              
                              n
                            
                            ⁢
                            
                              
                            
                            ⁢
                            
                              t
                              i
                              2
                            
                          
                        
                      
                    
                  
                
              
              ⁢
              
                

              
              ⁢
              
                {
                
                  
                    
                      
                        
                          
                            ∑
                            
                              i
                              =
                              1
                            
                            n
                          
                          ⁢
                          
                            
                          
                          ⁢
                          
                            z
                            i
                          
                        
                        =
                        
                          
                            
                              z
                              0
                            
                            ⁢
                            
                              
                                ∑
                                
                                  i
                                  =
                                  1
                                
                                n
                              
                              ⁢
                              
                                
                              
                              ⁢
                              1
                            
                          
                          +
                          
                            
                              V
                              z
                            
                            *
                            
                              
                                ∑
                                
                                  i
                                  =
                                  1
                                
                                n
                              
                              ⁢
                              
                                
                              
                              ⁢
                              
                                t
                                i
                              
                            
                          
                        
                      
                    
                  
                  
                    
                      
                        
                          
                            ∑
                            
                              i
                              =
                              1
                            
                            n
                          
                          ⁢
                          
                            
                          
                          ⁢
                          
                            
                              t
                              i
                            
                            ⁢
                            
                              z
                              i
                            
                          
                        
                        =
                        
                          
                            
                              z
                              0
                            
                            ⁢
                            
                              
                                ∑
                                
                                  i
                                  =
                                  1
                                
                                n
                              
                              ⁢
                              
                                
                              
                              ⁢
                              
                                t
                                i
                              
                            
                          
                          +
                          
                            
                              V
                              z
                            
                            *
                            
                              
                                ∑
                                
                                  i
                                  =
                                  1
                                
                                n
                              
                              ⁢
                              
                                
                              
                              ⁢
                              
                                t
                                i
                                2
                              
                            
                          
                        
                      
                    
                  
                
              
            
          
        
      
    
    
      
        (
        3
        )
      
    
  




Since all equations of equation set (3) are affected by random errors, the system of equation set (3) can be solved with a Least Squares Method (LSM), and thereafter compute the starting point (x0, y0, z0) and the moving speed (Vx, Vy, Vz) of the mobile terminal. The matrices associated with these systems of equations are computed using (xi, yi, zi) provided by the location service operations at time t1, t2, . . . tn,.
If the subscriber device in this example moves uniformly in one direction, the system of equation set (3) provides a perfect description of the movement. In reality, the subscriber device typically must change direction, speed, or both. In such cases, past data that has been collected is no longer current, and can decrease the accuracy of results.
To address this concern, the factor Φn−i can be used as a weight of each measurement, where 0<Φ<1. Because the value of Φn−i is very small for large n−i, the factor can be used to weight each measurement, so the filter algorithm “forgets” very old measurements. For this reason, Φ is called the “forget” factor. The effect of using the forget factor is similar, but not identical, with using a sliding window of size 1/(1−Φ).
The system of equations presented in equation set (3) can be rewritten using the forget factor as shown below in equation set (4).




  
    
      
        {
        
          
            
              
                
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      n
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        φ
                        
                          n
                          -
                          i
                        
                      
                      ⁢
                      
                        x
                        i
                      
                    
                  
                  =
                  
                    
                      
                        x
                        0
                      
                      ⁢
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          φ
                          
                            n
                            -
                            i
                          
                        
                      
                    
                    +
                    
                      
                        V
                        x
                      
                      *
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          
                            φ
                            
                              n
                              -
                              i
                            
                          
                          ⁢
                          
                            t
                            i
                          
                        
                      
                    
                  
                
              
            
            
              
                
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      n
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        φ
                        
                          n
                          -
                          i
                        
                      
                      ⁢
                      
                        t
                        i
                      
                      ⁢
                      
                        x
                        i
                      
                    
                  
                  =
                  
                    
                      
                        x
                        0
                      
                      ⁢
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          
                            φ
                            
                              n
                              -
                              i
                            
                          
                          ⁢
                          
                            t
                            i
                          
                        
                      
                    
                    +
                    
                      
                        V
                        x
                      
                      *
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          
                            φ
                            
                              n
                              -
                              i
                            
                          
                          ⁢
                          
                            t
                            i
                            2
                          
                        
                      
                    
                  
                
              
            
          
          ⁢
          
            

          
          ⁢
          
            {
            
              
                
                  
                    
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          
                            φ
                            
                              n
                              -
                              i
                            
                          
                          ⁢
                          
                            y
                            i
                          
                        
                      
                      =
                      
                        
                          
                            y
                            0
                          
                          ⁢
                          
                            
                              ∑
                              
                                i
                                =
                                1
                              
                              n
                            
                            ⁢
                            
                              
                            
                            ⁢
                            
                              φ
                              
                                n
                                -
                                i
                              
                            
                          
                        
                        +
                        
                          
                            V
                            y
                          
                          *
                          
                            
                              ∑
                              
                                i
                                =
                                1
                              
                              n
                            
                            ⁢
                            
                              
                            
                            ⁢
                            
                              
                                φ
                                
                                  n
                                  -
                                  i
                                
                              
                              ⁢
                              
                                t
                                i
                              
                            
                          
                        
                      
                    
                  
                
                
                  
                    
                      
                        
                          ∑
                          
                            i
                            =
                            1
                          
                          n
                        
                        ⁢
                        
                          
                        
                        ⁢
                        
                          
                            φ
                            
                              n
                              -
                              i
                            
                          
                          ⁢
                          
                            t
                            i
                          
                          ⁢
                          
                            y
                            i
                          
                        
                      
                      =
                      
                        
                          
                            y
                            0
                          
                          ⁢
                          
                            
                              ∑
                              
                                i
                                =
                                1
                              
                              n
                            
                            ⁢
                            
                              
                            
                            ⁢
                            
                              
                                φ
                                
                                  n
                                  -
                                  i
                                
                              
                              ⁢
                              
                                t
                                i
                              
                            
                          
                        
                        +
                        
                          
                            V
                            y
                          
                          *
                          
                            
                              ∑
                              
                                i
                                =
                                1
                              
                              n
                            
                            ⁢
                            
                              
                            
                            ⁢
                            
                              
                                φ
                                
                                  n
                                  -
                                  i
                                
                              
                              ⁢
                              
                                t
                                i
                                2
                              
                            
                          
                        
                      
                    
                  
                
              
              ⁢
              
                

              
              ⁢
              
                {
                
                  
                    
                      
                        
                          
                            ∑
                            
                              i
                              =
                              1
                            
                            n
                          
                          ⁢
                          
                            
                          
                          ⁢
                          
                            
                              φ
                              
                                n
                                -
                                i
                              
                            
                            ⁢
                            
                              z
                              i
                            
                          
                        
                        =
                        
                          
                            
                              z
                              0
                            
                            ⁢
                            
                              
                                ∑
                                
                                  i
                                  =
                                  1
                                
                                n
                              
                              ⁢
                              
                                
                              
                              ⁢
                              
                                φ
                                
                                  n
                                  -
                                  i
                                
                              
                            
                          
                          +
                          
                            
                              V
                              z
                            
                            *
                            
                              
                                ∑
                                
                                  i
                                  =
                                  1
                                
                                n
                              
                              ⁢
                              
                                
                              
                              ⁢
                              
                                
                                  φ
                                  
                                    n
                                    -
                                    i
                                  
                                
                                ⁢
                                
                                  t
                                  i
                                
                              
                            
                          
                        
                      
                    
                  
                  
                    
                      
                        
                          
                            ∑
                            
                              i
                              =
                              1
                            
                            n
                          
                          ⁢
                          
                            
                          
                          ⁢
                          
                            
                              φ
                              
                                n
                                -
                                i
                              
                            
                            ⁢
                            
                              t
                              i
                            
                            ⁢
                            
                              z
                              i
                            
                          
                        
                        =
                        
                          
                            
                              z
                              0
                            
                            ⁢
                            
                              
                                ∑
                                
                                  i
                                  =
                                  1
                                
                                n
                              
                              ⁢
                              
                                
                              
                              ⁢
                              
                                
                                  φ
                                  
                                    n
                                    -
                                    i
                                  
                                
                                ⁢
                                
                                  t
                                  i
                                
                              
                            
                          
                          +
                          
                            
                              V
                              z
                            
                            *
                            
                              
                                ∑
                                
                                  i
                                  =
                                  1
                                
                                n
                              
                              ⁢
                              
                                
                              
                              ⁢
                              
                                
                                  φ
                                  
                                    n
                                    -
                                    i
                                  
                                
                                ⁢
                                
                                  t
                                  i
                                  2
                                
                              
                            
                          
                        
                      
                    
                  
                
              
            
          
        
      
    
    
      
        (
        4
        )
      
    
  




All three systems of equations have exactly the same main matrix. In this example, the shorthand notations a1,1(n), a1,2(n), a2,1(n), a2,2(n) can be used for the elements of the main matrix. The upper index (n) shows the step of the process when the element is computed. Similarly, for these three systems of equations, the right terms are bx1(n), bx2(n), by1(n), by2(n), bz1(n) and bz2(n), and can now be written as equation set (5).




  
    
      
        
          
            a
            
              1
              ,
              1
            
            
              (
              n
              )
            
          
          =
          
            
              
                ∑
                
                  i
                  =
                  1
                
                n
              
              ⁢
              
                
              
              ⁢
              
                φ
                
                  n
                  -
                  i
                
              
            
            =
            
              
                1
                +
                
                  φ
                  ⁢
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      
                        n
                        -
                        1
                      
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      φ
                      
                        n
                        -
                        i
                      
                    
                  
                
              
              =
              
                1
                +
                
                  φ
                  ⁢
                  
                    
                  
                  ⁢
                  
                    a
                    
                      1
                      ,
                      1
                    
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            a
            
              1
              ,
              1
            
            
              (
              n
              )
            
          
          =
          
            
          
          ⁢
          
            
              a
              
                2
                ,
                1
              
              
                (
                n
                )
              
            
            =
            
              
                
                  ∑
                  
                    i
                    =
                    1
                  
                  n
                
                ⁢
                
                  
                
                ⁢
                
                  
                    φ
                    
                      n
                      -
                      i
                    
                  
                  ⁢
                  
                    t
                    i
                  
                
              
              =
              
                
                  
                    t
                    n
                  
                  +
                  
                    φ
                    ⁢
                    
                      
                        ∑
                        
                          i
                          =
                          1
                        
                        
                          n
                          -
                          1
                        
                      
                      ⁢
                      
                        
                      
                      ⁢
                      
                        
                          φ
                          
                            n
                            -
                            i
                          
                        
                        ⁢
                        
                          t
                          i
                        
                      
                    
                  
                
                =
                
                  
                    t
                    n
                  
                  +
                  
                    φ
                    ⁢
                    
                      
                    
                    ⁢
                    
                      a
                      
                        1
                        ,
                        2
                      
                      
                        (
                        
                          n
                          -
                          1
                        
                        )
                      
                    
                  
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            a
            
              2
              ,
              2
            
            
              (
              n
              )
            
          
          =
          
            
              
                ∑
                
                  i
                  =
                  1
                
                n
              
              ⁢
              
                
              
              ⁢
              
                
                  φ
                  
                    n
                    -
                    i
                  
                
                ⁢
                
                  t
                  i
                  2
                
              
            
            =
            
              
                
                  t
                  n
                  2
                
                +
                
                  φ
                  ⁢
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      
                        n
                        -
                        1
                      
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        φ
                        
                          n
                          -
                          i
                        
                      
                      ⁢
                      
                        t
                        i
                        2
                      
                    
                  
                
              
              =
              
                
                  t
                  n
                  2
                
                +
                
                  φ
                  ⁢
                  
                    
                  
                  ⁢
                  
                    a
                    
                      2
                      ,
                      2
                    
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            bx
            1
            
              (
              n
              )
            
          
          =
          
            
              
                ∑
                
                  i
                  =
                  1
                
                n
              
              ⁢
              
                
              
              ⁢
              
                
                  φ
                  
                    n
                    -
                    i
                  
                
                ⁢
                
                  x
                  i
                  ′
                
              
            
            =
            
              
                
                  x
                  n
                  ′
                
                +
                
                  φ
                  ⁢
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      
                        n
                        -
                        1
                      
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        φ
                        
                          n
                          -
                          1
                          -
                          i
                        
                      
                      ⁢
                      
                        x
                        i
                        ′
                      
                    
                  
                
              
              =
              
                
                  x
                  n
                  ′
                
                +
                
                  φ
                  ⁢
                  
                    
                  
                  ⁢
                  
                    bx
                    1
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            bx
            2
            
              (
              n
              )
            
          
          =
          
            
              
                ∑
                
                  i
                  =
                  1
                
                n
              
              ⁢
              
                
              
              ⁢
              
                
                  φ
                  
                    n
                    -
                    i
                  
                
                ⁢
                
                  t
                  i
                
                ⁢
                
                  x
                  i
                  ′
                
              
            
            =
            
              
                
                  
                    t
                    i
                  
                  ⁢
                  
                    x
                    n
                    ′
                  
                
                +
                
                  φ
                  ⁢
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      n
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        φ
                        
                          n
                          -
                          i
                        
                      
                      ⁢
                      
                        t
                        i
                      
                      ⁢
                      
                        x
                        i
                        ′
                      
                    
                  
                
              
              =
              
                
                  
                    t
                    n
                  
                  ⁢
                  
                    x
                    n
                    ′
                  
                
                +
                
                  φ
                  ⁢
                  
                    
                  
                  ⁢
                  
                    bx
                    2
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            by
            1
            
              (
              n
              )
            
          
          =
          
            
              
                ∑
                
                  i
                  =
                  1
                
                n
              
              ⁢
              
                
              
              ⁢
              
                
                  φ
                  
                    n
                    -
                    i
                  
                
                ⁢
                
                  y
                  i
                  ′
                
              
            
            =
            
              
                
                  y
                  n
                  ′
                
                +
                
                  φ
                  ⁢
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      
                        n
                        -
                        1
                      
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        φ
                        
                          n
                          -
                          1
                          -
                          i
                        
                      
                      ⁢
                      
                        y
                        i
                        ′
                      
                    
                  
                
              
              =
              
                
                  y
                  n
                  ′
                
                +
                
                  φ
                  ⁢
                  
                    
                  
                  ⁢
                  
                    by
                    1
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            by
            2
            
              (
              n
              )
            
          
          =
          
            
              
                ∑
                
                  i
                  =
                  1
                
                n
              
              ⁢
              
                
              
              ⁢
              
                
                  φ
                  
                    n
                    -
                    i
                  
                
                ⁢
                
                  t
                  i
                
                ⁢
                
                  y
                  i
                  ′
                
              
            
            =
            
              
                
                  
                    t
                    i
                  
                  ⁢
                  
                    y
                    i
                    ′
                  
                
                +
                
                  φ
                  ⁢
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      n
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        φ
                        
                          n
                          -
                          i
                        
                      
                      ⁢
                      
                        t
                        i
                      
                      ⁢
                      
                        y
                        i
                        ′
                      
                    
                  
                
              
              =
              
                
                  
                    t
                    n
                  
                  ⁢
                  
                    y
                    n
                    ′
                  
                
                +
                
                  φ
                  ⁢
                  
                    
                  
                  ⁢
                  
                    by
                    2
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            bz
            1
            
              (
              n
              )
            
          
          =
          
            
              
                ∑
                
                  i
                  =
                  1
                
                n
              
              ⁢
              
                
              
              ⁢
              
                
                  φ
                  
                    n
                    -
                    i
                  
                
                ⁢
                
                  z
                  i
                  ′
                
              
            
            =
            
              
                
                  z
                  n
                  ′
                
                +
                
                  φ
                  ⁢
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      
                        n
                        -
                        1
                      
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        φ
                        
                          n
                          -
                          1
                          -
                          i
                        
                      
                      ⁢
                      
                        z
                        i
                        ′
                      
                    
                  
                
              
              =
              
                
                  z
                  n
                  ′
                
                +
                
                  φ
                  ⁢
                  
                    
                  
                  ⁢
                  
                    bz
                    1
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            bz
            2
            
              (
              n
              )
            
          
          =
          
            
              
                ∑
                
                  i
                  =
                  1
                
                n
              
              ⁢
              
                
              
              ⁢
              
                
                  φ
                  
                    n
                    -
                    i
                  
                
                ⁢
                
                  t
                  i
                
                ⁢
                
                  z
                  i
                  ′
                
              
            
            =
            
              
                
                  
                    t
                    i
                  
                  ⁢
                  
                    z
                    i
                    ′
                  
                
                +
                
                  φ
                  ⁢
                  
                    
                      ∑
                      
                        i
                        =
                        1
                      
                      n
                    
                    ⁢
                    
                      
                    
                    ⁢
                    
                      
                        φ
                        
                          n
                          -
                          i
                        
                      
                      ⁢
                      
                        t
                        i
                      
                      ⁢
                      
                        z
                        i
                        ′
                      
                    
                  
                
              
              =
              
                
                  
                    t
                    n
                  
                  ⁢
                  
                    z
                    n
                    ′
                  
                
                +
                
                  φ
                  ⁢
                  
                    
                  
                  ⁢
                  
                    bz
                    2
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                
              
            
          
        
      
    
    
      
        (
        5
        )
      
    
  




The equation set (5) shown above illustrates how the main matrix and the right hand terms can be computed from the previously computed values using an iterative method. This method is useful because it eliminates the need for storing old data when updating matrix elements and reduce the amount of computation.
The elements of the subscriber device movement are then computed as shown in equation set (6).




  
    
      
        
          
            Δ
            
              (
              n
              )
            
          
          =
          
            
              
                a
                
                  1
                  ,
                  1
                
                
                  (
                  n
                  )
                
              
              ⁢
              
                a
                
                  2
                  ,
                  2
                
                
                  (
                  n
                  )
                
              
            
            -
            
              
                (
                
                  a
                  
                    1
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
                )
              
              2
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            x
            0
            
              (
              n
              )
            
          
          =
          
            
              
                
                  bx
                  1
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  a
                  
                    2
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
              
              -
              
                
                  bx
                  2
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  a
                  
                    1
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
              
            
            
              Δ
              
                (
                n
                )
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            V
            x
            
              (
              n
              )
            
          
          =
          
            
              
                
                  a
                  
                    1
                    ,
                    1
                  
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  bx
                  2
                  
                    (
                    n
                    )
                  
                
              
              -
              
                
                  a
                  
                    1
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  bx
                  1
                  
                    (
                    n
                    )
                  
                
              
            
            
              Δ
              
                (
                n
                )
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            y
            0
            
              (
              n
              )
            
          
          =
          
            
              
                
                  by
                  1
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  a
                  
                    2
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
              
              -
              
                
                  by
                  2
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  a
                  
                    1
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
              
            
            
              Δ
              
                (
                n
                )
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            V
            y
            
              (
              n
              )
            
          
          =
          
            
              
                
                  a
                  
                    1
                    ,
                    1
                  
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  by
                  2
                  
                    (
                    n
                    )
                  
                
              
              -
              
                
                  a
                  
                    1
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  by
                  1
                  
                    (
                    n
                    )
                  
                
              
            
            
              Δ
              
                (
                n
                )
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            z
            0
            
              (
              n
              )
            
          
          =
          
            
              
                
                  bz
                  1
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  a
                  
                    2
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
              
              -
              
                
                  bz
                  2
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  a
                  
                    1
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
              
            
            
              Δ
              
                (
                n
                )
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            V
            z
            
              (
              n
              )
            
          
          =
          
            
              
                
                  a
                  
                    1
                    ,
                    1
                  
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  bz
                  2
                  
                    (
                    n
                    )
                  
                
              
              -
              
                
                  a
                  
                    1
                    ,
                    2
                  
                  
                    (
                    n
                    )
                  
                
                ⁢
                
                  bz
                  1
                  
                    (
                    n
                    )
                  
                
              
            
            
              Δ
              
                (
                n
                )
              
            
          
        
      
    
    
      
        (
        6
        )
      
    
  




The filter provides all parameters needed for computing a smooth current position and for predicting the mobile position in the future for the subscriber device.
The quality of the computed prediction with the filter presented in equations (1) through (6) depends on previously collected data and the size of the forget factor φ. Usually the factor has a value very close to one (0.99 for example). The use of a KFilter in accordance with the embodiment of the present invention adds still more accuracy to the system and method of prediction described above.
The KFilter filtering method described below includes aspects of “Kalman filtering” as known to those skilled in the art, but is different in many aspects. One significant difference is the reduced amount of computation required in the embodiment of the present invention compared with Kalman filters. This allows the use of the KFilter of the present embodiment for real-time processing on low speed CPU devices. (The use of letter K in the name of the filter is as recognition to Kalman teaching about filtering methods).
Each individual position generated by location services operations for a mobile node is typically affected by random errors. Sometimes these errors are large or small, depending on the nature of the radio frequency (RF) propagation inside buildings and in and around dense areas and cannot be controlled. The example of a KFilter presented below computes an individual weight for each measurement generated by the subscriber device. The weight of the measurement is computed with the purpose of decreasing the standard deviation of errors from one measurement to the next. Although the purpose is to continuously decrease the standard deviation of errors, the variation of the standard deviation remains strongly dependent on the accuracy of the input data.
To decrease the standard deviation of errors from one measurement to the next, the KFilter first computes the error ε′(n) using the time and location provided by the mobile node or subscriber device, and previously computed movement characteristics of the subscriber device, such as the reference point (x0, y0, z0) and the moving speed (Vx, Vy, Vz) as shown in equation set (7).




  
    
      
        
          
            ɛ
            x
            
              ′
              ⁡
              
                (
                n
                )
              
            
          
          =
          
            
              x
              
                (
                n
                )
              
            
            -
            
              (
              
                
                  x
                  0
                  
                    (
                    
                      n
                      -
                      1
                    
                    )
                  
                
                +
                
                  
                    V
                    x
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                  ⁢
                  
                    t
                    n
                  
                
              
              )
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            ɛ
            y
            
              ′
              ⁡
              
                (
                n
                )
              
            
          
          =
          
            
              y
              
                (
                n
                )
              
            
            -
            
              (
              
                
                  y
                  0
                  
                    (
                    
                      n
                      -
                      1
                    
                    )
                  
                
                +
                
                  
                    V
                    y
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                  ⁢
                  
                    t
                    n
                  
                
              
              )
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            ɛ
            x
            
              ′
              ⁡
              
                (
                n
                )
              
            
          
          =
          
            
              z
              
                (
                n
                )
              
            
            -
            
              (
              
                
                  z
                  0
                  
                    (
                    
                      n
                      -
                      1
                    
                    )
                  
                
                +
                
                  
                    V
                    z
                    
                      (
                      
                        n
                        -
                        1
                      
                      )
                    
                  
                  ⁢
                  
                    t
                    n
                  
                
              
              )
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            σ
            
              ′
              ⁡
              
                (
                n
                )
              
            
          
          =
          
            
              
                
                  S
                  
                    (
                    
                      n
                      -
                      1
                    
                    )
                  
                
                +
                
                  
                    (
                    
                      ɛ
                      x
                      
                        ′
                        ⁡
                        
                          (
                          n
                          )
                        
                      
                    
                    )
                  
                  2
                
                +
                
                  
                    (
                    
                      ɛ
                      y
                      
                        ′
                        ⁡
                        
                          (
                          n
                          )
                        
                      
                    
                    )
                  
                  2
                
                +
                
                  
                    (
                    
                      ɛ
                      z
                      
                        ′
                        ⁡
                        
                          (
                          n
                          )
                        
                      
                    
                    )
                  
                  2
                
              
              
                
                  a
                  
                    1
                    ,
                    1
                  
                  
                    (
                    
                      n
                      -
                      1
                    
                    )
                  
                
                +
                1
              
            
          
        
      
    
    
      
        (
        7
        )
      
    
  




The computation of term sn-1 is described below. The weight factor w(n) of the current measurement is computed as shown in equation set (8) from the previous standard deviation, and the new measurement errors ε′x(n), ε′y(n) and ε′z(n) calculated from equation set (7).




  
    
      
        
          
            w
            ′
          
          =
          
            
              K
              ⁡
              
                (
                
                  
                    
                      σ
                      
                        (
                        
                          n
                          -
                          1
                        
                        )
                      
                    
                    
                      σ
                      
                        ′
                        ⁡
                        
                          (
                          n
                          )
                        
                      
                    
                  
                  -
                  1
                
                )
              
            
            +
            1
          
        
        ⁢
        
          

        
        ⁢
        
          w
          =
          
            {
            
              
                
                  
                    
                      
                        w
                        ′
                      
                      >
                      Max
                    
                    ⇒
                    Max
                  
                
              
              
                
                  
                    
                      
                        w
                        ′
                      
                      <
                      Min
                    
                    ⇒
                    Min
                  
                
              
              
                
                  
                    
                      
                        w
                        ′
                      
                      >
                      
                        Min
                        ⋀
                        
                          w
                          ′
                        
                      
                      <
                      Max
                    
                    ⇒
                    
                      w
                      ′
                    
                  
                
              
            
          
        
      
    
    
      
        (
        8
        )
      
    
  




The value of K in equation set (8) is always positive, is selected based on the specific application, and provides the “sensitivity” of the KFilter to variations of the input data. The Min and Max values are positive and serve to limit the variation of the computed weight factor w.
Equation (8) provides a weighting factor w that must assure the successive minimization of the standard deviation σ. In this equation σ′(n) was computed with equation (7) and is the predicted value of the standard deviation if the new measurement would be considered with weight w=1. Such presumption can be correct or not. If σ′(n) is smaller than the previous value of the standard deviation σ(n−1), σ(n−1)/σ′(n) is larger than one and then we get a weight value larger than one. If σ′(n) is larger than the previous value of the standard deviation σ(n−1), σ(n−1)/σ′(n) is smaller than one and then we get a weight value smaller than one. The value of K allows adjusting the sensitivity of the weighting process according to the needs of the specific application.
The computed weight factor w is then used for building the system of equation set (9).




  
    
      
        
          
            a
            
              1
              ,
              1
            
            
              (
              n
              )
            
          
          =
          
            
              w
              
                (
                n
                )
              
            
            +
            
              φ
              ⁢
              
                
              
              ⁢
              
                a
                
                  1
                  ,
                  1
                
                
                  (
                  
                    n
                    -
                    1
                  
                  )
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            a
            
              1
              ,
              2
            
            
              (
              n
              )
            
          
          =
          
            
              
                w
                
                  (
                  n
                  )
                
              
              ⁢
              
                t
                n
              
            
            +
            
              φ
              ⁢
              
                
              
              ⁢
              
                a
                
                  1
                  ,
                  2
                
                
                  (
                  
                    n
                    -
                    1
                  
                  )
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            a
            
              2
              ,
              2
            
            
              (
              n
              )
            
          
          =
          
            
              
                w
                
                  (
                  n
                  )
                
              
              ⁢
              
                t
                n
                2
              
            
            +
            
              φ
              ⁢
              
                
              
              ⁢
              
                a
                
                  2
                  ,
                  2
                
                
                  (
                  
                    n
                    -
                    1
                  
                  )
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            bx
            1
            
              (
              n
              )
            
          
          =
          
            
              
                w
                
                  (
                  n
                  )
                
              
              ⁢
              
                x
                n
                ′
              
            
            +
            
              φ
              ⁢
              
                
              
              ⁢
              
                bx
                1
                
                  (
                  
                    n
                    -
                    1
                  
                  )
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            bx
            2
            
              (
              n
              )
            
          
          =
          
            
              
                w
                
                  (
                  n
                  )
                
              
              ⁢
              
                t
                n
              
              ⁢
              
                x
                n
                ′
              
            
            +
            
              
            
            ⁢
            
              φ
              ⁢
              
                
              
              ⁢
              
                bx
                2
                
                  (
                  
                    n
                    -
                    1
                  
                  )
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            by
            1
            
              (
              n
              )
            
          
          =
          
            
              
                w
                
                  (
                  n
                  )
                
              
              ⁢
              
                y
                n
                ′
              
            
            +
            
              φ
              ⁢
              
                
              
              ⁢
              
                by
                1
                
                  (
                  
                    n
                    -
                    1
                  
                  )
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            by
            2
            
              (
              n
              )
            
          
          =
          
            
              
                w
                
                  (
                  n
                  )
                
              
              ⁢
              
                t
                n
              
              ⁢
              
                y
                n
                ′
              
            
            +
            
              
            
            ⁢
            
              φ
              ⁢
              
                
              
              ⁢
              
                by
                2
                
                  (
                  
                    n
                    -
                    1
                  
                  )
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            bz
            1
            
              (
              n
              )
            
          
          =
          
            
              
                w
                
                  (
                  n
                  )
                
              
              ⁢
              
                z
                n
                ′
              
            
            +
            
              φ
              ⁢
              
                
              
              ⁢
              
                bz
                1
                
                  (
                  
                    n
                    -
                    1
                  
                  )
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            bz
            2
            
              (
              n
              )
            
          
          =
          
            
              
                w
                
                  (
                  n
                  )
                
              
              ⁢
              
                t
                n
              
              ⁢
              
                z
                
                  n
                  i
                
                ′
              
            
            +
            
              
            
            ⁢
            
              φ
              ⁢
              
                
              
              ⁢
              
                bz
                2
                
                  (
                  
                    n
                    -
                    1
                  
                  )
                
              
            
          
        
      
    
    
      
        (
        9
        )
      
    
  




The a and b values from equation set (9) are used as described for equation set (6) to compute the new values of the reference point (x0, y0, z0) and the moving speed (Vx, Vy, Vz). The value of the standard deviation is then updated as shown in equation set (10).




  
    
      
        
          
            ɛ
            x
            
              (
              n
              )
            
          
          =
          
            
              x
              
                (
                n
                )
              
            
            -
            
              (
              
                
                  x
                  0
                  
                    (
                    n
                    )
                  
                
                +
                
                  
                    V
                    x
                    
                      (
                      n
                      )
                    
                  
                  ⁢
                  
                    t
                    n
                  
                
              
              )
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            ɛ
            y
            
              (
              n
              )
            
          
          =
          
            
              y
              
                (
                n
                )
              
            
            -
            
              (
              
                
                  y
                  0
                  
                    (
                    n
                    )
                  
                
                +
                
                  
                    V
                    y
                    
                      (
                      n
                      )
                    
                  
                  ⁢
                  
                    t
                    n
                  
                
              
              )
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            ɛ
            x
            
              (
              n
              )
            
          
          =
          
            
              z
              
                (
                n
                )
              
            
            -
            
              (
              
                
                  z
                  0
                  
                    (
                    n
                    )
                  
                
                +
                
                  
                    V
                    z
                    
                      (
                      n
                      )
                    
                  
                  ⁢
                  
                    t
                    n
                  
                
              
              )
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            ɛ
            
              (
              n
              )
            
          
          =
          
            
              
                
                  (
                  
                    ɛ
                    x
                    
                      (
                      n
                      )
                    
                  
                  )
                
                2
              
              +
              
                
                  (
                  
                    ɛ
                    y
                    
                      (
                      n
                      )
                    
                  
                  )
                
                2
              
              +
              
                
                  (
                  
                    ɛ
                    z
                    
                      (
                      n
                      )
                    
                  
                  )
                
                2
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            S
            
              (
              n
              )
            
          
          =
          
            
              
                
                  (
                  
                    ɛ
                    
                      (
                      n
                      )
                    
                  
                  )
                
                2
              
              ⁢
              
                w
                
                  (
                  n
                  )
                
              
            
            +
            
              φ
              ⁢
              
                
              
              ⁢
              
                s
                
                  n
                  -
                  1
                
              
            
          
        
        ⁢
        
          

        
        ⁢
        
          
            σ
            
              (
              n
              )
            
          
          =
          
            
              
                s
                
                  (
                  n
                  )
                
              
              
                a
                
                  1
                  ,
                  1
                
                
                  (
                  n
                  )
                
              
            
          
        
      
    
    
      
        (
        10
        )
      
    
  




The standard deviation σ(n) is not known a priori, therefore equations (7) and (8) cannot be applied when the first few measurements are made. For this reason, the first several samples are considered as correct and weighted with w=1. As described for equations (5) and (10), some terms are computed recursively using their values from previous iteration. Since the computation shows additive operations, it is normal that initial values of all variables computed iteratively are equal to zero when the filter is first started.
Implementation of an embodiment of the present invention in an ad-hoc network can be illustrated as shown in FIGS. 3, 4 and 5. FIG. 3 illustrates reported positions of a subscriber device on a geographic plot 120. A set of 281 samples were collected from a point inside a building at a rate of one sample every 2 seconds and reported as shown in FIG. 3. The plot of FIG. 3 shows all measurements that were enclosed within a 25×25 square meter area. The results of filtering this data with a KFilter to improve accuracy as described above is presented in FIG. 4, which illustrates examples of the filtered values shown in FIG. 3 on a geographic plot 130.
The standard deviation of errors for the unfiltered data of FIG. 3 is,

    
    
        σx=3.1;
        σy=2.6;
        σz=0.5; and
        σ=4.1.
    
    


After filtering as shown in FIG. 4, the standard deviation of errors is,

    
    
        σx=1.2;
        σy=0.8;
        σz=0.1; and
        σ=1.4. 
    
    


This data shows an improvement in three dimensional (3D) data precision by a factor of 3. In FIG. 4, the filtered values, or filtered positions, are shown covering an area of about 4×4 square meters, showing much better dispersion than raw data.
The improved results achieved using the embodiment of the present invention described above, are more clearly shown in FIG. 5. The chart 140 in FIG. 5 shows the precision of the subscriber device position provided by the standard location services operations compared with the filtered data using the system and method of the present invention described above. As shown, the plot of input data 142 has a much greater cumulative degree of error when compared to the filtered data of 144. In the example presented, the collected data has very small errors at the beginning, which allowed the KFilter to converge fast and provide very accurate precision after collecting only 6 samples. In other examples, larger errors can also be eliminated in a similar fashion.
Although only a few exemplary embodiments of the present invention have been described in detail above, those skilled in the art will readily appreciate that many modifications are possible in the exemplary embodiments without materially departing from the novel teachings and advantages of this invention. Accordingly, all such modifications are intended to be included within the scope of this invention.

## Claims

1. A method for determining a location of a mobile communication device in a communication network, the method comprising:
estimating a location of the mobile communication device based on measured data representing respective distances between the mobile communication device and a plurality of reference points;
assigning a respective weight factor to each data of the measured data;
generating a forget factor based on the respective weight factors; and
modifying the estimated location, using a predictive filter including the forget factor which treats older measured data less significantly than newer measured data in estimating the location, to generate a modified estimated location representative of the location of the mobile communication device.

2. The method as claimed in claim 1, wherein:
the modifying step predicts movement of the mobile communication device on three axes of coordinates and uses the predictive filter to adjust the predicted movement to ascertain the modified estimated location.

3. The method as claimed in claim 2, wherein:
the modifying step predicts the movement using equations including variables representing the starting position of the mobile communication device and variables representing the moving speed of the mobile communication device, as modified by the predictive filter.

4. The method as claimed in claim 1, wherein:
the network includes a wireless multihopping communication network, and the mobile communication device is a node in the wireless multihopping communication network.

5. The method as claimed in claim 1, wherein:
the mobile communication device performs the estimating and modifying steps.

6. The method as claimed in claim 1, wherein:
the forget factor has a value between 0 and 1.

7. A method for determining a location of a mobile communication device in a communication network, the method comprising:
estimating a location of the mobile communication device based on measured data representing respective distances between the mobile communication device and a plurality of reference points;
modifying the estimated location, using a predictive filter including a forget factor which treats older measured data less significantly than newer measured data in estimating the location, to generate a modified estimated location representative of the location of the mobile communication device;
wherein:
the modifying step predicts movement of the mobile communication device on three axes of coordinates and uses the predictive filter to adjust the predicted movement to ascertain the modified estimated location;
the modifying step predicts the movement using equations including variables representing the starting position of the mobile communication device and variables representing the moving speed of the mobile communication device, as modified by the predictive filter; and
the equations include three systems of equations, each system pertaining to a respective axis of movement and employing the forget factor to adjust the estimated starting position coordinate for that respective axis and speed of movement along that respective axis.

8. A computer readable medium of instructions for enabling a processor to determine a location of a mobile communication device in a communication network, the computer readable medium of instructions comprising:
a first set of instructions, adapted to control the processor to estimate a location of the mobile communication device based on measured data representing respective distances between the mobile communication device and a plurality of reference points; and
a second set of instructions, adapted to control the processor to modify the estimated location, using a predictive filter including a forget factor which treats older measured data less significantly than newer measured data in estimating the location, to generate a modified estimated location representative of the location of the mobile communication device;
wherein the second set of instructions is further adapted to control the processor to assign a respective weight factor to each data of the measured data, and to generate the forget factor based on the assigned weight factors.

9. The computer readable medium of instructions as claimed in claim 8, wherein:
the second set of instructions is adapted to control the processor to predict movement of the mobile communication device on three axes of coordinates and uses the predictive filter to adjust the predicted movement to ascertain the modified estimated location.

10. The computer readable medium of instructions as claimed in claim 9, wherein:
the second set of instructions is adapted to control the processor to predict the movement using equations including variables representing the starting position of the mobile communication device and variables representing the moving speed of the mobile communication device, as modified by the predictive filter.

11. The computer readable medium of instructions as claimed in claim 8, wherein:
the network includes a wireless multihopping communication network, and the mobile communication device is a node in the wireless multihopping communication network.

12. The computer readable medium of instructions as claimed in claim 8, wherein:
the processor is employed at the mobile communication device to perform the estimating and modifying operations.

13. The computer readable medium of instructions as claimed in claim 8, wherein:
the forget factor has a value between 0 and 1.

14. A computer readable medium of instructions for enabling a processor to determine a location of a mobile communication device in a communication network, the computer readable medium of instructions comprising:
a first set of instructions, adapted to control the processor to estimate a location of the mobile communication device based on measured data representing respective distances between the mobile communication device and a plurality of reference points; and
a second set of instructions, adapted to control the processor to modify the estimated location, using a predictive filter including a forget factor which treats older measured data less significantly than newer measured data in estimating the location, to generate a modified estimated location representative of the location of the mobile communication device;
wherein:
the second set of instructions is adapted to control the processor to predict movement of the mobile communication device on three axes of coordinates and uses the predictive filter to adjust the predicted movement to ascertain the modified estimated location;
the second set of instructions is adapted to control the processor to predict the movement using equations including variables representing the starting position of the mobile communication device and variables representing the moving speed of the mobile communication device, as modified by the predictive filter; and
the equations include three systems of equations, each system pertaining to a respective axis of movement and employing the forget factor to adjust the estimated starting position coordinate for that respective axis and speed of movement along that respective axis.

15. A system for determining a location of a mobile communication device in a communication network, the system comprising:
a processor, adapted to estimate a location of the mobile communication device based on measured data representing respective distances between the mobile communication device and a plurality of reference points, and being further adapted to assign a respective weight factor to each data of the measured data, generate the forget factor based on the assigned weight factors, and modify the estimated location, using a predictive filter including the forget factor which treats older measured data less significantly than newer measured data in estimating the location, to generate a modified estimated location representative of the location of the mobile communication device.

16. The system as claimed in claim 15, wherein:
the modifying operation predicts movement of the mobile communication device on three axes of coordinates and uses the predictive filter to adjust the predicted movement to ascertain the modified estimated location.

17. The system as claimed in claim 16, wherein:
the modifying operation predicts the movement using equations including variables representing the starting position of the mobile communication device and variables representing the moving speed of the mobile communication device, as modified by the predictive filter.

18. The system as claimed in claim 15, wherein:
the network includes a wireless multihopping communication network, and the mobile communication device is a node in the wireless multihopping communication network.

19. The system as claimed in claim 15, wherein:
the mobile communication device includes the processor that performs the estimating and modifying operations.

20. The system as claimed in claim 15, wherein:
the forget factor has a value between 0 and 1.

21. A system for determining a location of a mobile communication device in a communication network, the system comprising:
a processor, adapted to estimate a location of the mobile communication device based on measured data representing respective distances between the mobile communication device and a plurality of reference points, and being further adapted to modify the estimated location, using a predictive filter including a forget factor which treats older measured data less significantly than newer measured data in estimating the location, to generate a modified estimated location representative of the location of the mobile communication device;
wherein:
the modifying operation predicts movement of the mobile communication device on three axes of coordinates and uses the predictive filter to adjust the predicted movement to ascertain the modified estimated location;
the modifying operation predicts the movement using equations including variables representing the starting position of the mobile communication device and variables representing the moving speed of the mobile communication device, as modified by the predictive filter; and
the equations include three systems of equations, each system pertaining to a respective axis of movement and employing the forget factor to adjust the estimated starting position coordinate for that respective axis and speed of movement along that respective axis.