SYSTEM AND METHOD FOR AVOIDANCE OF COLLISION BETWEEN VEHICLES

Abstract: A system and a method for avoidance of collision between vehicles, wherein a possible avoidance manoeuvre trajectory (Tr1, Tr2) for the respective vehicle is calculated and compared with the avoidance manoeuvre trajectories calculated for the other vehicles for controlling whether the avoidance manoeuvre trajectory of the vehicle in every moment during its calculated lapse is located at a stipulated minimum distance (d) from the avoidance manoeuvre trajectories of the other vehicles. A warning is presented to a person manoeuvring the vehicle and/or the vehicle is made to follow an avoidance manoeuvre trajectory previously calculated and stored for the vehicle if the comparison shows that the avoidance manoeuvre trajectory (Tr1, Tr2) of a vehicle in any moment during its calculated lapse is located at a distance from the avoidance manoeuvre trajectories of any of the other vehicles that is smaller than the stipulated minimum distance (d).

Description: SYSTEM AND METHOD FOR AVOIDANCE OF COLLISION BETWEEN VEHICLES FIELD OF THE INVENTION AND PRIOR ART The invention relates to a system and a method for avoidance of collision between vehicles. Collisions between fighting airplanes during air combat training is frequently occurring and are normally caused by a pilot lacking of attention, for instance due to attention being directed to radar reconnaissance or weapon adjustments. These collisions cause costly losses in the form of crashed fighting airplanes and, in the worst case, result in the loss of life of an involved pilot. Consequently, there is a great need of a reliable system for collision avoidance. Conventional collision avoidance systems are based on the idea to calculate the trajectories of the involved airplanes and predict a risk of collision with the aid thereof. Such a collision avoidance system, which primarily has been developed and used for civil air traffic, is known under the denomination TCAS ("Traffic alert and Collision Avoidance System"). Each airplane included by this system is provided with its own TCAS-device comprising inter alia a radio transponder. The radio transponder continuously transmits a radio signal and a radio transponder in another airplane, when receiving this radio signal, transmits a reply signal comprising data concerning the height of flight of the own airplane. The distance to the other airplane is obtained by measuring the time between transmitted and received signal and the bearing is obtained by means of a radio direction finder. By means of these values the TCAS-device continuously calculates and updates the flight trajectories for the TCAS-equipped airplanes located in the surroundings. If a flight trajectory calculated for another airplane is estimated to cross the planned flight trajectory of the own airplane, a warning is generated to the pilot at a moment with a predetermined time interval up to a so called "Closest Point of Approach". TCAS I I is a further developed system which besides giving the pilot a warning also suggests an avoidance manoeuvre direction. The avoidance manoeuvre directions are co-ordinated between the involved airplanes via radio link. TCAS gives a bad accuracy in the bearing values and many warnings are generated even when the airplanes can pass each other without any risk of collision. A collision avoidance system that gives many superfluous warnings implies an additional stress factor for the pilot, which is particularly inconvenient in air combat training when the pilot has a very high work load with many instruments and a large amount of data to handle under great pressure. During air combat training with flight manoeuvres that are difficult to predict and a close contact between the involved airplanes, the risk of superfluous warnings is as well larger than in commercial aviation. PURPOSE OF THE I NVENTION The purpose of the present invention is to provide a system and a method for collision avoidance, particularly for use in fighting airplanes, by means of which collisions between vehicles can be averted with a high reliability at the same time as collision warnings and/or automatic avoidance manoeu- vres are avoided to the utmost possible extent in the situations when the vehicles located in the vicinity of each other have a possibility to pass each other without any risk of collision. SUMMARY OF THE I NVENTION According to the invention, said purpose is achieved by means of a system according to claim 1 and a method according to claim 7. The system and the method according to the invention are based on the strategy to seek for a possible avoidance manoeuvre for the respective vehicle and present a warning to a person manoeuvring the vehicle and/or automatically execute the suitable avoidance manoeuvre just before the pos- sibility to perform this avoidance manoeuvre disappears, i.e. just before the involved vehicles are in such a position in relation to each other that a collision cannot be avoided with a satisfactory security. The collision avoidance system according to the invention is consequently restricted and a warning is generated and/or an automatic avoidance manoeuvre is performed only in case of an immediate risk of collision. According to a preferred embodiment of the invention, a cal- culated avoidance manoeuvre trajectory is represented by a number of three dimensional objects, such as spheres, each of which objects being assigned a certain time value, the dimension of the separate objects being dependent on the stipulated minimum distance between the avoidance ma- noeuvre trajectories. In this connection, it is controlled whether any of the geometrical object representing the avoidance manoeuvre trajectory of the vehicle is overlapping a geometrical object with corresponding time value included in the representation of the avoidance manoeuvre trajectories of any of the other vehicles. In this way it becomes possible to control in an easy way whether the cal- culated avoidance manoeuvre trajectories are located to close to each other. By making the dimension of the geometrical objects depend also on estimated errors of the calculated avoidance manoeuvre trajectories, an improved security against collisions caused by miscalculations is obtained. According to a preferred embodiment of the invention, the avoidance manoeuvre direction for the respective vehicle is determined based on the criteria that the completion points of the avoidance manoeuvre trajectories of the vehicles are to be at as large a distance from each other as possible. In this way, the appropriate avoidance manoeuvre directions can be calculated by means of a relatively simple model of calculation. BRIEF DESCRIPTION OF THE DRAWING With reference to the enclosed drawing, the invention will hereinbelow be more closely described by means of embodiment examples. It is shown in: Fig 1 schematically two airplanes equipped with a system according to the invention and an avoidance manoeuvre trajectory calculated for the respective airplane, Fig 2 a block diagram illustrating a system according to the invention, Fig 3 schematically an avoidance manoeuvre trajectory calculated for an airplane and represented by geometrical objects in the form of spheres, Fig 4 two overlapping spheres belonging to the avoidance manoeuvre trajectories of two different vehicles, Fig 5 a schematic illustration of certain parameters in- eluded in a co-ordinated calculation of avoidance manoeuvre directions, Fig 6 a schematic illustration of a collision situation, and Fig 7 a schematic illustration of an auxiliary parameter. DETAILED DESCRIPTION OF PREFERRED EMBODIMENTS Fig 1 schematically shows two airplanes F T and F 2 flying in the direction towards each other, which airplanes are equipped with a collision avoidance system according to the invention. The airplanes Fi and F 2 are provided with means 2, see Fig 2, for continuous calculation of a future position Pi , P 2 for the own airplane and means 4 for calculating, coordinated between the airplanes F 1 f F 2 , an avoidance manoeuvre direction Dj for the respective airplane. Based on this avoidance manoeuvre direction D, and the calculated future position P^ P 2 , an avoidance manoeuvre trajectory Tr-i , Tr 2 for the respective airplane F 1 ; F 2 is calculated by means of a means 6. In the calculation of the avoidance manoeuvre trajectories Tr<ι , Tr 2 a formula is utilized which can be made more or less complex depending on inter alia the accuracy desired in the system and the computer power that can be used. The means 4 utilizes this formula for the calculation of values representing a number of possible avoidance manoeuvre trajectories, with different directions, for the respective air- plane F^ F 2 in the calculated future position P 1 f P 2 . By means of a suitable method, an avoidance manoeuvre di- rection D, corresponding to one of the possible avoidance manoeuvre trajectories of the airplane is then determined by a selection among said values. One possible method for this will be described hereinbelow. Based on the obtained avoidance manoeuvre direction D h the calculating means 6 thereafter calculates the avoidance manoeuvre trajectories Tri , Tr 2 for the airplane by means of said formula. The respective airplane F^ F 2 is also provided with means 8 for controlling whether the avoidance manoeuvre trajectory Tr-i , Tr 2 calculated for the airplane F 1 ; F 2 in each moment during its calculated lapse is located at a stipulated minimum length distance d from the avoidance manoeuvre trajectories calculated for the other airplanes. If the control shows that this is the case, the data concerning the calculated avoidance manoeuvre trajectory Tr 1 ; Tr 2 is stored by means of a suitable storage means 10, whereupon a new future position P-i , P 2 for the airplane is calculated by the means 2 based on the present position of the airplane and the previous procedure is repeated. If, on the other hand, the control shows that the avoidance manoeuvre trajectory Tr-i , Tr 2 of the airplane in any moment during its calculated lapse is located at a distance from the avoidance manoeuvre trajectories of any of the other airplanes that is smaller than the stipulated minimum distance d, a means 12 is activated, which means 12 warns the pilot for the existing risk of collision. The stipulated minimum distance d corresponds to a prede- termined safety distance d safe , possibly supplemented with an error d error corresponding to an estimated maximum error of the calculated avoidance manoeuvre trajectory Tr 1 ; Tr 2 . The warning means 12 can be arranged to present the warning in the form of an acoustic signal and/or a light signal. Preferably, the warning means is also arranged to present an appropriate avoidance manoeuvre to the pilot, which avoidance manoeuvre is based on the last stored safe avoidance manoeuvre trajectory Tη , Tr 2 . The initial warning is presented a short time before the moment t av0 ιd when an avoidance manoeuvre based on the last stored safe avoidance manoeuvre trajectory Tη , Tr 2 has to be initiated in order to be able to avoid a collision with certainty. After the initial warning , the system continues to search after a safe avoidance manoeuvre trajectory Tr 1 : Tr 2 , in which connec- tion a new future position P 1 ; P 2 for the airplane is calculated by the means 2 based on the present position of the airplane and the previous process is repeated. If the control means 8 shows that a new safe avoidance manoeuvre trajectory Tr-, , Tr 2 has been found, for instance due to the fact that any of the airplanes since the previous cycle of calculation has performed such a manoeuvre that an immediate risk of collision is no longer existing , the warning means 12 is inactivated. In this case, the new safe avoidance manoeuvre trajectory Tn , Tr 2 is stored by the storage means 10 and a new cycle of calculation follows. If no new safe avoidance manoeuvre trajectory Tη , Tr 2 is found during the warning period, i.e. before the moment t a - vo i d , the system executes, via a calculation means 14, an automatic avoidance manoeuvre based on the last stored safe avoidance manoeuvre trajectory Tr 1 f Tr 2 . Said means 14 is arranged to calculate control parameters based on the stored avoidance manoeuvre trajectory Tr-i , Tr 2 , by means of which control parameters the airplane can be made to per- form an avoidance manoeuvre corresponding to the stored avoidance manoeuvre trajectory Tη , Tr 2 . The calculation means 14 supplies the calculated control parameters as inputs to the electronic flight manoeuvring system of the airplane, whereby the airplane can be made to perform the desired avoidance manoeuvre. I n this connection, the system is adapted in such a way that the automatic avoidance manoeuvre is initiated at the moment t avoid , which corresponds to the moment when the airplane is supposed to be in the calculated future position P-i , P 2 based on which the stored avoidance manoeuvre trajectory Tr-i , Tr 2 has been calculated. When the automatic avoidance manoeuvre has been performed , the control of the manoeuvring system of the airplane is returned to the pilot as soon as possible after the situation is safe again . The means 6 for calculation of the avoidance manoeuvre trajectories Tr-i , Tr 2 is suitably arranged to make a calculated avoidance manoeuvre trajectory be represented by a number of three dimensional geometrical objects S-ι-S 4 , which objects are arranged close to each other along the avoidance manoeuvre trajectory and each of which is assigned a certain time value T-r T 4 . In this connection, the object S T represents a volume of space in which the airplane is calculated to be located at the moment Tι , and so on. The dimension of the separate objects Sι-S 4 is adapted taking the safety distance d safe between the avoidance manoeuvre trajectories Tη , Tr 2 into account. In this connection, the control means 8 is arranged to control whether any of the geometrical objects Si-S 4 representing the avoidance manoeuvre trajectory Tr-i , Tr 2 of a vehicle overlaps a geometrical object with corresponding time value included in the representation of the avoidance manoeuvre trajectories of any of the other vehicles. The geometrical objects are preferably constituted by spheres, as shown in Figs 3 and 4, which gives a simple presentation of the avoidance manoeuvre trajectory since only the centre point, the radius r n and the time value T n of the respective sphere S π has to be determined. The number of spheres S n in the repre- sentation of the respective avoidance manoeuvre trajectory Tri , Tr 2 depends on the radius r n of the spheres S n and the length of the avoidance manoeuvre trajectory Tn , Tr 2 . In this connection , the radius r n of the respective sphere S n corresponds to d/2. Since there are many sources of error in the calculation of the avoidance manoeuvre directions D, and the avoidance manoeuvre trajectories Tri , Tr 2 , inter alia due to the unpredictable manoeuvres of the pilot, the avoidance manoeuvre trajectories Tr-i , Tr 2 should be presented in such a way that the errors in the calculated avoidance manoeuvre direction D, and avoidance ma- noeuvre trajectories Tn , Tr 2 do not affect the security of the system. This is suitably achieved in that the calculation means is arranged to adapt the dimension of said geometrical objects Si-S 4 taking estimated errors of the respective calculated avoidance manoeuvre trajectory Tn , Tr 2 into account. In case the objects consist of spheres, the radius r n of the respective sphere S n is in this connection determined by two components, the possible error d error and half the safety distance d safe /2, i.e. This is illustrated in Fig 4. In Fig 4 it also shown how two spheres with the same time values overlap each other. In this case, the system would consequently generate a warning to the pilot. The possible error d error corresponds to the estimated maximum error of the calculated avoidance manoeuvre trajectory Tn , Tr 2 . The error of the avoidance manoeuvre trajectory Tri , Tr 2 increases with the distance from its starting point Pi , P 2 and therefore the spheres S n will have a larger radius r π the further away from the starting point Pi , P 2 they are located, as shown in Fig 3. The respective sphere S n represents a volume of space in which the airplane with a certain probability will be located at a certain moment T n . The calculation of the avoidance manoeuvre trajectories Tri , Tr 2 is performed continuously at discrete moments t n . The time distance between two cycles of calculation has to be so short that two spheres S n with the same time value t π belonging to avoid- ance manoeuvre trajectories Tr-i , Tr 2 of different airplanes cannot "jump over" each other during the time between two cycles of calculation. Otherwise, two avoidance manoeuvre trajectories could overlap each other without being registered by the system . The maximum time distance between two updatings, i.e. between two cycles of calculation , depends on the relative velocity between the airplanes, the radius r n of the spheres and the maximum accepted overlapping between two spheres s n . A certain overlapping has to be accepted , since otherwise the time distance between two cycles of calculation would have to be infinitesimal . In the abovementioned calculation of the avoidance manoeuvre directions D-, it is important that the respective avoidance manoeuvre direction is so chosen that the solution to one critical situation of collision does not cause a new such situation . The avoidance manoeuvre directions D, of the airplanes therefore have to be co-ordinated with each other in some manner. It has appeared suitable to determine the avoidance manoeuvre direction D, for the respective airplane based on the criteria that the completion points Cι , C 2 (see Fig 1 ) of the avoidance manoeu- vre trajectories Tn , Tr 2 of the vehicles are to be at such a large distance from each other as possible. In this connection, it has also appeared that suitable avoidance manoeuvre directions D, are obtained by a minimization of the function where C, is the completion point of the avoidance manoeuvre trajectory Tr, for the vehicle i . The function f is consequently the sum of the inverted distance between the completion point C, of the avoidance manoeuvre trajectories Tn , Tr 2 of all airplanes. The values of C, are obtained by means of the formula used for the calculation of the avoidance manoeuvre trajectories Tn , Tr 2 . In Fig 5 the possible completion points C, of the possible avoidance manoeuvre trajectories Tr, of an airplane based on a certain calculated future position P are represented by an ellipse E. An avoidance manoeuvre should be as sharp as possible, and therefore the load factor imposed on the airplane during the avoidance manoeuvre should have as large a value as possible. The largest possible load factor can be applied in a direction in parallel with an axis Z B extending straight up through the airplane, see Fig 5. At the avoidance manoeuvre, the airplane should therefore suitably have a roll angle φ, being such that said axis Z B is directed in parallel with the avoidance manoeuvre direction D,. The completion point C, is a function of inter alia the roll angle φ, of the airplane at an avoidance manoeuvre based on the calculated avoidance manoeuvre trajectory Tr,, and by minimizing the function f with respect to the roll angle φ,, which roll angle in accordance with the reasoning above determines the avoidance manoeuvre direction D,, the combination of roll angles φ, and thereby avoidance manoeuvre directions D, that gives the largest possible distance between the completion points C, of the avoidance manoeuvre trajectories Tr, of the vehicles is obtained. The co-ordination of the avoidance manoeuvre directions D, should be independent of the communication between the air- planes and should consequently be performed separately in all airplanes. In order to avoid complications in case one and the same minimum value of the function f is obtained with several different combinations of values of roll angles φ,, the system can be adapted such that the means 4 for calculation of the avoid- ance manoeuvre direction in the respective airplane tests the different roll angle combinations in the same order and selects a certain combination of the possible several combinations that minimizes f according to a fixed priority. By utilizing the same priority in all airplanes, the means 4 in the different airplanes can consequently be made to select one and the same roll angle combination that minimizes the function f. The above described method for calculation of avoidance manoeuvre directions could give inappropriate results when the completion point C, of the avoidance manoeuvre trajectory Tr, of a first airplane passes the flight path of a second airplane at the same time as, in the same way, the completion point of the avoidance manoeuvre trajectory of the second airplane passes the flight path of the first airplane. This is illustrated in Fig 6, which shows two airplanes flying towards one and the same point in an angle of 90° in relation to each other. Cι ιt och C 2,t are the completion points of the avoidance manoeuvre trajectory of the respective airplane at the moment t, whereas C 1 ιt+dt och C 2 , t +dt are the corresponding completion points at the moment t+dt. When the respective calcu- lated completion point has passed the respective calculated flight path, the above described method in this specific case gives avoidance manoeuvre trajectories directed towards each other, with a great risk of collision as a result. This problem can be avoided by the introduction of an auxiliary point C Cι , (see Fig 7) and the formation of a condition for the geometry concerning the completion point C, and this auxiliary point C c ,. The auxiliary point according to the shown example is placed in line with the velocity vector v, of the airplane calculated for the future position P, in such a way that a right angle is formed between P,, C c , and C,. The above mentioned problem arises when C, is located closer than C c, , to P j at the same time as C j is located closer than C C j to P,. For a situation with n involved airplanes, n conditions are required. Each of these conditions comprises the following two inequalities: I! o.i — F > j || < n C, — R, i i At least one of these inequalities has to be satisfied for each condition. If the method for calculation of avoidance manoeuvre direction gives a solution that does not satisfy these conditions, this solution is rejected and an alternative solution is calculated. The collision avoidance system according to the invention requires that each airplane knows the avoidance manoeuvre trajectories calculated for the other airplanes. Furthermore, each airplane needs to have access to data from the other airplanes in order to be able to carry out the co-ordination of the avoidance manoeuvre directions. The calculation of the present and future position, velocity, roll angle etc for the own airplane is suitably carried out separately in each indi- vidual airplane. The values required for subsequent calculations are then communicated to and received from the other airplanes by means of a suitable communication means 16, for instance a radio communication system. The co-ordinated calculation of the avoidance manoeuvre directions is then carried out separately in the respective airplane. According to a first alternative, the calculation of the avoidance manoeuvre trajectories of all involved airplanes and the comparison control of these avoidance manoeuvre trajectories are thereafter carried out in each individual air- plane without any further data communication between the airplanes. According to a second alternative, the respective airplane only calculates its own avoidance manoeuvre trajectory, whereupon data representing the avoidance manoeuvre trajectory of the respective airplane via the com- munication means 16 is exchanged between the airplanes for the subsequent comparison control of the avoidance manoeuvre trajectories of all airplanes. The first alternative has the advantage that a relatively small data communication capacity is required, since only a relatively low amount of data has to be communicated between the airplanes. However, a large computer power is required in the individual airplane, since each airplane has to calculate the avoidance manoeuvre trajectories for all airplanes. Therefore, the first alternative is most suited for such systems that utilize a relatively simple model with few parameters for the calcula- tion of the avoidance manoeuvre trajectories. If a more complex model is utilized for the calculation of the avoidance manoeuvre trajectories, the other alternative is to be preferred, since the respective airplane in this case only calculates its own avoidance manoeuvre trajectory. How- ever, the second alternative requires a larger data communication capacity than the first. The second alternative has the advantage that redundancy is obtained in the system. If an airplane communicates data concerning an avoidance manoeuvre trajectory that turns out to be calculated in an- other direction than the direction to be expected according to the method for the co-ordinated calculation of the avoidance manoeuvre directions, an indication is namely obtained that an error has occurred somewhere in the system. For registration and calculation of present and future position and other parameters that are required for the calculation of avoidance manoeuvre direction and avoidance manoeuvre trajectory, such as present and future roll angle, velocity etc, suitable means and sensors of know type can be used. The collision avoidance system according to the invention has above been exemplified by an application in pilot manoeuvred airplanes. However, the system is not limited to this application, on the contrary it can be adapted for use in other types of aircrafts, for instance unmanned aircrafts, and can within the scope of the inventional idea also be adapted for use in other types of vehicles than aircrafts. Furthermore, it is possible, if considered suitable in any context, to design the system according to the invention in such a way that an automatic avoidance manoeuvre is exe- cuted in case of an established risk of collision without any preceding warning or in such a way that a warning is generated without a subsequent automatic avoidance manoeuvre.

Claims: Claims 1 . A system for avoidance of collision between vehicles, comprising means ( 16) for communication of data to and from the respective vehicle, characterized in that the system further comprises: - means (2) for continuous calculation of a future position (P l t P 2 ) for the respective vehicle, - means (4) for determining , co-ordinated between the vehicles, an avoidance manoeuvre direction (D,) for the respective vehicle, - means (6) for calculation of an avoidance manoeuvre trajectory (Tri , Tr 2 ) for the respective vehicle based on the calculated future position (Pi , P 2 ) and avoidance manoeuvre direction (D,) for the vehicle, - means (8) for controlling whether the avoidance manoeuvre trajectory (Tn , Tr 2 ), which has been calculated for the respective vehicle, in each moment during its calculated lapse is located at a stipulated minimum distance (d) from the avoidance manoeuvre trajectories calculated for the other vehicles, - means (10) for storing data concerning the avoidance manoeuvre trajectory (Tn , Tr 2 ) of a vehicle if the control shows that this trajectory in each moment during its calculated lapse is located at the stipulated minimum distance (d) from the avoidance ma- noeuvre trajectories of the other vehicles, and - means (12, 14) for, in case the control shows that the avoidance manoeuvre trajectory (Tri , Tr 2 ) of a vehicle in any moment during its calculated lapse is located at a distance from the avoidance manoeuvre trajectory of any of the other vehicles that is smaller than the stipulated minimum distance (d), presenting a warning to a person manoeuvring the vehicle that a risk of collision exists and/or making the vehicle follow an avoidance manoeuvre trajectory previously calculated and stored for this vehicle. 2. A system according to claim 1 , characterized in that the system comprises means (2) in the respective vehicle for calculation of a future position (Pi ) for the vehicle, the communication means ( 16) being arranged to communicate data concerning the calculated future position (Pi ) to each of the other vehicles and to receive data from each of the other vehicles concerning the calculated future position (P 2 ) of the respective vehicle. 3. A system according to any of the preceding claims, charac- terized in that the system comprises means (14) in the respective vehicle for automatically making the vehicle follow an avoidance manoeuvre trajectory (Tn , Tr 2 ) previously calculated and stored for the vehicle, which means (14) is arranged, with the aid of the stored avoidance manoeuvre trajectory (Tn , Tr 2 ), to calculate control parameters by means of which the vehicle can be made to perform and avoidance manoeuvre corresponding to the stored avoidance manoeuvre trajectory. 4. A system according to any of the preceding claims, charac- terized in that the means (6) for calculation of avoidance manoeuvre trajectory (Tn , Tr 2 ) is arranged to make a calculated avoidance manoeuvre trajectory (Tn , Tr 2 ) be represented by a number of three dimensional geometrical objects (Sι-S 4 ), for instance spheres, each of which objects being assigned a certain time value (T 1 -T 4 ), the dimension of the separate objects (S 1 -S 4 ) being dependent on the stipulated minimum distance (d) between the avoidance manoeuvre trajectories (Tn , Tr 2 ), and that the control means (8) is arranged to control whether any of the geometrical objects (S 1 -S 4 ) representing the avoidance manoeu- vre trajectory (Tri , Tr 2 ) of a vehicle overlaps a geometrical object with corresponding time value included in the representation of the avoidance manoeuvre trajectory of any of the other vehicle. 5. A system according to claim 4, characterized in that the calculation means (6) is arranged to adapt the dimension of the geometrical objects (S 1 -S 4 ) taking estimated errors (d err or) of the calculated avoidance manoeuvre trajectory (Tri , Tr 2 ) into account. 6. A system according to any of the preceding claims, characterized in that the means (4) for determining an avoidance manoeuvre direction (D;) for the respective vehicle is arranged to determine this direction based on the criteria that the completion points (Cι , C 2 ) of the avoidance manoeuvre trajectories (Tri , Tr 2 ) of the vehicles are to be at as large a distance from each other as possible. 7. A method for avoidance of collision between vehicles, characterized in that a future position (P^ P 2 ) for the respective ve- hide is continuously calculated, that an avoidance manoeuvre direction (Di ) for the respective vehicle is determined co-ordinated between the vehicles, and that an avoidance manoeuvre trajectory (Tn , Tr 2 ) for the respective vehicle is calculated based on the avoidance manoeuvre direction (Dj) and the future position (Pi , P 2 ) calculated for the vehicle, whereupon the avoidance manoeuvre trajectory (Tn , Tr 2 ) calculated for the respective vehicle is compared with the avoidance manoeuvre trajectories calculated for the other vehicles in order to control whether the avoidance manoeuvre trajectory of the vehicle in each moment during its calculated lapse is located at a stipulated minimum distance (d) from the avoidance manoeuvre trajectories of the other vehicles, whereupon, if the comparison shows that the avoidance manoeuvre trajectory (Tn , Tr 2 ) of a vehicle in each moment during its calculated lapse is located at the stipulated minimum distance (d) from the avoidance manoeuvre trajectories of the other vehicles, data concerning this avoidance manoeuvre trajectory is stored , and , if the comparison shows that the avoidance manoeuvre trajectory (Tn , Tr 2 ) of a vehicle in any moment during its calculated lapse is located at a distance from an avoidance manoeuvre trajectory of any of the other vehicles that is smaller than the stipulated minimum dis- tance (d), a warning is presented to a person manoeuvring the vehicle that a risk of collision exists and/or the vehicle is made to follow an avoidance manoeuvre trajectory previously calculated and stored for the vehicle. 8. A method according to claim 7, characterized in that the avoidance manoeuvre direction (D,) for the respective vehicle is determined based on the criteria that the completion points (Ci , C 2 ) of the avoidance manoeuvre trajectories (Tn , Tr 2 ) of the ve- hides are to be at as large a distance from each other as possible. 9. A method according to claim 8, characterized in that suitable avoidance manoeuvre directions (D,) are calculated by minimi- zation of the function where Ci constitutes the completion point of the avoidance manoeuvre trajectory Tr, for the vehicle i. 10. A method according to any of claims 7-9, characterized in that the future position (Pi ) for the respective vehicle is calcu- lated by means of a means (2) arranged in the respective vehicle, data concerning the calculated future position (Pi ) being communicated from the respective vehicle to each of the other vehicles, and that the respective vehicle from each of the other vehicles receives data concerning the calculated future position (P 2 ) of each of the other vehicles. 1 1 . A method according to any of claims 7-10, characterized in that the respective calculated avoidance manoeuvre trajectory (Tn , Tr 2 ) is represented by a number of three dimensional geo- metrical objects (S 1 -S 4 ), for instance spheres, each of which objects being assigned a certain time value (Tι-T 4 ), the dimen- sion of the separate objects (S^S^ being dependent on the stipulated minimum distance (d) between the avoidance manoeuvre trajectories (Tn , Tr 2 ), and that it is controlled at the comparison between the avoidance manoeuvre trajectories (Tn , Tr 2 ) whether any of the geometrical objects (S 1 -S 4 ) representing the avoidance manoeuvre trajectory of a vehicle overlaps a geometrical object with corresponding time value included in the representation of the avoidance manoeuvre trajectory of any of the other vehicles. 12. A method according to claim 1 1 , characterized in that the dimension of the geometrical objects (Sι-S 4 ) is adapted taking estimated errors (d error ) of the calculated avoidance manoeuvre trajectory (Tn , Tr 2 ) into account.

Inventors: SPORRONG JONAS, UHLIN PETER, SPORRONG, JONAS, UHLIN, PETER
Applicants: SAAB AB, SPORRONG JONAS, UHLIN PETER, SPORRONG, JONAS, UHLIN, PETER
Application year: 2000
Main classification: G08G5
IPC codes: G01S13, G08G5