Abstract:This paper presents a new collision avoidance procedure for unmanned aerial vehicles in the presence of static and moving obstacles. The proposed procedure is based on a new form of local parametrized guidance vector fields, called collision avoidance vector fields, that produce smooth and intuitive maneuvers around obstacles. The maneuvers follow nominal collision-free paths which we refer to as streamlines of the collision avoidance vector fields. In the case of multiple obstacles, the proposed procedure determines a mixed vector field that blends the collision avoidance vector field of each obstacle and assumes its form whenever a pre-defined distance threshold is reached. Then, in accordance to the computed guidance vector fields, different collision avoidance controllers that generate collision-free maneuvers are developed. Furthermore, it is shown that any tracking controller with convergence guarantees can be used with the avoidance controllers to track the streamlines of the collision avoidance vector fields. Finally, numerical simulations demonstrate the efficacy of the proposed approach and its ability to avoid collisions with static and moving pop-up threats in three different practical scenarios.
What problem does this paper attempt to address?
The problem that this paper attempts to solve is how an unmanned aerial vehicle (UAV) can achieve effective collision avoidance in the presence of static and moving obstacles. Specifically, the paper proposes a new collision avoidance method based on locally parameterized guiding vector fields (called Collision Avoidance Vector Fields, CAVFs), which can generate smooth and intuitive obstacle - avoidance maneuver paths. These paths are called streamlines of the collision avoidance vector fields. In the case of multiple obstacles, the paper proposes a method of hybrid vector fields, which can fuse the collision avoidance vector fields of each obstacle and adopt the corresponding form when a predefined distance threshold is reached. In addition, the paper also develops different collision avoidance controllers, which can generate collision - free maneuvers. Finally, numerical simulations verify the effectiveness of the proposed method and its ability to avoid collisions with static and moving sudden threats in three different practical scenarios.
### Mathematical Model and Problem Definition
The paper first defines the system state - space model and mathematical formulation of the collision avoidance problem. Consider a UAV flying in a horizontal plane at a constant forward speed \(v\) and direction \(\theta\) with respect to the \(x\)-axis of an inertial coordinate system fixed on the plane, as shown in Figure 1. The complete state of the UAV is represented by its position \(\mathbf{p} = [x, y]^T\in\mathbb{R}^2\) and direction \(\theta\in\mathbb{R}\). The equations of motion are given by the following dynamic model:
\[
\begin{aligned}
\dot{x}(t) &= v\cos(\theta(t)), & x(t_0) &= x_0, \\
\dot{y}(t) &= v\sin(\theta(t)), & y(t_0) &= y_0, \\
\dot{\theta}(t) &= u(t), & \theta(t_0) &= \theta_0,
\end{aligned}
\]
where \(u\) is the turn - rate input, \([x_0, y_0]^T\in\mathbb{R}^2\) and \(\theta_0\in\mathbb{R}\) are the vehicle position and direction at the initial time \(t_0\), respectively. The UAV position trajectory obtained by forward integrating the system (1) is represented as \(\gamma[t_0, T]: [t_0, T]\to\mathbb{R}^2\), where \(T > t_0\) is the free final time and \(\gamma[t_0, T]:=\{\mathbf{p}(t):t\in[t_0, T]\}\).
It is further assumed that the UAV initially travels at a constant speed according to a constant desired turn angle \(\theta_d\in\mathbb{R}\) provided by a high - level planning module. This indicates that during the planning process, the UAV's goal is to maintain the same heading, and any deviation from the predetermined path will be handled by the high - level planner, which is outside the scope of this paper.
The UAV moves in an environment that may contain static and moving obstacles, which can represent no - fly zones, other UAVs, aircraft, or physical obstacles. Therefore, for planning purposes, it is assumed that each obstacle can be surrounded by a circular area with a specific radius \(R_c > 0\), which is determined by the maximum obstacle size. In addition, it is assumed that the UAV has a limited sensing range, modeled as a circular area with a radius \(R_s\), which is determined by its sensor capabilities and centered at the geometric center of the UAV. Therefore, the sensing area of the UAV at time \(t\) can be modeled as:
\[
S(t)=\left\{[x, y]^T\in\mathbb{R}^2:\sqrt{(x(t)-x)^2+(y(t)-y)^2}\leq R_s\right\},
\]
Due to sensor limitations, obstacles can be regarded as "popping - up" motion constraints because they are only considered when they enter the circular...