Abstract

The paper presents methods to determine the time, positions, and distance of closest approach for two vehicles following arbitrary trajectories in two or three dimensions. The distance of closest approach of two vehicles following arbitrary curved trajectories is determined by two conditions: (i) the relative velocity must be orthogonal to the relative position in order for the distance to be a nonzero extremum; (ii) the radial acceleration including centripetal terms must have a direction that increases the separation for the extremum to be a minimum. This theorem on the distance of closest approach simplifies in the case of uniform motion along rectilinear trajectories. Three examples are given: (i) the two-dimensional motion of surface vehicles changing the velocity of one of them so as to enforce a given minimum separation distance; (ii) the three-dimensional motion of two aircraft, one flying horizontally and the other climbing, changing the vertical velocity of the latter to ensure a minimum separation distance set “a priori”; (iii) the case of an aircraft flying with constant velocity in a straight line so that its closest approach to another aircraft flying in a circular holding pattern in the same plane occurs at a given time chosen “a priori”.

1. Introduction

In the traffic of vehicles safety is identified with the absence of collisions or conflicts. A conflict occurs when the distance between the centroids of two vehicles is less than a safe separation distance (SSD) determined by their size. Thus (i) the absence of conflicts and (ii) the confirmation that a conflict has been resolved depend on determining the distance of closest approach (DCA) that is not less than the SSD. The conflict resolution relies (iii) on trajectory modifications that change the DCA from smaller than the SSD to larger than (or equal to) the SSD. The paper presents methods to determine the time, positions, and distance of closest approach for two vehicles following arbitrary trajectories in two or three dimensions. The two-dimensional cases include cars in road traffic, ships in sea lanes, and aircraft ground movements at an airport. The three-dimensional cases include all types of flying vehicles, like airplanes, helicopters, drones, rockets and satellites, and also submerged submarines. The differences in conflict detection and resolution (CDR) between all these types of vehicles concern the speed, size, and distances that enter as parameters in the same methods of calculation of distance and time of closest approach.

The distance and time of closest approach are essential inputs for CDR methods [13]. The collision risk applies to cars [4, 5], ships and submarines [6, 7], and aircraft [8, 9]. Taking as example the case of Air Traffic Management (ATM) the problem may be divided into (i) prediction of flight paths [10, 11], (ii) safety assessment [12, 13], and (iii) conflict resolution [1416]. Collision avoidance between aircraft starts with [17] separation distances (e.g., longitudinal, lateral, and altitude) leading to high Target Level of Safety (TLS: probability of collision less than per hour) for various aircraft encounter geometries, like level crossing [18] or climb and descent [19]. The safe separation ultimately determines airspace capacity [20]. Many of these methods assume straight trajectories or approximate curved trajectories by straight segments. While this allows a continuous trajectory, the velocity becomes discontinuous in direction at the edges and the acceleration becomes singular. The purpose of the present paper is to determine the distance and time of closest approach for arbitrary curved trajectories without approximations of any kind. This may be used for CDR methods or to assess TLS.

There are a variety of CDR methods including multiagent algorithms [2123] that apply to vehicles moving in two [19, 2427] or three [1020] dimensions. All CDR methods (i) start with the identification of a conflict, (ii) involve trajectory changes to resolve the conflict, and (iii) end with the verification that the conflict has been resolved. The safety of traffic requires that a minimum SSD be held, for example, ensuring that the “safety volumes” around two vehicles do not penetrate. If two vehicles follow two arbitrary trajectories with position vectors and , as a function of time, the modulus of the difference specifies their distance that generally varies with time: A conflict is detected if at any time the distance is less than the SSD: If a conflict is detected, then one or both trajectories must be modified to resolve the conflict. The success of the conflict resolution is checked by showing that the distance exceeds the SSD for all time:The criteria for conflict (2) or no conflict (3) are next put into a simpler form that is easier to apply.

The key concept is that of distance of closest approach between two trajectories: which occurs at the time of closest approach, when the vehicles are at position and . There is a conflict if the distance of closest approach is less than the safe separation distance (5a) and no conflict otherwise (5b): The paper presents a method to determine (i) the distance of closest approach , (ii) the time of closest approach , and (iii) the positions of the two vehicles at that time . The method applies to arbitrary trajectories: (a) curved or rectilinear; (b) with constant velocity, accelerated or decelerated motion. The method is deterministic and excludes external disturbances. The extension to include random disturbances can be made adding to the position vectors the deviations due to uncertainties or external effects and applying statistical methods.

Considering first arbitrary nonuniform motion a theorem is established (Section 2.1) specifying the conditions for minimum separation between two trajectories. In many traffic situations the future trajectories are not known, and the information available is only the current positions and velocities of two vehicles; if the motion is assumed to be uniform, simple formulas are obtained (Section 2.2) for the distance and time of closest approach. This in turn specifies the conditions for collision avoidance between two or any number of vehicles (Section 2.3). These conditions give a simple geometric interpretation of the two theorems (Section 2). The preceding theory is applied (Section 3) to three examples: (Section 3.1) two-dimensional collision avoidance between surface vehicles (ships, car, or airplanes on the ground at an airport) with constant velocity by choosing the modulus of the velocity of one of them; (Section 3.2) three-dimensional collision avoidance between two aircraft moving at constant velocity, one at constant altitude and the other climbing, by changing the vertical velocity of the latter; (Section 3.3) meeting a given time of closest approach between a vehicle in a holding pattern of uniform circular motion and another in uniform rectilinear motion. These three cases are sufficiently simple for analytical calculation (Section 3), illustrate the two theorems (Section 2), and substantiate the discussion (Section 4).

2. Distance of Closest Approach between Trajectories

The minimal separation for two vehicles following arbitrary trajectories is obtained by minimizing the relative distance as a function of time. This leads to two conditions to be satisfied at the time of closest approach (Section 2.1). The simplest case is that of uniform motion from given initial positions (Section 2.2). It leads to a simple criterion for collision avoidance by maintaining a minimum separation distance (Section 2.3) and is applicable to two or more vehicles. The vehicles are represented by material vehicles placed at their centroids, and their dimensions are taken into account by setting a safe separation distance to avoid collisions.

2.1. Nonuniform Motion along Curved Trajectories

Consider two vehicles moving with integrable time-dependent velocities and from initial positions and at time , so that their positions at time are given by It is necessary to find (i) the conditions for a collision, where the positions coincide with for some time(s) ; (ii) if there is no collision then the time and distance of closest approach are given by (4)(7): The relative position of the two vehicles is given at all times by:Introducing the initial relative positions (9a) at the initial time and the relative velocity (9b) at all times,the relative position at arbitrary time is given by where the change in relative position from time to time is given by (11a): and its time derivative is relative velocity (11b).

The distance between the vehicles at time is given by The first derivative of (12) with regard to time, is zero for stationary distance between the vehicles: Thus two cases may arise: (i) if the distance is zero at the stationary point(s) then there is collision between the vehicles and the relative velocity is arbitrary:(ii) if the distance is not zero then the velocity and relative position must be orthogonal: Note that the distance of closest approach is generally not the smallest distance between the paths because the two vehicles will be at these points at different times. The condition of closest approach that the relative velocity and relative position are orthogonal (Figure 1) can be explained as follows: (i) if at time then the vehicles would be moving towards each other and would be closer at some later time ; (ii) if at time then the vehicles would be moving away from each other and would have been closer for some earlier time . In either case (i) or (ii) the time would not be that of stationary distance. This proves by “reductio ad absurdum” that a stationary distance requires that the relative velocity be orthogonal to the relative position.

A stationary distance is a necessary but not sufficient condition for closest approach; an inflexion point in one of the trajectories would also correspond to a stationary distance but might not be a minimum; a minimum is determined by the second-order derivative of distance with regard to time: being positive at the stationary condition. In the stationary condition (14a) (18a) the relation (17) simplifies to (18b):where (19a) is the relative acceleration that must satisfy (19b) for a minimum: Thus the stationary distance will be a minimum if the acceleration is along the relative position , because it tends to move the two vehicles away from each other. Even if the relative acceleration is from one vehicle towards the other , the distance will still be a minimum if the centripetal acceleration is larger: The stationary point would not be one of closest approach only if the relative acceleration projected on the relative position is opposite in sign and larger in modulus than the centripetal acceleration.

The preceding results may be summarized in a theorem on nonuniform motion: two vehicles with initial positions and and nonuniform velocities, respectively, and , which are integrable functions of time, will collide at an arbitrary angle if their relative distance ((8), (12)) vanishes ((15a), (15b)). If the vehicles do not collide, (i) the distance is stationary, which is a necessary condition for closest approach, if and only if ((16a), (16b)) the relative velocity (9b) is orthogonal to the relative position (8) (10); (ii) a sufficient condition for closest approach, which is that the distance is minimum, is that the relative acceleration (19a) satisfies (19b) implying that the centripetal acceleration associated with the relative curvature of the trajectories predominates over the relative acceleration projected on the relative velocity.

The distance of closest approach D between vehicles moving two trajectories generally exceeds the smallest distance E between the two paths, because the vehicles might cross the closest points at different times; for example (Figure 2), (i) at the time when vehicle 2 is at the closest position vehicle 1 is still behind the closest position :(ii) by the time vehicle 1 reaches the closest position vehicle 2 will be beyond the closest position . Conditions (16b) and (18b) of closest approach are local, in the sense that for small deviations to earlier or later time the relative distance increases. In the case of curved trajectories there can exist several times , distances , and positions of local closest approach as shown in Figure 3. In this case the distance of closest approach would be the “minimum minimorum” that is the smallest or infimum of all local distances of closest approach:The existence of multiple local minima of the distance is not possible for straight trajectories: if the two vehicles move with constant velocity there is only one time and distance of closest approach, as shown next.

2.2. Closest Approach for Uniform Rectilinear Motion

In many traffic situations the future trajectories of vehicles are not known or can be adjusted to avoid collisions. The information available from traffic sensors is usually positions and velocities at a given time. The simplest assumption is that the velocities will be constant and the position of the centroids of the vehicles, taken as material vehicles, at time will be The relative position at time is where (9a) is the initial relative position and the relative velocity (9b) is constant. The relative distance at time is given byThe second-order derivative with regard to time is always positive:and thus a stationary distance can only be a minimum distance. There is no maximum distance because a constant relative velocity leads the vehicles infinitely apart after a long time.

The first derivative of the distancevanishes at the time of closest approach: where is the angle of the relative initial position (9a) with the constant relative velocity (9b). The position of the two vehicles at the time of closest approach is obtained by substituting (28b) in (23a), (23b):and their relative position is given bywhere the double outer product of vectors was used.

The distance of closest approach (31b) is the modulus of the relative position vector (30)(31a):Denoting by the unit vector orthogonal to the plane of the initial relative position (9a) and constant relative velocity (9b) leads to the following: (i) the outer product (32a): (ii) since the outer product involving is orthogonal to , it follows (32b). Substituting (32b) in (31b) specifies the distance of closest approach (33):which must exceed the safety distance to avoid a conflict between the vehicles. The distance of closest approach can also be obtained substituting the time of closest approach (28b) in the distance (25):in agreement with (33).

2.3. Collision Avoidance for Several Vehicles

The preceding results with uniform motion apply to collision avoidance with two vehicles, as stated in the theorem on uniform motion: two vehicles with given distinct initial positions and constant velocities collide (35a) only if the initial relative position (9a) and the constant relative velocity (9b) are antiparallel (35b)(35c):in which case collision (28b) occurs at time (35d). If the relative velocity makes an angle with the initial relative position, the time of closest approach is (28b) and the distance of closest approach is (33). In order that a minimum safety distance can be maintained at all times it is sufficient that the angle of the constant relative velocity (9b) with the relative initial position (9a) satisfies In this case one vehicle “misses the other” or “passes by” at a distance larger than the minimum separation distance.

These results can be interpreted by a simple geometrical construction involving elementary Euclidean geometry (Figure 4): (i) since only relative motion is of interest the origin O is taken at the second vehicle; (ii) the initial position A of the first vehicle specifies the initial distance ; (iii) through A a straight line is drawn in the direction of the constant relative velocity that makes an angle with the relative initial position; (iv) an orthogonal line through the origin intersects at the point B of closest approach; (v) it follows that the distance of closet approach is (33); (vi) the distance travelled by the first vehicle from the initial position to the point of closest approach is (37a): (vii) since the relative velocity is constant the time of closest approach is (37b) in agreement with (28b); (viii) the minus sign arises because of the angle is measured from the relative initial position to the constant relative velocity; (ix) at the point of closest approach the relative position (30) is orthogonal to the relative velocity: in agreement with the general condition ((16a), (16b)); (x) the condition (19b) for a minimum distance is met for zero relative acceleration .

The angle in (36) would be imaginary if but in this case the initial separation would already be less than the minimum separation distance, and the safety criterion was violated from the start. If the safety condition is not violated from the start, the initial relative distance is larger than the safe separation distance, and a real angle exists. It suffices that the angle of the relative velocity with the relative initial position exceeds this value in modulus for the safe separation to be ensured at all times. The problem of safe separation between two vehicles, with a given safe separation distance as a chosen parameter, may be extended to several vehicles, say . Choosing vehicle 1 as the reference the exclusion of collision with each of the other N vehicles leads to N conditions of type (36). If these N conditions are compatible the first vehicle can avoid a collision with all the others by being steered in a constant direction. If the N conditions are incompatible a collision cannot be avoided in a straight path and a polygonal or curved path will be necessary. That may not be sufficient to avoid a collision if the traffic density is too high.

Three situations can arise concerning the time of closest approach (28b): The time of closest approach is time zero (39b) if the initial relative position is orthogonal to the constant relative velocity, in agreement with condition (16b) of closest approach. If the vehicles move towards each other (39a) the time of closest approach is positive because (Figure 5(a)) the trajectories are converging and will be closest in the future. If the two vehicles are moving away from each other (39c) the time of closest approach is negative, because the trajectories are diverging (Figure 5(b)) and were closer in the past. Thus two situations arise: (a) for converging trajectories (40a), that is, positive time of closest approach (39a), the minimum separation distance is (31b): (b) for parallel or diverging trajectories (40b) the minimum separation distance is the initial separation, because the vehicles will not get closer in the future.

3. Safe Separation between Straight and Curved Trajectories

As examples of the preceding theory, the second theorem is used in the simplest case of uniform motion along straight paths (Sections 2.2 and 2.3) both in two (Section 3.1) and three (Section 3.2) dimensions motivated by collision avoidance between (i) ships or aircraft moving on ground at airports (Section 3.1)and (ii) aircraft in flight (Section 3.2). The first theorem is needed in the third (iii) case involving a curved path (Section 3.3).

3.1. Two-Dimensional Safe Separation between Ships in a Water

The first application is conflict avoidance between two ships; following nautical practice the speed is in knots (kt) in (41a) and heading (41b) in degrees: and hence time is in hours and distance in nautical miles (nm), e.g., for the initial positions (41c,d) in a Cartesian frame: It is necessary to find if the minimum separation distance satisfies the safety threshold of 20 nm:if this is not the case then the modulus of the velocity of the second ship is to be modified to as little as possible so that the minimum safety distance is complied with. The problem would be similar with different values for the ground movements of two aircraft at an airport or other cases of two-dimensional motion of vehicles like cars.

The Cartesian components of the velocities of the two ships are This specifies the relative velocity (44a) and relative initial position (44b):The angle between them is calculated fromwhere (45c) has two roots.

The angle is less than 180° so the root (46a) of (45c) is chosen:leading to a distance of closest approach (46b) after a time (46c). At that time the position of the two ships is confirming the separation (46b)(48a)is less than the desired safe separation distance (48b) (42).

In the example shown the distance of minimal approach (46b) is less than the desired safe separation distance (42)(48b), and thus the angle between the relative velocity and initial relative position must be decreased to satisfyingIt is required that the desired minimum separation distance is to be obtained by changing only the modulus of velocity of the second ship from in (41a) to to be determined next; the speed of the first ship is unchanged and the headings of the two ships are also maintained. The Cartesian components of the velocity of the first ship are the same (43a) and those of the second ship (43b) change toThe relative initial position (44b) remains and the relative velocity (44a) changes to The square of the modulus of the relative velocity changes toThe projection of the relative velocity on the relative initial position (44b) changes toIts square appears in (45c) modified toSubstitution of , , (45b), and in leads towhich is a quadratic equation in :with roots:The two roots, correspond to slowing down or reversing the motion of the second ship. They lead, respectively, to the relative velocities and distinct times of closet approach:The relative positions of the two ships at these times areBoth solutions correspond to the desired minimum safety distance: obtained either by moving faster ahead or by slowing down .

3.2. Three-Dimensional Safe Separation between Aircraft in Climb and at Cruise

The second example is conflict avoidance between aircraft in flight; following aeronautical practice the speed is in kilometers per hour, for the first aircraft in level flight and the second climbing :The initial positions are (,) in kilometers (km) and time is in hours (h). The required safe separation distance isif it is not met then only the vertical velocity of the second aircraft is to be changed to by the minimum amount to satisfy the safe separation distance. The safety distances in (42) and are examples, with standard values specified by nautical or aeronautical separation standards. For example, in aeronautics the horizontal separation may be 5 or 10 nautical miles in radar controlled airspace and 50 nautical miles in oceanic airspace and vertical separation may be 2000 or 1000 feet in altitude.

The relative initial position and the relative velocity are and the angle between them is calculated from The angle (, ) leads to a distance of closest approach at the time :The positions of the two aircraft at this timeconfirm the minimum separation which is less than the required safety distance .

The required separation distance implies that the angle between the relative velocity and initial relative position must satisfythis will be met by changing only the vertical velocity of the second aircraft from in (63b) to determined in the sequel. The identity is used again, where (i) the modulus of the relative velocity is (ii) the inner product by the relative position isSubstituting (, , ) and in leads to a quadratic equation for the vertical velocity of the second aircraft:The binomial has rootsleading to two possible vertical velocities, one climbing and the other descending.

The corresponding relative velocities are The corresponding times of closet approach are The relative positions at these times areBoth roots lead to the desired minimum separation distance:in different ways, one by descending (73b) and the other by climbing faster (73a). Next is considered a different kind of problem with one curved trajectory and time of closest approach imposed “a priori”.

3.3. Minimum Distance between a Curved and a Straight Trajectory

The third example uses SI units for the velocity in meters per second of an aircraft flying in a circular path of radius in meters, using time in seconds in the centripetal acceleration that is small compared with that of gravity:The trajectory in a Cartesian reference frame with origin at the centre iswhere is the angular velocity. The second aircraft starts at an initial position and flies at the same altitude with a constant heading :with constant velocity such that the time of closest approach is . It is necessary to find the distance of closest approach and the corresponding positions of the two aircraft.

The trajectory of the second aircraft is The relative position is and its derivative with regard to timespecifies the relative velocity .

The condition of closest approach is ((16a), (16b)) that the relative position and velocity should be orthogonal: The time of closest approach is satisfied if the velocity along the straight path satisfies the quadratic relation:where for the present problem (, ; , )the quadratic has rootsThe corresponding positions along the straight path at the time of closest approach areat the same time the position on the circular path isThe extrema for the relative distance,may be local maxima or minima.

To clarify this the acceleration is needed, which is specified by the circular motion alone:Criterion (18b) requires also relative velocities:through the square of the moduli:Acceleration appears projected on the relative position (, ; ):leading toCriterion (18b),shows that the first solution that has positive velocity corresponds to the closest approach and is both a local and a global minimum for the relative distance. The second solution that has negative velocity is a local maximum of the relative distance; it is not an absolute maximum because the latter corresponds to infinite distance.

4. Discussion

The problem of conflict avoidance between two vehicles involves, besides a safe separation distance chosen “a priori”, 4 vectors, namely, the initial position vectors and constant velocity vectors of each vehicle, leading to components in two dimensions and components in three dimensions. Since a conflict is concerned with relative motion, it might be expected that only four variables would be relevant, namely, the relative initial position (9a) and the constant relative velocity (9b). It is remarkable that the distance of closest approach (33) and hence the safety criterion involve only two combinations of these four variables: (i) initial distance (not the direction); (ii) the angle of the relative velocity with the relative initial position (not the modulus of the relative velocity). Thus a conflict can be avoided by (a) steering only one vehicle, so that the condition (36) is met, with no need to change the modulus of the velocity; (b) alternatively the heading that may be retained and conflict avoidance which is implemented by increasing the velocity to race ahead or slowing down or reversing the motion to fall behind. Other less simple combinations are to change the heading and velocity of one or both vehicles. For example, a conflict between aircraft can be resolved by changing speed (acceleration or deceleration) or heading or climb or descend rate for one or both aircraft. The present method applies to all these cases and combinations thereof.

Besides (i) the initial relative distance and (ii) angle of the relative initial position with the relative velocity, the (iii) modulus of the relative velocity also appears in the time of closest approach (28b)(37b). The condition of conflict avoidance between two vehicles thus requires that one of them be steered out of a dangerous angular sector for which a collision would occur. In the case of several vehicles a conflict can be avoided if the dangerous angular sectors for each vehicle do not cover all directions of straight travel. If all directions of straight travel lead to conflicts then curved trajectories must be considered. The cases of conflict between vehicles with nonuniform velocity along curved paths are addressed by the first theorem, of which the second is a particular case. The minimum distance between two curves occurs at a point with common normal (Figure 6); this would be the distance of closest approach only if the two vehicles would be at these points at the same time. In that case the relative velocity, that is tangential, would be orthogonal to the relative position, that is along the normal ((16a), (16b)); if the curves have opposite curvatures it would also be locally the point of closest approach ((19a), (19b)). However, in general the vehicles following the two paths will pass by nearest points at different times (Figure 2) and the distance of closest approach will be larger than the minimum distance between the two curves.

In all cases of uniform or nonuniform motion along straight or curved paths it remains true that an extremum of the relative distance (16a) will correspond to a relative velocity orthogonal to the relative position (16b) and that extremum will be the minimum separation distance if the relative acceleration (19a) meets the condition (19b) that may be interpreted as stating that the total acceleration, including the centripetal acceleration, must cause the vehicles to move away from each other. The latter two conditions ((16a), (16b) and (19a), (19b)) are necessary and sufficient to determine the distance of closest approach and apply the criterion of minimum safe separation distance for two vehicles or vehicles with arbitrary trajectories and velocities along them. The minimum is a local minimum for curved trajectories with nonuniform velocity and an absolute minimum for straight trajectories with uniform velocity. In the latter case of straight trajectories with constant velocity (Figure 4) the maximum distance is infinity after an infinite time, and there are no local maxima. In the case of nonuniform motion along curved paths there can exist local minima of the relative distance (Figure 3) as well as maxima . The objective of maximizing the relative distance corresponds to (i) relative position orthogonal to the relative velocity, as for any extremum, and (ii) the local acceleration which must overcome the centripetal acceleration to increase the distance. Thus the dotted path in Figure 1 would correspond to a local maximum of the relative distance whereas the solid curve would correspond to a local minimum.

5. Conclusion

The conflict detection and resolution (CDR) required that the trajectories of two vehicles lead to a relative distance not less than the safe separation distance (SSD) at all times. This can be ensured if the distance of closest approach (DCA) is not less than the SSD. The DCA has been calculated for two arbitrary trajectories, generally curved and with accelerated motion: in this case there can exist several local minima of the relative distance between two vehicles and the DCA is the smallest of them. In the case of two vehicles with constant velocity the rectilinear trajectories lead to one time of closest approach; the maximum distance is unbounded for large time. The preceding results apply to any type of vehicle (car, ship, and aircraft) and to motion in two or three dimensions. They are illustrated by 2 examples with constant velocities: (i) conflict avoidance between two ships changing the modulus of the velocity of one of them; (ii) conflict avoidance between two aircraft changing the climb rate of one of them. A third example involves one straight and one curved trajectory and requires one velocity to be chosen to achieve a time of closest approach chosen “a priori”.

List of Symbols

Acceleration
Distance between two trajectories
Distance of closest approach between two trajectories
Radius
Time of closest approach
Inner product or dot product of two vectors and
Velocity vector of vehicle 1
Velocity vector of vehicle 2
Relative velocity,
Position vector of vehicle 1
Position vector of vehicle 2
Relative position,
:Initial position of vehicle 1
:Initial position of vehicle 2
:Relative initial position,
Safe separation distance.
Units
h:Hours
nm:Nautical miles
km:Kilometers
kt:Knots.
Acronyms
ATM:Air Traffic Management
CDR:Conflict detection and resolution
DCA:Distance of closest approach
TCA:Time of closest approach
TLS:Target Level of Safety
SSD:Safe separation distance.

Data Availability

The data used to support the findings of this study are included in the paper.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.

Acknowledgments

This work was supported by FCT (Foundation for Science and Technology), through IDMEC (Institute of Mechanical Engineering), under LAETA Pest-OE/EME/LA0022.