Quadrotor parameters.

## Abstract

In this chapter, two controllers are investigated for stabilisation, path tracking and leader-follower team formation. The first controller is a PD2 implemented for attitude stability. The second controller is an Integral Backstepping IBS control algorithm presented for the path tracking and leader-follower team formation problems of quadrotors. This nonlinear control technique divide the control into two loops, the inner loop is for the attitude stabilisation and the outer loop is for the position control. The dynamic model of a quadrotor is represented based on Euler angles representation and includes some modelled aerodynamical effects as a nonlinear part. The IBS controller is designed for the translational part to track the desired trajectory and to track the leader quadrotor by the followers. Stability analysis is achieved via a suitable Lyapunov function. The external disturbance and model parameters uncertainty are considered in the simulation tests. The proposed controllers yielded good results in terms of Root Mean Square Error RMSE values, time-consumption, disturbance rejection and model parameter uncertainties change coverage.

### Keywords

- integral backstepping
- adaptive controller
- Euler angles
- UAVs quadrotors
- team formation

## 1. Introduction

In recent years, research on the control of Unmanned Aerial Vehicles (UAVs) has been growing due to its simplicity in design and low cost. Quadrotor helicopters have several advantages over fixed-wing air crafts, such as taking off and landing vertically in a limited space and hovering easily over fixed or dynamic targets, which gives them efficiency in applications that fixed-wing air crafts cannot do, in addition to being safer [1, 2, 3]. Based on its structure the UAV offers the power of sensing and computing in many applications. Quadrotor UAVs can be used to perform several tasks in the applications of dangerous areas for a manned aircraft in a high level of accuracy. They can be utilised in different applications, such as inspection of power lines, oil platforms, search and rescue operations, and surveillance [4, 5, 6]. Increasing the applications of quadrotors encourages the growth in their technologies and raises the requirements on autonomous control protocols. Moreover, using swarm robotics has advantages over individual robots in that they perform their tasks faster with high accuracy and use a minimum number of sensors by distributing them to the robots [7]. Researchers are focusing on the design and implementation of many types of controllers to control the take-off, landing and hovering of individual quadrotor UAVs with some applications which require the creation of a trajectory and tracking in three dimensions, benefiting from the wide developments in sensors.

Research in the field of control of individual and multi-robot quadrotor team formation is still facing some challenges. Challenges of individual quadrotor control come from the complexity of modelling its dynamic system because of its complex structure and the design issue. The dynamic model equations present four input forces with six output states, which mean that the system is in under-actuated range [5, 7]. Further challenges of multi-robot control come from evaluating the control architecture and communication network limitations.

The formation problem of quadrotors has had a vast area of interesting research in the past few years. Researchers have been motivated to contribute to this field of research by the development of materials, sensors and electronics used in designing quadrotors, which consequently has an effect on minimising their size, weight and cost. Working as a team of quadrotors has many benefits over using a single quadrotor in several applications.

Team formation control includes many problems to be addressed, including communication loss, delay between the robots or packet drop problems [8, 9, 10, 11]. Simultaneous localization and mapping is another problem in team formation control, in which the vehicle builds up its maps and estimates its location precisely at the same time; this problem has also been addressed in [12, 13, 14]. The third problem is the collision and obstacle avoidance, which includes avoiding collisions with both other robots and static or moving unknown obstacles while flying to their destination and maintaining their positions. Solutions to this problem have been handled by [12, 15]. Now, team formation control adopts a combination of some functions; the first is to perform the mission between two points, the second is to preserve the comparative positions of the robots over the formation and maintain the shape consequently, the third is to avoid obstacles and the forth is to divide the formation. In this chapter, we focus on designing only a control law for the leader-follower team formation problem with collision avoidance between team members by maintaining the distance between the leader and the follower.

In the leader-follower approach, at least one vehicle performs as a leader and the other robots are followers. The leader vehicle tracks a predefined path, whereas the followers maintain a certain distance with the leader and among themselves to obtain the desired shape. Each robot has its own controller and the robots keep the desired relative distance between themselves. However, two types of control architecture may be used to control the vehicle: one loop control scheme and two loop control scheme. If a two loop control scheme is used to control each vehicle, the outer loop is used for position control and its

Abundant literature exists on the subject of attitude stabilisation, path tracking and leader-follower team formation control. Several control techniques have been demonstrated to control a group of quadrotors varying between the linear PID, PD or LQR controllers to more complex nonlinear controllers as neural networks and BS controllers. These controllers achieved good results and some of them guaranteed the performance, such as the LQR controller, and some of them guaranteed their stability. The performance of an individual quadrotor or a group of quadrotors in formation control is often affected by external disturbances such as payload changes (or mass changes), wind disturbance, inaccurate model parameters, etc. Therefore, the IBS controller was proposed to reject the effect of disturbances and handle the change in model parameter uncertainties. On the other hand, improving the control performance is another aspect.

Dynamic model representation of the quadrotors is a major demand for designing these controllers. In this chapter, Euler angles technique was used to represent the quadrotors.

## 2. Dynamic model

In this section, Euler angles are used to represent the quadrotor dynamical model. External disturbances and model parameter uncertainties change are considered as well. An IBS controller is derived and tested in simulation. The stability analysis is obtained via a selected Lyapunov function. The full quadrotor dynamic model including the gyroscope effects

and the rotational matrix

where

Assuming that

## 3. Quadrotors formation problem

The full dynamic model based on Euler angles (1) of a quadrotor can be written as:

where

The leader-follower formation control problem to be solved in this chapter is a distributed control scheme of one leader and one follower. The leader control problem is formulated as a trajectory tracking, and the follower control problem is also formulated as a tracking problem, but with a different tracking target.

The follower keeps its yaw angle the same as the leader when it maintains the formation pattern. It moves to a desired position

Assume both the leader and the follower are able to obtain their own pose information and the follower is able to obtain the leader’s pose information via wireless communication. The design goal of the controllers is to find the state feedback control law for the thrust and torque inputs for both the leader and the follower. The leader-follower formation control problem is solved if both conditions (6) and (7) are satisfied.

and

The communication among the robots is assumed to be available. The position

## 4. Formation IBS controllers

Integral backstepping control is one of the popular control approaches for both individual and multiple quadrotors. In this section, the integral backstepping control is applied for the individual quadrotor path tracking and leader-follower formation problems. This nonlinear control technique divide the control into two loops, the inner loop is for the attitude stabilisation and the outer loop is for the position control as shown in Figure 2.

In this case, the leader and the follower desired roll and pitch angles are assumed to be

### 4.1 Backstepping control concept

Backstepping is a recursive design mechanism to asymptotically stabilise a controller for the following system [16]:

This system is described as an initial system in Figure 3, where

where

where

which is the backstepping, since

This system is equivalent to the initial system (8), where

Then

Let

Then

This signifies that the origin

### 4.2 Follower integral backstepping controller

The IBS controller for the follower is to track the leader and maintain a desired distance between them with desired incidence and bearing angles.

In this subsection, we derive the IBS controller for the follower. Let us use the follower translational part (17):

where

where

Then the position tracking error between the leader and the follower can be calculated as:

and its derivative is

where

where the integration of the follower position error is added to minimise the steady-state error.

Now, consider the linear velocity error between the leader and the follower as:

By substituting (24) into (25) we obtain

and its time derivative becomes

Then from (24) and (25) we can rewrite (23) in terms of the linear velocity error as:

By substituting (17) and (28) into (27), the time derivative of the linear velocity error can be rewritten as:

The desirable time derivative of the linear velocity error is supposed to be

Now, the total thrust

For the attitude stability, the following nonlinear

where

Next, we show the stability of the follower’s translational part.

### 4.3 Follower controller stability analysis

The following candidate Lyapunov function is chosen for the stability analysis for the follower’s translational part with the IBS controller:

and its time derivative is

By substituting

Finally, (37) is less than zero provided

### 4.4 Leader IBS controller

The leader is to track a desired trajectory

The result is that the total force and horizontal position control laws

The torque vector applied to the leader quadrotor

## 5. Simulations

In order to determine the efficiency of the proposed controller, a MATLAB quadrotor simulator is used to test it numerically. The design parameters of the quadrotor used in the simulator are listed in Table 1. Two paths were presented in the simulation to show the performance of using the proposed controller with four different circumstances for quadrotors team formation. The first desired path to be tracked by the leader was.

Symbol | Definition | Value | Units |
---|---|---|---|

Roll Inertia | |||

Pitch Inertia | |||

Yaw Inertia | |||

Mass | 0.5 | ||

Gravity | 9.81 | ||

Arm Length | 0.17 | ||

Rotor Inertia |

The IBS controllers were tested in simulation to track a desired path by the leader and maintain the desired distance, desired incidence angle and desired bearing angle between them for the follower. The parameters chosen for both paths were

The leader initial positions were

The second desired path to be tracked by the leader was

The leader initial positions were

The four circumstances included: (17) no disturbance, (32) force disturbance

Figures 5 and 6 indicate the response of the IBS controller while the leader was tracking the first and second desired path, respectively. Figure 7 shows the distance between the leader and the follower via the two paths, and Figures 8–11 illustrate the yaw angles’ behaviour for the leader and the follower via the two paths respectively.

It can be noticed from these figures that not only the overshoot but also the error in distance between the leader and the follower was low. It was also rejecting the disturbances in the two paths.

Table 2 demonstrates the RMSE values of the two paths positions and yaw angle. It is clear that the RMSE values of the IBS controller were almost the same when using the IBS controller in normal conditions and with

Path 1 | Path 2 | |||||||
---|---|---|---|---|---|---|---|---|

RMSE | ||||||||

0.0005 | 0.0040 | 0.0936 | 0.0004 | 0.0030 | 0.0248 | 0.0936 | 0 | |

0.0112 | 0.0772 | 0.0943 | 0.0004 | 0.0804 | 0.1018 | 0.0910 | ||

0.0005 | 0.0040 | 0.0936 | 0.0004 | 0.0030 | 0.0248 | 0.0936 | 0 | |

0.0005 | 0.0040 | 0.0936 | 0.0004 | 0.0030 | 0.0248 | 0.0936 | 0 |

In conclusion, it is obvious that the proposed IBS controller maintained the distance between the leader and the follower and keep them in the desired formation.

## 6. Discussions

This chapter presented an IBS controller derived based on the Backstepping controller for quadrotor UAVs leader-follower team formation problem. Two loops control scheme was used in simulation to find the total thrust and torques. A

It is well-known that IBS control is a methodical approach to build the Lyapunov function ahead with the control input design. Thus by the cancellation of the indefinite error terms, the stability of the derivative of the Lyapunov function can be secured. Although the stability of the Lyapunov function is guaranteed, this does not guarantee the performance of the system. In this work, a suitable Lyapunov function was used to derive the controller stability conditions.

The simulation results prove that the performance by using the IBS controller had significantly small errors. It is also obvious that using the IBS controller led to a smooth and fast performance with small overshoot. Moreover, the response of using the proposed controller in rejecting the external disturbances was fast enough.

As a result, the proposed IBS controller indeed produced good control performance in all circumstances.