Abstract:
A method of determining the location of an object uses data representing the bearing of the object from a plurality of observation locations. The method comprises (a) deriving, for each bearing, the coordinates of a point, the coordinates comprising a first value p representing the signed distance between a predetermined location and the closest point on the bearing line, and a second value θ representing the angle of the bearing line, using a procedure according to which co-linear bearings of opposite direction have first values which are of opposite sign to each other and second values which differ from each other by π; and (b) deriving parameters defining a curve fitting said points, said parameters representing the object location. Values representing the signal-to-noise ratios associated with the bearing measurements, and values representing the observation locations relative to each other and to the object, can be used to group the bearings for the purpose of weighting their effects on the calculation of object location.

Description:
BACKGROUND OF THE INVENTION 
       [0001]    1. Field of the Invention 
         [0002]    This invention relates to a method and apparatus for determining an unknown location of an object from bearing lines supplied by multiple sensors distributed over some surveillance region of interest, and is especially, but not exclusively, applicable to dynamically reconfigurable networks of distributed sensors. 
         [0003]    2. Description of the Prior Art 
         [0004]    There are many circumstances in which there is a need to detect, localize and track a noncooperative object of interest in some specified surveillance area. Such tasks can be performed by suitable active or passive sensors which can extract useful information by collaborative processing of signals reflected or emitted by that object. 
         [0005]    In contrast to applications employing active sensors, such as radar or active sonar, in which the surveillance region of interest is illuminated by an interrogating energy waveform to obtain object-backscattered returns, passive sensors capture only object-generated signals. For example, the movement of people, wheeled or tracked vehicles, speedboats, vibrating machinery can all generate usable acoustic signals, which can be exploited for object detection, localization and tracking. 
         [0006]    One area in which object detection and localisation is useful is that of security surveillance with a network of distributed optical and/or acoustic sensors. When an object of interest, such as a vehicle, has been detected and localised, the estimated object position can be utilized by security cameras for aiming and zooming, in order to enhance the quality of recorded images. Such systems may be installed for monitoring purposes in industrial environments, e.g. to offer improved continuous surveillance of critical infrastructure, including power grids, power plants, gas and oil pipelines and water supply systems. 
         [0007]    Another application is that of coastguard or littoral surveillance in which speedboats and other surface vessels of interest can be detected and localized by a network of floating buoys employing acoustic sensors and low-power radio transceivers providing an intersensor communication link. 
         [0008]    One important application in which the present invention can be utilized is that of bearings-only object localization by a wireless network of unattended ground sensors (UGS) employed to provide an improved security surveillance capability. The network comprises a plurality of passive sensors, dispersed over some surveillance region of interest, and a data fusion centre. The sensors that form the nodes of the network may be of the same type (e.g., all optical, infra-red, acoustic, seismic, etc.), or the network may employ disparate sensors. It is assumed that there is provided a radio frequency (RF) link to exchange information between the sensors and the data fusion centre. The main task of the sensor network is to detect the presence of an object of interest and to determine its location. 
         [0009]      FIG. 1  is an example of a sensor network comprising a plurality of sensors, S 1 , S 2 , . . . , Sk, . . . , SM, arranged in a regular or irregular array, and a data fusion centre DFC. Each sensor is capable of detecting the presence of an object and determining a bearing angle (or direction of arrival, DOA) of a signal emitted by that object. The data fusion centre DFC may ‘interrogate’ either all the sensors or only a group of sensors selected in a judicious manner to supply bearing information. The bearing information is then suitably processed in the DFC to determine the ‘snapshot’ coordinates (x 0 ,y 0 ) of the object location P 0 . The DFC may also incorporate a subsystem with tracking capabilities, such as an extended Kalman filter, a particle filter or other similar device. 
         [0010]    A well-known class of algorithms for beaings-only object localization is based on modelling each observed bearing angle φ k * as 
         [0000]      φ k *=φ k +η k , k=1, 2, . . . M 
         [0000]    where φ k  is the true bearing angle given by 
         [0000]    
       
         
           
             
               φ 
               k 
             
             = 
             
               arc 
                
               
                   
               
                
               
                 tan 
                  
                 
                   ( 
                   
                     
                       
                         y 
                         0 
                       
                       - 
                       
                         y 
                         Sk 
                       
                     
                     
                       
                         x 
                         0 
                       
                       - 
                       
                         x 
                         Sk 
                       
                     
                   
                   ) 
                 
               
             
           
         
       
     
         [0000]    where (x 0 ,y 0 ) are hypothesized coordinates of the object location, (x Sk ,y Sk ) are known coordinates of the k-th sensor Sk, and η k  is the observation error with zero mean and variance σ k   2 . 
         [0011]    The estimated object location (x 0 *,y 0 *) is a pair of such numbers (x 0 ,y 0 ) for which the following expression 
         [0000]    
       
         
           
             
               ∑ 
               
                 k 
                 = 
                 1 
               
               M 
             
              
             
               
                 
                   ( 
                   
                     
                       φ 
                       k 
                     
                     - 
                     
                       φ 
                       k 
                       ⋆ 
                     
                   
                   ) 
                 
                 2 
               
               
                 σ 
                 k 
                 2 
               
             
           
         
       
     
         [0000]    attains its minimum value. 
         [0012]    Other known algorithms of this class may attempt to minimize somewhat modified versions of the above cost function, but all the algorithms will suffer to some extent from the following drawbacks:
       1. there is no indication of whether or not the ‘viewing’ geometry is favourable, e.g. whether the problem is ill-conditioned because the bearing lines are almost co-linear;   2. there is no guarantee that the global minimum has been reached; hence the determined location may differ significantly from the true one;   3. the implementation is based on iterative batch processing rather than recursive processing which, in general, is much more suitable for real-time implementation.       
 
         [0016]    It would therefore be desirable to provide a method and an apparatus for object localization in a more efficient way than that provided by the prior art techniques, especially (but not only) for dynamically reconfigurable networks of distributed passive sensors with limited computation and communication capabilities. 
       SUMMARY OF THE INVENTION 
       [0017]    Aspects of the present invention are set out in the accompanying claims. 
         [0018]    Some aspects of the invention use techniques which involve mapping a set of bearing lines into points which will theoretically, as a consequence of the mapping procedure, lie on a cosine curve (which term is used herein as synonymous with sine curve). The position of the object to be localised will determine the phase and amplitude of the cosine curve. Accordingly, the location of the object can be determined by finding the phase and amplitude of the cosine curve substantially fitting the points, which can be achieved in a efficient manner, for example using known curve-fitting algorithms. Preferably the parameters of the cosine curve are determined by combining the coordinates of the points in a particular manner, preferably using various averages. A particularly preferred embodiment described below uses a technique analogous to quadrature demodulation in signal processing to extract orthogonal components of mapped bearing lines and then combines the components to derive the Cartesian coordinates of the object location. 
         [0019]    The principle of operation of the preferred embodiments is described below. 
         [0020]    In stochastic geometry, it is known that a directed line b (e.g., a bearing line emanating from a sensor) may be characterized by two parameters d and β, where d is the perpendicular (signed) distance of b from a reference location or point (e.g. an origin 0), and β is an angle, measured in an anti-clockwise direction, between the line b and a reference directed line such as an x axis, north or other direction. The parameter d is positive if the reference point lies to the left of the line, as we ‘look along it’, and d is negative if the reference point lies to the right of the line.  FIG. 2  depicts examples of bearing lines, including two lines (b 1  and b 2 ) that are anti-parallel. 
         [0021]    Each directed line b in the xy-plane is determined uniquely by a corresponding pair of parameters (d, β); in other words, there is one-to-one correspondence between all directed lines {bk} in the xy-plane and the points {(d k ,β k )} on the infinite cylinder, defined by 
         [0000]      {( d ,β):−∞&lt; d ≦∞,0≦β&lt;2π} 
         [0000]    Accordingly, the infinite cylinder with unit radius determines the (d,β)-space which includes all directed planar lines. 
         [0022]    As known from stochastic geometry, when the (d,β) parameterisation is used to represent lines on a plane, the probabilistic characterization of the lines is invariant under the group of rigid motions (translations and rotations) in the plane. Therefore, for the purpose of object localization and tracking such parameterisation is superior to other parameterisations, such as the slope-intercept one, used in other applications. 
         [0023]    A preferred and independent aspect of the invention operates according to the following principles, although it should be noted that particular embodiments of the invention may not perform the actual steps as described, but may instead operate using equivalent techniques. 
         [0024]    For the purpose of object localisation it is convenient to transform the (d,β)-space of bearing lines into an equivalent (p,θ)-space as follows. Let (x 0 ,y 0 ) be the coordinates of a stationary point P 0  to be localized, and let bk be any bearing line, from any sensor S k , passing through P 0 , as shown in  FIG. 3 . By construction, 
         [0000]        p   k   =r   0  cos(θ k −α 0 )  (1) 
         [0000]    where θ is the angle that the perpendicular p k  makes with the x-axis, and r 0  and α 0  are the polar coordinates 
         [0000]    
       
         
           
             
               
                 r 
                 0 
               
               = 
               
                 
                   
                     x 
                     0 
                     2 
                   
                   + 
                   
                     y 
                     0 
                     2 
                   
                 
               
             
             , 
             
                 
             
              
             
               
                 α 
                 0 
               
               = 
               
                 arctan 
                  
                 
                   ( 
                   
                     
                       y 
                       0 
                     
                     
                       x 
                       0 
                     
                   
                   ) 
                 
               
             
           
         
       
     
         [0000]    of the point P 0 . 
         [0025]    When the value of angle θ is allowed to vary over the entire (0, 2π)-range, equation (1) will represent all bearing lines passing through the point P 0 . For illustrative purposes,  FIG. 4  depicts examples of bearing lines passing through P 0 ; lines, b 1 , b 2  and b 4 , are undirected, whereas lines b 3   +  and b 3   −  have opposite direction. 
         [0026]    Equation (1) may alternately be viewed as a unique representation of the point P 0  on the surface of an infinite cylinder with unit radius: 
         [0000]      {( p ,θ):−√&lt; p &lt;∞,0≦θ&lt;2π} 
         [0027]    From those two interpretations of equation (1) it follows that each point P(x,y) in the xy-plane will be represented by a respective ellipse obtained by cutting the unit-radius cylinder by a plane, as shown in  FIG. 5   a . In particular, polar coordinates, r 0  and α 0 , of a specified point P 0  can be determined from the elevation angle ψ, as r 0 =tan ψ, and from the azimuth angle α 0 . All bearing lines passing through the point P 0  are represented by points on the ellipse. For example, the directed bearing lines b 3   +  and b 3   −  shown in  FIG. 4  appear as corresponding points b 3   +  and b 3   − . 
         [0028]    In accordance with the adopted parameterisation, to each undirected bearing line in the xy-plane, such as lines b 1 , b 2  and b 4  shown in  FIG. 4 , there corresponds a pair of points lying on the ellipse. These pairs of points, such as: b 1   +  and b 1   − , b 2   +  and b 2   − , b 4+  and b 4   − , are reflections of each other. As seen from  FIG. 5   a , as the line direction changes, the point jumps to the opposite wall of the cylinder, while the value of the p-parameter changes its sign. 
         [0029]    When the surface of the cylinder is unfolded, the ellipse appears as one cycle of a cosine wave, as shown in  FIG. 5   b . While the period of the cosine wave is equal to 2π, the amplitude r 0  and starting phase as are equal to the respective polar coordinates, r 0  and α 0 , of the point P 0 . Two points representing opposite directions of a bearing line passing through P 0  are shifted (cyclically) on the cosine wave with respect to each other by π. Although the p-coordinates of these points have equal magnitudes, each of them retains the sign of the corresponding direction of the bearing line. When there are no observation errors, each point of the pair carries the same information as the other one. 
         [0030]    The problem of determining the unknown object location (x 0 , y 0 ) in the (x,y)-plane from a plurality of bearing lines {bk}, supplied by respective sensors {Sk}, is reduced to fitting in a (p,θ)-space a cosine wave with known period (but unknown amplitude and phase) to a plurality of points, where each such point represents a respective bearing line. More specifically, the unknown amplitude r 0  and the unknown phase α 0  define the cosine wave to be fitted and are equal to the respective polar coordinates of the point to be localized. 
         [0031]    Because in practice each bearing line bk is corrupted by some measurement error, the coordinates (p k ,θ k ) of the corresponding point on the surface of the cylinder will be perturbed. Consequently, the task of fitting a sine wave to a plurality of given points is far from being trivial. In principle, any suitable robust numerical algorithm can be utilized for this purpose. However, in the preferred embodiments of the invention described below the parameters representing the multiple bearing lines are processed using techniques which offer the following advantages:
       the method is based on a closed-form solution to the problem; hence no iterative computation steps are needed;   the method can utilize input data in a recursive manner to perform object localization and facilitate tracking;   the method provides a measure indicative of the ‘goodness of viewing geometry’; therefore it can be utilized for selecting a group of sensors that can perform object localization in a most efficient manner;   the method can be made sufficiently robust to process input data corrupted by noise and other interference;   for most applications, the method can be implemented in real-time even with a standard digital signal processor (DSP) or a suitable low-complexity FPGA.       
 
         [0037]    In implementing these preferred techniques, a bearing angle β k  provided by sensor Sk is used together with known sensor coordinates (x Sk ,y Sk ) to determine the parameters (p k ,θ k ) of a point representing the corresponding bearing line bk in the (p k ,θ k )-space. The values of θ k  and p k  are obtained from 
         [0000]      θ k =β k −π2 , p   k   =x   Sk  cos θ k   +y   Sk  sin θ k , k=1, 2, . . . , M  (2) 
         [0038]    It is to be noted that θ k  could be any value within the range (0, 2π), depending on the direction of the bearing, and p k  can be either negative or positive, depending on both the direction of the bearing and the position of the closest point on the bearing line relative to the reference location. 
         [0039]    The parameter p k  has normalized components (which can also have positive and negative values), which can be derived by resolving each parameter p k  at the corresponding angle θ k  using orthogonal trigonometric functions, in this case sin θ k  and cos θ k . Thus, averages Q and I of these components are determined as follows: 
         [0000]    
       
         
           
             
               
                 
                   
                     Q 
                      
                     
                         
                     
                      
                     
                       Δ 
                       _ 
                     
                      
                     
                       1 
                       M 
                     
                      
                     
                       
                         ∑ 
                         
                           k 
                           = 
                           1 
                         
                         M 
                       
                        
                       
                         
                           p 
                           k 
                         
                          
                         sin 
                          
                         
                             
                         
                          
                         
                           θ 
                           k 
                         
                       
                     
                   
                   , 
                   
                       
                   
                    
                   
                     I 
                      
                     
                         
                     
                      
                     
                       Δ 
                       _ 
                     
                      
                     
                       1 
                       M 
                     
                      
                     
                       
                         ∑ 
                         
                           k 
                           = 
                           1 
                         
                         M 
                       
                        
                       
                         
                           p 
                           k 
                         
                          
                         cos 
                          
                         
                             
                         
                          
                         
                           θ 
                           k 
                         
                       
                     
                   
                 
               
               
                 
                   ( 
                   3 
                   ) 
                 
               
             
           
         
       
     
         [0040]    It can be seen from  FIG. 3  that 
         [0000]        p   k   =r   0  cos(θ k −α 0 ), k=1, 2, . . . M, 0≦θ&lt;2π 
         [0000]      Hence: 
         [0000]        p   k   =r   0 (sin θ k  sin α 0 +cos θ k  cos α 0 ) 
         [0000]      Thus: 
         [0000]        p   k   =r   0  sin α 0  sin θ k   +r   0  cos α 0  cos θ k   =y   0  sin θ k   +x   0  cos θ k    
         [0041]    The averages Q and I can thus be expressed as 
         [0000]    
       
         
           
             Q 
             = 
             
               
                 
                   
                     y 
                     0 
                   
                   M 
                 
                  
                 
                   
                     ∑ 
                     
                       k 
                       = 
                       1 
                     
                     M 
                   
                    
                   
                     
                       sin 
                       2 
                     
                      
                     
                       θ 
                       k 
                     
                   
                 
               
               + 
               
                 
                   
                     x 
                     0 
                   
                   M 
                 
                  
                 
                   
                     ∑ 
                     
                       k 
                       = 
                       1 
                     
                     M 
                   
                    
                   
                     sin 
                      
                     
                         
                     
                      
                     
                       θ 
                       k 
                     
                      
                     cos 
                      
                     
                         
                     
                      
                     
                       θ 
                       k 
                     
                   
                 
               
             
           
         
       
       
         
           
             I 
             = 
             
               
                 
                   
                     x 
                     0 
                   
                   M 
                 
                  
                 
                   
                     ∑ 
                     
                       k 
                       = 
                       1 
                     
                     M 
                   
                    
                   
                     
                       cos 
                       2 
                     
                      
                     
                       θ 
                       k 
                     
                   
                 
               
               + 
               
                 
                   
                     y 
                     0 
                   
                   M 
                 
                  
                 
                   
                     ∑ 
                     
                       k 
                       = 
                       1 
                     
                     M 
                   
                    
                   
                     sin 
                      
                     
                         
                     
                      
                     
                       θ 
                       k 
                     
                      
                     cos 
                      
                     
                         
                     
                      
                     
                       θ 
                       k 
                     
                   
                 
               
             
           
         
       
     
         [0042]    Assuming S, C, and P are the auxiliary averages defined as follows 
         [0000]    
       
         
           
             
               
                 
                   
                     S 
                      
                     
                         
                     
                      
                     
                       Δ 
                       _ 
                     
                      
                     
                       1 
                       M 
                     
                      
                     
                       
                         ∑ 
                         
                           k 
                           = 
                           1 
                         
                         M 
                       
                        
                       
                         
                           sin 
                           2 
                         
                          
                         
                           θ 
                           k 
                         
                       
                     
                   
                   , 
                   
                       
                   
                    
                   
                     C 
                      
                     
                         
                     
                      
                     
                       Δ 
                       _ 
                     
                      
                     
                       1 
                       M 
                     
                      
                     
                       
                         ∑ 
                         
                           k 
                           = 
                           1 
                         
                         M 
                       
                        
                       
                         
                           cos 
                           2 
                         
                          
                         
                           θ 
                           k 
                         
                       
                     
                   
                 
               
               
                 
                   ( 
                   4 
                   ) 
                 
               
             
             
               
                 
                   P 
                    
                   
                       
                   
                    
                   
                     Δ 
                     _ 
                   
                    
                   
                     1 
                     M 
                   
                    
                   
                     
                       ∑ 
                       
                         k 
                         = 
                         1 
                       
                       M 
                     
                      
                     
                       sin 
                        
                       
                           
                       
                        
                       
                         θ 
                         k 
                       
                        
                       cos 
                        
                       
                           
                       
                        
                       
                         θ 
                         k 
                       
                     
                   
                 
               
               
                 
                   ( 
                   5 
                   ) 
                 
               
             
           
         
       
     
         [0000]    then Q and I can be expressed as 
         [0000]    
       
      
       Q=Px 
       0 
       +Sy 
       0  
      
     
         [0000]    
       
      
       I=Cx 
       0 
       +Py 
       0  
      
     
         [0043]    Consequently, the Cartesian coordinates, x 0  and y 0 , of a point P 0  at which all the M bearing lines {bk}={(p k , θ k ); k=1, 2, . . . , M} intersect can be determined from the following two linear equations 
         [0000]        Px+Sy−Q= 0  (6) 
         [0000]        Cx+Py−I= 0  (7) 
         [0044]    The two lines, given by equations (6) and (7), may be viewed as two metabearing lines: Q-line and I-line. Their intersection yields the Cartesian coordinates 
         [0000]    
       
         
           
             
               
                 
                   
                     
                       x 
                       0 
                     
                     = 
                     
                       
                         IS 
                         - 
                         QP 
                       
                       
                         SC 
                         - 
                         
                           P 
                           2 
                         
                       
                     
                   
                   , 
                   
                       
                   
                    
                   
                     
                       y 
                       0 
                     
                     = 
                     
                       
                         QC 
                         - 
                         IP 
                       
                       
                         SC 
                         - 
                         
                           P 
                           2 
                         
                       
                     
                   
                 
               
               
                 
                   ( 
                   8 
                   ) 
                 
               
             
           
         
       
     
         [0000]    of the point P 0  at which all the M bearing lines intersect. 
         [0045]    The values x 0 , y 0  uniquely define the polar coordinates r 0 , α 0  of the point P 0 , and thus, as can be seen from the foregoing, are parameters defining the cosine wave to be fitted to the points representing the bearing lines. 
         [0046]    The orthogonal functions sin θ k  and cos θ k  resolve the parameter p k  into components which correspond to directions parallel to the Cartesian x and y axes, with the x axis aligned with the reference direction. This is preferred but not essential. The values θ k  could be adjusted, to resolve the parameter p k  into components which are rotated relative to the reference direction. 
         [0047]    Instead of using averages of the various parameters mentioned above, other quantities (such as sums) which are proportional to the averages may be used. The parameters may also be combined in other ways, such as by taking a trimmed or weighted average, the median value, etc. 
         [0048]    Because the two intersecting metabearing lines, Q-line and I-line, encapsulate information concerning the ‘viewing’ geometry of the M bearing lines, it is of interest to determine the angle between these lines. The acute angle ξ between the lines can be obtained from 
         [0000]    
       
         
           
             
               
                 
                   ξ 
                   = 
                   
                     arctan 
                      
                     
                        
                       
                         
                           SC 
                           - 
                           
                             P 
                             2 
                           
                         
                         P 
                       
                        
                     
                   
                 
               
               
                 
                   ( 
                   9 
                   ) 
                 
               
             
           
         
       
     
         [0049]    As an example,  FIG. 6  shows the four bearing lines of  FIG. 4  and the angle ξ between the resulting two metabearing lines, Q-line and I-line. 
         [0050]    The ‘viewing’ geometry representing the relationship between the bearing lines (i.e. the positions of the observation locations relative to each other and to the object) becomes more and more favourable when the value of the angle ξ is changing from zero (coinciding or co-linear metabearing lines) to π/2 (perpendicular metabearing lines). Preferred embodiments of the invention are arranged to calculate this value, so that an indication of the quality of the estimate of the object location can be generated and/or the sensor outputs can be selectively processed in order to improve the quality. 
         [0051]    The Q-line and the I-line can also be regarded as a result of applying a data compression procedure to M bearing lines in order to obtain just two metabearing lines (i.e., compression ratio being equal to M/2). 
         [0052]    The mapping procedure discussed above is preferred but not essential. For example, it would be possible to use a mapping procedure whereby θ k  varies between 0 and π, or where p k  is always positive (or negative). Because of the periodicity and symmetry of cosine curves, the phase and amplitude of the cosine curve would still be determinable. 
         [0053]    The above method can be utilized to develop various embodiments of a topologic correlator which may be incorporated into a data fusion centre to process efficiently bearing information supplied by a plurality of passive sensors. Some illustrative examples of topologic correlators constructed in accordance with the invention are presented below. 
         [0054]    In some embodiments of the invention, the data provided by the various sensors is weighted so that different sensors have different influences on the calculation of the object location. (The term “weighting” is intended to include the possibility of simply disregarding selected sensor outputs.) The weighting can be determined by various factors, such as the signal-to-noise ratios for the different sensors. Alternatively, the weighting can be altered in order to improve the quality of the resulting location estimate as indicated by the calculated angle between the metabearing lines. These are considered independent aspects of the invention, which are preferably, but not necessarily, used in conjunction with the techniques described above for performing the calculation of object location. 
     
    
     
       BRIEF DESCRIPTION OF THE DRAWINGS 
         [0055]    Arrangements embodying the invention will now be described by way of example with reference to the accompanying drawings, in which: 
           [0056]      FIG. 1  is an example of a sensor network utilized to localize an object P 0  and to which the present invention can be applied. 
           [0057]      FIG. 2  depicts an example showing how bearing lines can be represented. 
           [0058]      FIG. 3  illustrates a representation in the (p,θ)-space of a bearing line passing through point P 0 . 
           [0059]      FIG. 4  depicts examples of bearing lines passing through point P 0 . 
           [0060]      FIG. 5  comprises  FIG. 5   a , illustrating schematically the representation of a point P 0  in the xy-plane by an ellipse obtained by cutting a unit-radius cylinder by a plane, and  FIG. 5   b , showing one cycle of a cosine wave obtained from the ellipse by unfolding the surface of the cylinder. 
           [0061]      FIG. 6  shows four bearing lines and the acute angle between two metabearing lines. 
           [0062]      FIG. 7  is a functional block diagram of a topologic correlator constructed in accordance with the invention. 
           [0063]      FIG. 8  is a functional block diagram of a modified topologic correlator constructed in accordance with the invention. 
           [0064]      FIG. 9  is a functional block diagram of a topologic correlator constructed in accordance with the invention and capable of processing bearing lines determined by sensors with different signal-to-noise ratio. 
           [0065]      FIG. 10  is a functional block diagram of an example of a data fusion centre incorporating a topologic correlator constructed in accordance with the invention. 
           [0066]      FIG. 11 , comprising  FIGS. 11   a  and  11   b , depicts schematically examples of poor and more favourable ‘viewing’ geometry. 
       
    
    
     DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 
     First Embodiment 
       [0067]      FIG. 7  is a functional block diagram of a topologic correlator LOCOR constructed in accordance with the invention. The correlator comprises a data converter DCR, a quadrature generator QGR, three multipliers: PXS, SXC and PXC, two squarers: SXS and CXC, five averagers: AVQ, AVS, AVP, AVC and AVI, and an arithmetic/logic unit ALU. As in other embodiments described below, all individual units can readily be constructed from hardware and/or software by anyone skilled in the art, given an understanding of the required functionality as set out in the present specification. 
         [0068]    Bearing angles {β k ; k=1, 2, . . . , M} obtained from M sensors are applied to an input BA, whereas the known coordinates {(x Sk , y Sk ); k=1, 2, . . . , M} of the M sensors {Sk} are applied to inputs XS and YS of the converter DCR. 
         [0069]    The converter processes jointly, according to equation (2), bearing angles {β k } and sensor coordinates {(x Sk , y Sk )} to produce parameters {(p k , θ k )} which represent respective bearing lines in the (p,θ)-space. The values TH of θ k , appearing at output TH of the data converter DCR, are used by the quadrature generator QGR to produce at its respective outputs ST and CT values of sin θ k  and cos θ k . 
         [0070]    The values PP of p k , obtained at output PP of the data converter DCR, are multiplied in the multiplier PXS by the values ST of sin θ k , and the resulting products (p k  sin θk) are applied to input PS of the averager AVQ. Similarly, the values PP of Pk are multiplied in the multiplier PXC by the values CT of cos θ k , and the resulting products (p k  cos θ k ) are applied to input PC of the averager AVI. 
         [0071]    The values ST and CT of sin θ k  and cos θ k , supplied by the quadrature generator QGR, are also used by:
       the multiplier SXC, to produce values SC of products (sin θ k  cos θ k ) to drive input SC of the averager AVP;   the squarer SXS, to produce values SS of sin 2  θ k  to drive input SS of the averager AVS;   the squarer CXC, to produce values CC of cos 2  θ k  to drive input CC of the averager AVC.       
 
         [0075]    The values of averages Q, I, S, C and P are supplied by the respective averagers to the arithmetic/logic unit ALU that determines:
       1. the values X0 and Y0 of the coordinates (x 0 , y 0 ) of an object location, according to equation (8);   2. the value LX of the metabearing intersection angle ξ, according to equation (9); the value LX is indicative of the ‘goodness’ of the ‘viewing’ geometry.       
 
         [0078]    The values X0, Y0 and LX are produced by the ALU at its respective outputs. 
       Second Embodiment 
       [0079]    Making use of the trigonometric identities
       2 sin θ cos θ=sin 2θ, 2 cos 2  θ=1+cos 2θ, 2 sin 2 θ=1−cos 2θ
 
leads to a significant modification of the topologic correlator LOCOR constructed in accordance with the method of the invention. Now, the three auxiliary averages, S, C and P, can be determined from
       
 
         [0000]    
       
         
           
             
               
                 
                   
                     S 
                     = 
                     
                       
                         1 
                         - 
                         CC 
                       
                       2 
                     
                   
                   , 
                   
                       
                   
                    
                   
                     C 
                     = 
                     
                       
                         1 
                         + 
                         CC 
                       
                       2 
                     
                   
                   , 
                   
                       
                   
                    
                   
                     P 
                     = 
                     
                       SS 
                       2 
                     
                   
                 
               
               
                 
                   ( 
                   10 
                   ) 
                 
               
             
           
         
       
     
         [0000]    where 
         [0000]    
       
         
           
             
               CC 
                
               
                   
               
                
               
                 Δ 
                 _ 
               
                
               
                 1 
                 M 
               
                
               
                 
                   ∑ 
                   
                     k 
                     = 
                     1 
                   
                   M 
                 
                  
                 
                   cos 
                    
                   
                       
                   
                    
                   2 
                    
                   
                     θ 
                     k 
                   
                 
               
             
             , 
             
                 
             
              
             
               SS 
                
               
                   
               
                
               
                 Δ 
                 _ 
               
                
               
                 1 
                 M 
               
                
               
                 
                   ∑ 
                   
                     k 
                     = 
                     1 
                   
                   M 
                 
                  
                 
                   cos 
                    
                   
                       
                   
                    
                   2 
                    
                   
                     θ 
                     k 
                   
                 
               
             
           
         
       
     
         [0000]    In this implementation, no squaring circuits are needed, and the three auxiliary averages, S, C and P, can be obtained by employing only two averagers: one for cos 2θ k  and one for sin 2θ k . 
         [0081]      FIG. 8  is a functional block diagram of a modified topologic correlator LOCOR constructed in accordance with this embodiment of the invention. The correlator comprises a data converter DCR, a vector generator VCG, a quadrature generator QGR, four averagers: AVQ, AVI, AVS 2  and AVC 2 , and an arithmetic/logic unit ALU. 
         [0082]    Bearing angles {β k ; k=1, 2, . . . , M} obtained from M sensors are applied to input BA, whereas the known coordinates {(x Sk , y Sk ); k=1, 2, . . . , M} of the M sensors {Sk} are applied to inputs XS and YS of the converter DCR. The converter processes jointly, according to equation (2), bearing angles {β k } and sensor coordinates {(x Sk , y Sk )} to produce parameters {(p k , θ k )} which represent respective bearing lines in the (p,θ)-space. 
         [0083]    The values TH of θ k , appearing at output TH of the data converter DCR, are used by the quadrature generator QGR to produce at its respective outputs S 2  and C 2  values of sin 2θ k  and cos 2θ k . The values appearing at outputs S 2  and C 2  are applied, respectively, to averagers AVS 2  and AVC 2 . 
         [0084]    The vector generator VCG produces directly at its two outputs, PS and PC, products (p k  sin θ k ) and (p k  cos θ k ) in response to values PP of p k  and values TH of θ k  supplied by the data converter DCR at its respective outputs PP and TH. 
         [0085]    The values appearing at outputs PS and PC are applied, respectively, to averagers AVQ and AVI. 
         [0086]    The values of averagers Q, I, SS and CC are supplied by the respective averagers to the arithmetic/logic unit ALU that determines:
       1. the values X0 and Y0 of the coordinates (x 0 , y 0 ) of an object location, according to equations (8) and (10);   2. the value LX of the metabearing intersection angle ξ, according to equations (9) and (10); the value LX is indicative of the ‘goodness’ of the ‘viewing’ geometry.       
 
         [0089]    The values X0, Y0 and LX are produced by the ALU at its respective outputs. 
       Third Embodiment 
       [0090]    In many practical cases, some information may be available regarding the accuracy with which the bearing angles {β k ; k=1, 2, . . . , M} have been estimated. For example, each sensor Sk may supply a value g k  of the observed signal-to-noise ratio (SNR) that affects the accuracy of angle determination. Such information can be utilized by arrangements of the present invention as follows:
       1. The observed values g k  of the signal-to-noise ratio are compared to a set of predetermined thresholds to form a number N of classes, each class being characterized by a different range of the SNR values. For example, three classes may be formed to indicate bearing observations at low SNR, moderate SNR or high SNR.   2. Parameters (p k , θ k ) obtained from reported bearing angles β k  and known sensor locations (x Sk , y Sk ) are used to form N groups. The parameters (p k , θ k ) will belong to the same group if the associated values g k  of the signal-to-noise ratio fall into the same range of SNR values. For example, three groups may be formed; each group will comprise parameters obtained for the same range (low, moderate or high) of the SNR.   3. The parameters (p k , θ k ) within each group are then utilized to determine the coordinates (x 0 , y 0 ) of the point P 0 . As a result, there will be the same number N of coordinate pairs (x 0 , y 0 ) as the number of groups. For example, in the case of three groups (i.e., three ranges of SNR values), the determined coordinates will be:
           (x 0 , y 0 ) low , (x 0 , y 0 ) moderate , (x 0 , y 0 ) high      
           4. The coordinates determined within each of N groups are then combined as follows:       
 
         [0000]    
       
         
           
             
               
                 x 
                 0 
               
               = 
               
                 
                   1 
                   W 
                 
                  
                 
                   
                     ∑ 
                     
                       i 
                       = 
                       1 
                     
                     N 
                   
                    
                   
                     
                       w 
                       i 
                     
                      
                     
                       x 
                       0 
                       
                         ( 
                         i 
                         ) 
                       
                     
                   
                 
               
             
             , 
             
                 
             
              
             
               
                 y 
                 0 
               
               = 
               
                 
                   1 
                   W 
                 
                  
                 
                   
                     ∑ 
                     
                       i 
                       = 
                       1 
                     
                     N 
                   
                    
                   
                     
                       w 
                       i 
                     
                      
                     
                       y 
                       0 
                       
                         ( 
                         i 
                         ) 
                       
                     
                   
                 
               
             
           
         
       
     
         [0000]    where 
         [0000]    
       
         
           
             
               
                 w 
                 i 
               
               = 
               
                 
                   L 
                   i 
                 
                  
                 
                   g 
                   i 
                 
               
             
             , 
             
                 
             
              
             
               
                 
                   ∑ 
                   
                     i 
                     = 
                     1 
                   
                   N 
                 
                  
                 
                   w 
                   i 
                 
               
               = 
               W 
             
           
         
       
     
         [0000]    where x 0   (i) , y 0   (i)  are the calculated coordinates x 0 , y 0  for each respective group i, L i  is the number of observations falling in group i, and g i  is the average SNR for that group. Therefore, the product L i g i  can be viewed as a total average power received by sensors belonging to the same group i, where i=1, 2, . . . , N. 
         [0096]    As will be explained in more detail below, a similar averaging procedure may be applied to angles {ξ}. 
         [0097]      FIG. 9  is a functional block diagram of a topologic correlator LOCOR constructed in accordance with the invention. The correlator comprises a data converter DCR, a vector generator VCG, a quadrature generator QGR, four blocks of averagers: AVQ, AVI, AVS 2  and AVC 2 , and an arithmetic/logic unit ALU. 
         [0098]    Bearing angles {β k ; k=1, 2, . . . , M} together with values of the signal-to-noise ratio {g k ; k=1, 2, . . . , M} are applied to inputs BA and SNR, respectively, whereas the known coordinates {(x Sk , y Sk ); k=1, 2, . . . , M} of the M sensors {Sk} are applied to inputs XS and YS of the data converter DCR. 
         [0099]    The data converter DCR processes jointly, according to equation (2), bearing angles {β k } and sensor coordinates {(x Sk , y Sk )} to produce parameters {(p k , θ k )} which represent respective bearing lines in the (p,θ)-space. 
         [0100]    For each pair of parameters (p k , θ k ), the data converter DCR determines a group index ID depending on the value of the signal-to-noise ratio g k  associated with the underlying bearing angle β k . The group index ID is an integer number, and its value is determined as follows:
       ID=0, if g i &lt;SNR th0 , observation discarded   ID=1, if SNR th0 &lt;g i &lt;SNR th1 , low-SNR observation   ID=2, if SNR th1 &lt;g i &lt;SNR th2 , moderate-SNR observation   ID=3, if g i &gt;SNR th2 , high-SNR observation
 
where SNR th0 , SNR th1  and SNR th2  are some predetermined suitably chosen threshold values.
       
 
         [0105]    The values TH of θ k , appearing at output TH of the data converter DCR, are used by the quadrature generator QGR to produce at its respective outputs S 2  and C 2  values of sin 2θ k  and cos 2θ k . The values appearing at outputs S 2  and C 2  are applied, respectively, to two blocks of averagers, AVS 2  and AVC 2 . 
         [0106]    The vector generator VCG produces directly at its two outputs, PS and PC, products (p k  sin θ k ) and (p k  cos θ k ) in response to values PP of p k  and values TH of θ k  supplied by the data converter DCR at its respective outputs PP and TH. The values appearing at outputs PS and PC are applied, respectively, to two blocks of averagers AVQ and AVI. 
         [0107]    Each of the four blocks of averagers, AVQ, AV 1 , AVS 2  and AVC 2 , comprises three identical averagers, each corresponding to a specific (non-zero) value of the group index ID. A specific averager within each group will be assigned to the respective data input (PS, SS, S 2  or C 2 ) depending on the value of the index ID associated with the underlying bearing angle β k . As a result, each of four blocks of averagers has three outputs, each output corresponding to a different value of group index ID. 
         [0108]    The four output values, Q, I, SS and CC, supplied by the averagers with the same (non-zero) index ID=i, where i=1, 2, 3, are utilized by the arithmetic/logic unit ALU to determine the coordinates (x 0   (i) , y 0   (i) ) from 
         [0000]    
       
         
           
             
               
                 x 
                 0 
                 
                   ( 
                   i 
                   ) 
                 
               
               = 
               
                 
                   
                     
                       I 
                       
                         ( 
                         i 
                         ) 
                       
                     
                      
                     
                       S 
                       
                         ( 
                         i 
                         ) 
                       
                     
                   
                   - 
                   
                     
                       Q 
                       
                         ( 
                         i 
                         ) 
                       
                     
                      
                     
                       P 
                       
                         ( 
                         i 
                         ) 
                       
                     
                   
                 
                 
                   
                     
                       S 
                       
                         ( 
                         i 
                         ) 
                       
                     
                      
                     
                       C 
                       
                         ( 
                         i 
                         ) 
                       
                     
                   
                   - 
                   
                     
                       [ 
                       
                         P 
                         
                           ( 
                           i 
                           ) 
                         
                       
                       ] 
                     
                     2 
                   
                 
               
             
             , 
             
                 
             
              
             
               
                 y 
                 0 
                 
                   ( 
                   i 
                   ) 
                 
               
               = 
               
                 
                   
                     
                       Q 
                       
                         ( 
                         i 
                         ) 
                       
                     
                      
                     
                       C 
                       
                         ( 
                         i 
                         ) 
                       
                     
                   
                   - 
                   
                     
                       I 
                       
                         ( 
                         i 
                         ) 
                       
                     
                      
                     
                       P 
                       
                         ( 
                         i 
                         ) 
                       
                     
                   
                 
                 
                   
                     
                       S 
                       
                         ( 
                         i 
                         ) 
                       
                     
                      
                     
                       C 
                       
                         ( 
                         i 
                         ) 
                       
                     
                   
                   - 
                   
                     
                       [ 
                       
                         P 
                         
                           ( 
                           i 
                           ) 
                         
                       
                       ] 
                     
                     2 
                   
                 
               
             
           
         
       
     
         [0109]    Finally, the resulting coordinates (x 0 , y 0 ) of an object being localized are determined by combining the coordinates {(x 0   (i) , y 0   (i) ); i=1, 2, 3} as follows 
         [0000]    
       
         
           
             
               
                 x 
                 0 
               
               = 
               
                 
                   
                     
                       w 
                       1 
                     
                      
                     
                       x 
                       0 
                       
                         ( 
                         1 
                         ) 
                       
                     
                   
                   + 
                   
                     
                       w 
                       2 
                     
                      
                     
                       x 
                       0 
                       
                         ( 
                         2 
                         ) 
                       
                     
                   
                   + 
                   
                     
                       w 
                       3 
                     
                      
                     
                       x 
                       0 
                       
                         ( 
                         3 
                         ) 
                       
                     
                   
                 
                 W 
               
             
             , 
             
                 
             
              
             
               
                 y 
                 0 
               
               = 
               
                 
                   
                     
                       w 
                       1 
                     
                      
                     
                       y 
                       0 
                       
                         ( 
                         1 
                         ) 
                       
                     
                   
                   + 
                   
                     
                       w 
                       2 
                     
                      
                     
                       y 
                       0 
                       
                         ( 
                         2 
                         ) 
                       
                     
                   
                   + 
                   
                     
                       w 
                       3 
                     
                      
                     
                       y 
                       0 
                       
                         ( 
                         3 
                         ) 
                       
                     
                   
                 
                 W 
               
             
           
         
       
     
         [0000]    with W=w 1 +w 2 +w 3 , and w 1 =L 1  G 1 , w 2 =L 2  G 2 , and w 3 =L 3  G 3 , where L 1 , L 2  and L 3  are the numbers of observations falling respectively into groups  1 ,  2  and  3 , and G 1 , G 2  and G 3  are the average signal-to-noise ratios assigned to each corresponding group. 
         [0110]    As a result, each weight w i =Li Gi, i=1, 2, 3, can be viewed as a total average power received by sensors belonging to the same group. Also, the sum W of all the weights w i  is indicative of the total power received by the sensors employed for localization. The value W appears at the output TP of the arithmetic/logic unit ALU. 
         [0111]    In a similar fashion, the four output values, Q, I, SS and CC, supplied by the averagers with the same (non-zero) index ID=i, where i=1, 2, 3, may be utilized by the arithmetic/logic unit ALU to determine the intersection angles ξ (i)  from 
         [0000]    
       
         
           
             
               
                 ξ 
                 
                   ( 
                   i 
                   ) 
                 
               
               = 
               
                 arctan 
                  
                 
                    
                   
                     
                       
                         
                           S 
                           
                             ( 
                             i 
                             ) 
                           
                         
                          
                         
                           C 
                           
                             ( 
                             i 
                             ) 
                           
                         
                       
                       - 
                       
                         
                           [ 
                           
                             P 
                             
                               ( 
                               i 
                               ) 
                             
                           
                           ] 
                         
                         2 
                       
                     
                     
                       P 
                       
                         ( 
                         i 
                         ) 
                       
                     
                   
                    
                 
               
             
             , 
             
                 
             
              
             
               i 
               = 
               1 
             
             , 
             2 
             , 
             3 
           
         
       
     
         [0112]    Then, the angles are combined as follows 
         [0000]    
       
         
           
             ξ 
             = 
             
               
                 
                   
                     w 
                     1 
                   
                    
                   
                     ξ 
                     
                       ( 
                       1 
                       ) 
                     
                   
                 
                 + 
                 
                   
                     w 
                     2 
                   
                    
                   
                     ξ 
                     
                       ( 
                       2 
                       ) 
                     
                   
                 
                 + 
                 
                   
                     w 
                     3 
                   
                    
                   
                     ξ 
                     
                       ( 
                       3 
                       ) 
                     
                   
                 
               
               W 
             
           
         
       
     
         [0000]    with W=w 1 +w 2 +w 3 , and w 1 =L 1  G 1 , w 2 =L 2  G 2 , and w 3 =L 3  G 3 , where L 1 , L 2  and L 3  are the numbers of observations falling respectively into groups  1 ,  2  and  3 , and G 1 , G 2  and G 3  are the average signal-to-noise ratios allocated to each corresponding group. The value LX of the average angle ξ appears at the output LX of the arithmetic/logic unit ALU. 
         [0113]    The value LX indicates the quality of the estimate of the object location, based on the relative positions of the sensors and the object. If desired a suitable algorithm could be used to vary the weighting in accordance with the calculated value LX in order to improve the quality. In this situation the weighting would thus be a function of both (i) the SNR values for the respective sensors and (ii) their locations relative to each other and to the object. The weighting could instead be based on either one of these factors or on any other factor or combination of factors. 
         [0114]    In some cases, it may be preferable not to apply angle averaging but utilize the determined angle values ξ (i)  for further processing. 
         [0000]    Example of Incorporating a Topologic Correlator LOCOR into a Data Fusion Centre 
         [0115]      FIG. 10  is functional block diagram of a data fusion centre DFC incorporating a topologic correlator LOCOR constructed in accordance with the invention. The data fusion centre comprises a transceiver TRX, a topologic correlator LOCOR and a control/arithmetic/logic unit CAL. For the illustrative purposes, it is assumed that the third embodiment described above is employed as the correlator LOCOR, though with appropriate modifications either of the other embodiments could be used instead. 
         [0116]    The control/arithmetic/logic unit CAL interrogates via the transceiver TRX a selected group of sensors {S} to obtain from them information on determined bearing angles and registered signal-to-noise ratios. This information, together with sensor coordinates, is passed to the topologic correlator LOCOR via internal links BA, SN, YS and XS for further processing. 
         [0117]    The correlator LOCOR determines the object location, the total power of signals received by the sensors and the angle of intersection of metabearing lines. This information is sent to the unit CAL via internal links X0, Y0, TP and LX. 
         [0118]    In bearings-only object localization, the selection of a group of sensors by the DFC for surveillance purposes could be based on two main criteria:
       1. a sufficiently high level of power of signals intercepted by the group;   2. a favourable ‘viewing geometry’ of an object under surveillance, as determined by measuring the angle ξ of intersection of metabearing lines.       
 
         [0121]    Therefore, if the control/arithmetic/logic unit CAL decides that the total power is too low and/or the ‘viewing geometry’ is not favourable, it will attempt to form a new group of sensors. Some ‘old’ sensors may be retained and new sensors may be added. Then, the performance of the new group will be assessed on the basis of the total received power and the ‘viewing’ geometry. As an example, the ‘viewing’ geometry depicted in  FIG. 11   a  is poor, whereas the ‘viewing’ geometry obtained by replacing sensor S 3  by sensor S 6  is more favourable, as seen from  FIG. 11   b.    
         [0122]    In the preceding discussion, the SNR values of the sensors are used to indicate the quality of the bearing measurements and hence they form bearing error values used for weighting the effect of the bearing measurement and/or the selection of sub-sets of sensors. However, other factors could be used instead of or as well as the SNR values (for example values representing potential quantisation errors). 
         [0123]    The foregoing description of preferred embodiments of the invention has been presented for the purpose of illustration and description. It is not intended to be exhaustive or to limit the invention to the precise form disclosed. In light of the foregoing description, it is evident that many alterations, modifications, and variations will enable those skilled in the art to utilize the invention in various embodiments suited to the particular use contemplated.