Abstract:
Described herein is a method for determining the position of one vehicle with respect to another vehicle, in which the position of one vehicle with respect to the others is determined using counter means and short-range radio systems that provide for exchange of electromagnetic signals between the vehicles when these are within a pre-set range of coverage, on the basis of the calculation of the distance between the vehicles and the measurement of the their displacements in successive time intervals made by means of odometers, compasses and inclinometers.

Description:
BACKGROUND OF THE INVENTION  
       [0001]     1. Field of the Invention  
         [0002]     The present invention relates to a method for determining the position of one vehicle with respect to another vehicle, in particular for motor vehicles.  
         [0003]     2. Technical Background  
         [0004]     As is known, methods have been proposed for determining the position of one vehicle with respect to another vehicle which use technologies of a radar type, or of a satellite-location type. The use of radar for applications in the automotive field presents high costs and not always adequate performance. Instead, unless costly systems are used, satellite location is unable to achieve the precision necessary for the applications that have the purpose of determining the position of one vehicle with respect to another vehicle.  
       BRIEF SUMMARY OF THE INVENTION  
       [0005]     The purpose of the present invention is to provide a method for determining the position of one vehicle with respect to another vehicle, in particular for motor vehicles, which will be extremely simple and will not require complex technologies for its implementation.  
         [0006]     The foregoing purpose is achieved by the present invention in so far as it relates to a method for determining the position of one vehicle with respect to another vehicle, characterized in that it comprises the steps of:  
         [0007]     calculating the distance do between a first and a second vehicle at an instant T 0 ;  
         [0008]     measuring the displacement of the first vehicle with respect to a reference system having its origin at the point where the first vehicle is located at the instant T 0  by detecting the position x r1 , y r1 , z r1  of the vehicle at an instant T 1 ;  
         [0009]     measuring the displacement of the second vehicle with respect to a reference system having its origin at the point where the second vehicle is located at the instant T 0  by detecting the position x s1 , y s1 , z s1  of the vehicle at the instant T 1 ;  
         [0010]     calculating the distance d 1  between the first vehicle and the second vehicle at the instant T 1 ;  
         [0011]     measuring the displacement of the first vehicle with respect to the reference system with its origin at the point where the first vehicle is located at the instant T 0  by detecting the position x r2 , y r2 , z r2  of the vehicle at an instant T 2 ;  
         [0012]     measuring the displacement of the second vehicle with respect to the reference system having its origin at the point where the second vehicle is located at the instant T 0  by detecting the position x s2 ,y s2 ,z s2  of the vehicle at the instant T 2 ; and  
         [0013]     calculating the distance d 2  between the first vehicle and the second vehicle at the instant T 2  and using the information regarding the distances and the positions to determine the position of one vehicle with respect to the other vehicle. 
     
    
     BRIEF DESCRIPTION OF THE DRAWINGS  
       [0014]     The invention will now be illustrated with particular reference to the attached plate of drawings, which represent a preferred non-limiting embodiment thereof and in which:  
         [0015]      FIG. 1  is a schematic illustration of a system for determining the position of vehicles, in particular motor vehicles, which uses the method according to the present invention;  
         [0016]      FIGS. 2   a  and  2   b  illustrate steps of the method according to the present invention regarding the calculation of the position, between two vehicles, of one vehicle with respect to the other;  
         [0017]      FIG. 3  illustrates the method used in the present invention for the calculation of the distance between two vehicles;  
         [0018]      FIG. 4  shows a reference system in which the quantities that describe the displacement of a vehicle are given; and  
         [0019]      FIG. 5  illustrates considerations of a geometrical nature, on the basis of which the position of one vehicle with respect to the other is calculated using the method according to the present invention through the measurements of the distances and of the displacements. 
     
    
     DETAILED DESCRIPTION OF THE INVENTION  
       [0020]     Designated, as a whole, by  1  in  FIG. 1  is a system for determining the position of one vehicle with respect to another vehicle which uses the method according to the present invention.  
         [0021]     In the example illustrated—for simplicity of description—two vehicles are shown; it is in any case clear how said system functions with any number of vehicles.  
         [0022]     In particular, the system  1  comprises an electronic unit  2   a  set on board a first vehicle  3  (in particular a motor vehicle) and an electronic unit  2   b  set on board a second vehicle  4  (in particular a motor vehicle).  
         [0023]     Each electronic unit  2   a ,  2   b  is provided with a short-range radio-communication system  5   a ,  5   b  (of a known type) designed to transmit in a continuous way a recognition signal of a pre-set type and designed to recognize said reference signal when it is transmitted by another vehicle.  
         [0024]      FIGS. 2   a  and  2   b  illustrate the steps of the method according the present invention regarding the calculation of the position of one vehicle with respect to the other.  
         [0025]     Initially, the electronic unit  2   a  of the first vehicle sends an identification signal (block  100 ) by means of the short-range radio-communication system  5   a,  which uses an appropriate communication channel and at the same time sets itself in a state for awaiting equivalent signals arriving in response from the short-range communication system of another vehicle. This procedure can be started also between a number of pairs of vehicles simultaneously.  
         [0026]     At the moment when a second vehicle receives said identification signal (block  110 ), it starts a procedure of recognition (block  120 ) designed to verify whether the first vehicle has already been previously located.  
         [0027]     If the vehicle has already been identified, the location procedure is interrupted. If, instead, the vehicle has not yet been identified, the second vehicle sends an identification signal (block  130 ) to the first vehicle, which, in the case where the signal of identification of the second vehicle has been received (block  140 ), it sends a sync request to the second vehicle (block  150 ) for execution of a first measurement of distance and displacement.  
         [0028]     In the case where the identification signal sent by the second vehicle has not been received, the first vehicle restarts the identification procedure (blocks  100 ,  140 ).  
         [0029]     Following upon recognition of the sync signal on the part of the second vehicle (block  160 ), a signal indicating that synchronization has occurred is transmitted (output YES from block  160 ), and the block  160  is followed by a block  170 , which calculates (with modalities that will be clarified in what follows) the distance d 0  between the two vehicles at the instant of synchronization T 0 . The value measured of the distance d 0  is stored.  
         [0030]     In the case where the sync signal has not been recognized (output NO from block  160 ) said block is followed by the block  150 , which repeats the attempt to synchronize.  
         [0031]     Following upon synchronization, the first vehicle (block  180 ) starts to measure its own three-dimensional displacement x r1 ,y r1 ,z r1  with respect to a Cartesian reference system having its origin at the point where the first vehicle is located at the instant of synchronization T 0 , with the axis X oriented towards the north and the axis Y oriented towards the west. As will be explained more clearly in what follows, to be able to perform the measurement of the displacement, the vehicle is provided with a compass, an odometer and an inclinometer. Simultaneously with the operations of block  180 , the second vehicle (block  190 ) starts to measure its own three-dimensional displacement x s1 ,y s1 ,z s1  with respect to a cartesian reference system having its origin at the point where the second vehicle is located at the instant of synchronization T 0 , with the axis X oriented towards the north and the axis Y oriented towards the west.  
         [0032]     Also in this case, to be able to perform the measurement of the displacement, the vehicle must be provided with a compass, an odometer and an inclinometer.  
         [0033]     The two reference systems consequently each have axes X, Y and Z that are respectively parallel; i.e., the two reference systems have the same orientation.  
         [0034]     The measurement of the displacement is carried out by the two vehicles for a pre-set time interval T 1 -T 0 , and at the instant T 1  the values of displacement x r1 ,y r1 ,z r1  and x s1 ,y s1 ,z s1  measured are read and stored. There is thus detected the positions x r1 ,y r1 ,z r1  and x s1 ,y s1 ,z s1  of the vehicles at the instant T 1 .  
         [0035]     At the end of the operations of the blocks  180 ,  190 , the first vehicle sends to the second vehicle a second sync request (block  200 ) in order to be able to perform a second calculation of the distance d 1  at the instant T 1 .  
         [0036]     After it has synchronized with the second vehicle, (block  210 ), the first vehicle calculates the distance d 1  between the vehicles at the instant T 1  (block  220 ). The value measured of the distance d 1  is stored.  
         [0037]     The block  220  is followed by a block  230 , which performs the measurement of the three-dimensional displacement x r2 ,y r2 ,z r2  of the first vehicle with respect to the cartesian reference system, which again has its origin at the point where the first vehicle is located at the instant of synchronization T 0 .  
         [0038]     Simultaneously with the operations of block  230 , the second vehicle (block  240 ) measures its own three-dimensional displacement x s2 ,y s2 ,z s2  with respect to the cartesian reference system, which again has its origin at the point where the second vehicle is located at the instant T 0 .  
         [0039]     The measurement of the displacement is carried out by the two vehicles for a pre-set time interval T 2 -T 0 , and at the instant T 2  the values of displacement x r2 ,y r2 ,z r2  and x s2 ,y s2 ,z s2  measured are read and stored. There is thus detected the positions x r2 ,y r2 ,z r2  and x s2 ,y s2 ,z s2  of the vehicles at the instant T 2 .  
         [0040]     The blocks  230 ,  240  are followed by a block  250  that carries out calculation of the distance d 2  between the two vehicles at the instant T 2 . Also in this case, the value calculated of the distance d 2  is stored.  
         [0041]     The block  250  is followed by a block  260 , which asks the second vehicle for the results of the calculations performed in the previous measurements (block  260 ), i.e., the positions x s1 ,y s1 ,z s1  and x s2 ,y s2 ,z s2 .  
         [0042]     Said results are transmitted by a block  270 . Upon receipt of the results, a block  280  calculates the position of each vehicle with respect to the other according to the three distances measured d 0 , d 1 , and d 2  and to the positions, x r1 ,y r1 ,z r1 , x r2 ,y r2 ,z r2 , x s1 ,y s1 ,z s1  and x s2 ,y s2 ,z s2  detected at the instants T 1  and T 2 . In particular, in the preferred example of embodiment there is solved a system of equations of the type: 
 
 x   2   +y   2   +z   2   =d   0  
 
(x−x 1 ) 2 +( y−y   1 ) 2 +( z−z   1 ) 2   =d   1  
 
( x−x   2 ) 2 +( y−y   2 ) 2 +( z−z   2 ) 2   =d   2  
 
 where: 
 
 x   1   =x   r1   −x   s1   x   2   =x   r2   −x   s2  
 
 y   1   =y   r1   −y   s1   y   2   =y   r2   −y   s2  
 
 z   1   =z   r1   −z   s1   z   2   =z   r2   −z   s2  
 
 which supplies at output the values x, y and z, which represent, in the reference system of the first vehicle, the position of the second vehicle with respect to the first vehicle at the instant T 0 . 
 
         [0043]     The solution of said system of equations (i.e., the position of each vehicle with respect to the other) is then sent by the first vehicle to the second vehicle (block  290 ), which, after receiving it, stores it (block  295 ).  
         [0044]     Illustrated in  FIG. 3  are the operations performed in the present invention for calculation of the distance between two vehicles.  
         [0045]     Initially, each electronic unit  2   a,    2   b  sends (block  300 ) a start-of-count signal by means of the short-range radio-communication system (block  310 ) and at the same instant starts an internal local counter (block  300 ), which counts the time Tc that has elapsed from sending of the start-of-count signal.  
         [0046]     Said start-of-count signal propagates, at a speed substantially equal to the speed of light, between the first vehicle and the second vehicle, and when received by the communication system of the second vehicle, controls activation (block  320 ) of an internal local counter designed to count for a pre-set time interval ΔTr.  
         [0047]     At the end of the pre-set time interval ΔTr (block  330 ), the electronic unit of the second vehicle sends, by means of the short-range communication system, an end-of-count signal (block  350 ) to the vehicle that has generated the start-of-count signal. Said end-of-count signal propagates, at a speed substantially equal to the speed of light, between the second vehicle and the first vehicle.  
         [0048]     The time interval ΔTr has the function of temporally separating the instants of reception and transmission of the signals of start and end of counting. In this way, it is possible to provide a simple device, in which the steps of transmission and reception of the signals must not be performed simultaneously.  
         [0049]     When the end-of-count signal is received by the electronic unit of the vehicle that has generated the start-of-count signal (block  340 ), the local counter is stopped (block  360 ), and the time interval Tc measured by the local counter, i.e., the time elapsing between the generation of the start-of-count signal and the receipt of the end-of-count signal is detected.  
         [0050]     Said time interval Tc is substantially equal to the pre-set time interval ΔTr increased by the time occupied for propagation from one vehicle to the other of the electromagnetic signal for start of counting and end of counting.  
         [0051]     At this point, the electronic unit (block  370 ) calculates the propagation time Tp of the electromagnetic signal as the difference between the time interval Tc (measured) and the pre-set time interval ΔTr (set), namely: 
 
 Tp=Tc−ΔTr−Td  
 
 where Td allows for the delays that are generated in the electronic unit  2   b  and in the short-range communication system  5   b.  
 
         [0052]     Finally (block  380 ), the distance D between the two vehicles is calculated as: 
 
D=Tp/2 C  
 
 where C is the speed of propagation of the electromagnetic signal (equal to the speed of light), and Tp is the propagation time. 
 
         [0053]     The propagation time Tp is divided by two to take into account the two-way path that the electromagnetic signal (start-of-count signal/end-of-count signal) covers between the two vehicles.  
         [0054]     With the system according to the present invention, it is not necessary to use very precise clocks on the systems on board the two vehicles, but it is sufficient to use very precise counters, for example ones made with quartz systems.  
         [0055]     With a nanosecond precision it is possible to make measurements with a spatial error of about 15 centimetres, which is adequate for many applications. The more precise the counter, the greater the precision of calculation of the distance.  
         [0056]     By using the short-range communication systems, both of the vehicles can indifferently perform the operations described in the flowchart of  FIG. 2 , i.e., each vehicle can indifferently generate the start-of-count signal or the end-of-count signal.  
         [0057]     The entire process can occur in very short time intervals, shorter than a ten millionth of a second. In this time interval, even though two vehicles cross one another at a very high speed, they don&#39;t move more than a fraction of millimetre.  
         [0058]     From the description of the steps that characterize the method of the present invention ( FIG. 2 ) it may be seen how, to obtain the position of one vehicle with respect to another, it is necessary to perform measurements that will provide data regarding the displacements made by the vehicles, in addition to the detection of the distance from one another in successive instants of time.  
         [0059]      FIG. 4  shows a Cartesian reference system in which there appear the quantities that describe the displacement made by a vehicle in a time interval, detected by an odometer, a compass and an inclinometer.  
         [0060]     In said reference system, the quantity s(t) describes the length of the displacement of the vehicle as a function of time; the quantity φ(t) is the angle, which represents the direction of the displacement made by a vehicle with respect to the axis X, oriented towards the north, on the plane (X, Y); the quantity θ(t) is the angle, which represents the slope of the stretch covered by the vehicle in the direction of the displacement with respect to the axis Z.  
         [0061]     Assuming that, for small displacements, the values of φ(t) and of θ(t) will remain unvaried (linearization), it is possible to describe the displacement of a vehicle at the instant t via the equations: 
 
Δ x ( t )=( s ( t+Δt )− s ( t ))sin θ( t )cos φ( t ) 
 
Δ y ( t )=( s ( t+Δt )− s ( t ))sin θ( t )sin φ( t ) 
 
Δ z ( t )=( s ( t+Δt )− s ( t ))cos θ( t ) 
 
         [0062]     The overall displacement of a vehicle in the time interval Δt=T 1 -T 0  can then be calculated by summing the individual displacements:  
             x   =       ∑     n   =   0       N   -   1       ⁢           ⁢       (       s   ⁡     (       T   0     +       (     n   +   1     )     ⁢   Δ   ⁢           ⁢   t       )       -     s   ⁡     (       T   0     +     (     n   ⁢           ⁢   Δ   ⁢           ⁢   t     )       )         )     ⁢     sin   ⁡     [     θ   ⁡     (       T   0     +     n   ⁢           ⁢   Δ   ⁢           ⁢   t       )       ]       ⁢     cos   ⁡     [     ϕ   ⁡     (       T   0     +     n   ⁢           ⁢   Δ   ⁢           ⁢   t       )       ]                       y   =       ∑     n   =   0       N   -   1       ⁢           ⁢       (       s   ⁡     (       T   0     +       (     n   +   1     )     ⁢   Δ   ⁢           ⁢   t       )       -     s   ⁡     (       T   0     +     (     n   ⁢           ⁢   Δ   ⁢           ⁢   t     )       )         )     ⁢     sin   ⁡     [     θ   ⁡     (       T   0     +     n   ⁢           ⁢   Δ   ⁢           ⁢   t       )       ]       ⁢     sin   ⁡     [     ϕ   ⁡     (       T   0     +     n   ⁢           ⁢   Δ   ⁢           ⁢   t       )       ]                       z   =       ∑     n   =   0       N   -   1       ⁢           ⁢       (       s   ⁡     (       T   0     +       (     n   +   1     )     ⁢   Δ   ⁢           ⁢   t       )       -     s   ⁡     (       T   0     +     (     n   ⁢           ⁢   Δ   ⁢           ⁢   t     )       )         )     ⁢     cos   ⁡     [     θ   ⁡     (       T   0     +     n   ⁢           ⁢   Δ   ⁢           ⁢   t       )       ]                     
 
 where N=(T 1 -T 0 )/Δt. 
 
         [0063]      FIG. 5  illustrates the considerations of a geometrical nature on the basis of which the position of one vehicle with respect to another is calculated with the method of the present invention using the measurements of the distances and of the displacements. In  FIG. 5  the position of one vehicle with respect to the other is obtained, assuming that the first vehicle is moving and that the second vehicle is stationary. In this case, the distance do between the two vehicles, calculated at the instant T 0  with the method described in the present invention, can be reduced to the mathematical equation: 
   d   0   =x   2   +y   2   +z   2    
         [0064]     Setting, in fact, the point in which the first vehicle is located at the instant T 0  as the origin of a cartesian reference system of co-ordinates X, Y, Z, there exists a locus of the points in which the second vehicle may be found with respect to the first, given precisely by a sphere with a radius equal to the distance d 0  calculated between the two vehicles at the instant T 0 . At the instant T 1 , following upon a displacement of the first vehicle, the second vehicle will be found in the locus of the points described by a second sphere of radius equal to the distance: 
 
 d   1 =( x−x   1 ) 2 +( y−y   1 ) 2 +( z−z   1 ) 2  
 
 calculated between the two vehicles at the instant T 1 . The first and second spheres intersect in two different points, which represent the two possible loci in which the second vehicle can be found with respect to the first at the instant T 1 . At the instant T 2  following upon a further displacement of the first vehicle and always assuming that the second vehicle is stationary, it is possible to obtain a third sphere with a radius equal to the distance: 
 
 d   2 =( x−x   2 ) 2 +( y−y   2 ) 2 +( z−z   2 ) 2  
 
 which describes the locus of the points in which the second vehicle can be found at the instant T 2 . As illustrated in  FIG. 5 , the three spheres intersect in a single point that coincides exactly with the position of the second vehicle that has at no time shifted with respect to the first. Said results are obtained from solving a system of equations containing the equations of the three spheres described above: 
 
 d   0   =x   2   +y   2   +z   2  
 
 d   1 =( x−x   1 ) 2 +( y−y   1 ) 2 +( z−z   1 ) 2  
 
 d   2 =( x−x   2 ) 2 +( y−y   2 ) 2 +( z−z   2 ) 2  
 
         [0065]     A system of equations of the above kind allows of a single solution, which corresponds precisely to the position of the second vehicle with respect to the first.  
         [0066]     Said result can be obtained also in the case where both of the vehicles are moving, on the condition that the respective reference systems, in which all the quantities that describe the displacements made by the vehicles are given and which have their origins in different points, are oriented exactly in the same way. Respect of said condition is guaranteed by the use of the inclinometer and the compass.  
         [0067]     In this case it is sufficient to subtract from the vectors that describe the overall absolute displacements made by the first vehicle and the second vehicle in the time interval T 2 -T 0  the vector that describes the overall absolute displacement made by the second vehicle in the time interval T 2 -T 0  and measured starting from the instant T 0 .  
         [0068]     In this way, the displacement made by the second vehicle is cancelled out, and the second vehicle can be considered as having returned to the initial position corresponding to the instant T 0 , whilst the first vehicle will be displaced into a fictitious point of co-ordinates obtained from the difference between the two displacement vectors.  
         [0069]     The system of equations of the type: 
 
 x   2   +y   2   +z   2   =d   0  
 
( x−x   1 ) 2 +( y−y   1 ) 2 +( z−z   1 ) 2   =d   1  
 
( x−x   2 ) 2 +( y−y   2 ) 2 +( z−z   2 ) 2   =d   2  
 
 where: 
 
 x   1   =x   r1   −x   s1   x   2   =x   r2   −x   s2  
 
 y   1   =y   r1   −y   s1   y   2   =y   r2   −y   s2  
 
 z   1   =z   r1   −z   s1   z   2   =z   r2   −z   s2  
 
 supplies at output the values x, y and z, which represent, in the reference system of the first vehicle, the position of the second vehicle with respect to the first at the instant T 0 .