Sliding Mode Path following and Control Allocation of a Tilt-Rotor Quadcopter

Abstract

A tilt-rotor quadcopter (TRQ) equipped with four tilt-rotors is more agile than its under-actuated counterpart and can fly at any path while maintaining the desired attitude. To take advantage of this additional control capability and enhance the quadrotor system’s robustness and capability, we designed two sliding mode controls (SMCs): the typical SMC exploits the properties of the rotational dynamics, and the modified SMC avoids undesired chattering. Our simulation studies show that the proposed SMC scheme can follow the planned flight path and keep the desired attitude in the presence of variable deviations and external perturbations. We demonstrate from the Lyapunov stability theorem that the proposed control scheme can guarantee the asymptotic stability of the TRQ in terms of position and attitude following via control allocation.

1. Introduction

Due to advancements in microprocessors and sensors, quadrotors have recently received much attention, playing an increasingly important role in unmanned aerial vehicles (UAVs). Now, quadrotors can easily hover indoors or outdoors and fly fast with global positioning system (GPS) devices or tiny cameras. Generally, changing the velocities of rotors [1,2] can generate lift and steering torque to control the attitude and position of the quadcopter.

Scholars and engineers have proposed several methods to solve the control problem for a quadrotor. These methods can be divided into: PID control [3,4,5], feedback linearization [6], optimal control [7], back-stepping [8,9], SMC [10,11,12,13], robust control [14], neural control [15,16], and nonlinear control [17]. To handle uncertainty systematically, researchers have extensively applied SMCs to address the robust control problem of quadrotors.

The super-twist control algorithm [18,19,20], a second-order SMC, has been studied to alleviate harmful chattering and maintain the robust capability of first-order SMCs. The studies in [21,22,23] demonstrate the stability and finite-time convergence of the super-twist control algorithm for single-variable systems through a Lyapunov stability analysis. For instance, Xu et al. [11] studied an adaptive terminal sliding mode for a quadrotor attitude control with specified capability and input saturation. In addition, Besnard et al. [12] proposed an observer-based SMC to address model uncertainty and wind perturbation. The recent work in [24,25] introduced the perturbation observer incorporating enhanced SMC for application in quadrotor UAV control.

Recently, several control methods have been proposed to solve the localization or following problem of under-actuated quadrotors, but these methods are still insufficient and have many shortcomings. For example, if the actuator fails or the rotor is damaged, the quadrotor will crash due to a lack of actuator redundancy to restore attitude and position. Tilt-rotor quadrotors [26] can increase the degree of control freedom and provide control redundancy. Compared with under-actuated quadrotors, full-drive quadrotors have more flexibility than under-actuated quadrotors and have recently attracted the research community’s attention. Ryll et al. [27] proposed a modeling approach for an overdrive quadrotor UAV. They provide a dynamic linearization control that uses higher-order derivatives of the measured output. Hua et al. [28] studied the control of vertical take-off and landing (VTOL) vehicles with bank thrust angle limitation. The proposed control can achieve the primary and secondary goals of asymptotically stabilizing position and direction. Recently, Rashad et al. [29] reviewed various UAV designs with fully actuated multi-rotors, in the literature. They introduced the control allocation matrix to categorize the proposed hardware framework and discussed the criteria for optimizing the UAV design. Zheng et al. [30] introduced the hardware design of an experimental tilt-rotor drone that uses linear servo motors to control the tilt mechanism. The authors also implemented and tested their PD-based translation and attitude control scheme on the fully actuated prototype quadrotor. To control the hovering and fixed-wing flight of a tilt-rotor UAV and the transition between them, Willis et al. [31] proposed a control scheme, which includes a low-level angular rate controller and a variable mixer, and an LQR following control

We propose a TRQ model based on translational and rotational dynamics, perturbation, and model uncertainty. Note that the SMC presented for an under-actuated quadrotor cannot be directly applied to a tilt-rotor quadrotor. We propose an SMC scheme with control allocation, exploiting the structural features of rotational dynamics and avoiding chattering in translational dynamics to further enhance the robustness and capability of TRQ systems.

The paper is organized as follows: Section 2 discusses the TRQ’s dynamics and various drive modes. Section 3 presents the proposed SMC scheme and control assignment. Section 4 provides a stability analysis. In Section 5, the proposed SMC scheme is applied to a TRQ for numerical simulation. Section 6 gives some conclusions.

2. Dynamic Model of a Tilt-Rotor Quadcopter (TRQ) with Various Actuation Modes

This section will establish a dynamic model from the Newton–Euler equation. First, we present the dynamics of the TRQ (Figure 1). Using the variables defined in the nomenclature, we propose various actuation modes from over-actuated, to fully actuated, to under-actuated modes.

2.1. Rotational and Translational Dynamics

The rotation matrix ${}^{B}R_{P_i}$ from the ith rotor frame to the body frame is

$${}^{B}R_{P_i}=R_Z\left({\beta }_i\right)R_X\left({\alpha }_i\right)$$

(1)

$$R_X\left({\alpha }_i\right)=\left[\begin{array}{ccc}1& 0& 0\\ 0& \cos {\alpha }_i& -\sin {\alpha }_i\\ 0& \sin {\alpha }_i& \cos {\alpha }_i\end{array}\right],$$

and

$$R_Z\left({\beta }_i\right)=\left[\begin{array}{ccc}\cos {\beta }_i& -\sin {\beta }_i& 0\\ \sin {\beta }_i& \cos {\beta }_i& 0\\ 0& 0& 1\end{array}\right], {\beta }_i=\left(i-1\right)\frac{\pi }{2}, i=1, 2, 3, 4.$$

The angular velocity is

$$w_{Pi}={}^{P_i}{R}_B{w}_B+{\left[\begin{array}{ccc}{\dot{\alpha }}_i& 0& w_i\end{array}\right]}^T$$

(2)

We define

$$sgn\left(x\right)=\{\begin{array}{c} 1 if x >0\\ -1 if x <0\end{array}$$

where

$$w_1<0, w_3<0 , w_2>0, w_4>0$$

The rotational dynamics of the TRQ can be formulated as:

$${\tau }_B=I_B{\dot{w}}_B+w_B\times I_B{w}_B+{\displaystyle \sum }_{i=1}^4{}^{B}R_{P_i}{\tau }_{Pi}$$

(3)

where

$${\tau }_{Pi}=I_{Pi}{\dot{w}}_{Pi}+w_{Pi}\times I_{Pi}{w}_{Pi}-{\tau }_{di}$$

(4)

$${\tau }_{di}=\left[\begin{array}{ccc}0& 0& -k_m{w}_i^{2}sgn(\end{array}{w}_i\right){]}^T$$

(5)

The force in the rotor frame is

$$T_{pi}={\left[\begin{array}{ccc}0& 0& k_f{w}_i^2\end{array}\right]}^T$$

(6)

and the toque in body frame is

$${\tau }_B={\displaystyle \sum }_{i=1}^4({}^{B}O_{P_i}\times {}^{B}R_{P_i}{T}_{Pi})$$

(7)

The transform between body angular rates to the Euler rates is

$$\dot{r}=R_T{w}_B$$

(8)

where

$$R_T=\left[\begin{array}{ccc}1& s_{\varphi }\tan \theta & c_{\varphi }\tan \theta \\ 0& c_{\varphi }& -s_{\varphi }\\ 0& s_{\varphi }\sec \theta & c_{\varphi }\sec \theta \end{array}\right]$$

(9)

and $r={\left[\begin{array}{ccc}\varphi & \theta & \psi \end{array}\right]}^T\in R^3$ is the attitude vector of the roll, the pitch, and the yaw angle. We denote $s_{q_i}=\sin q_i$ and $c_{q_i}=\cos q_i$.

Taking the derivative of (8) and ignoring $I_{Pi}$ in (4), we have

$$\ddot{r}={\dot{R}}_T{R}_T^{-1}\dot{r}+R_T{I}_B^{-1}({\tau }_B-w_B\times I_B{w}_B+{\displaystyle \sum }_{i=1}^4{}^{B}R_{P_i}{\tau }_{di})$$

(10)

We denote

$$\tau ={\displaystyle \sum }_{i=1}^4({}^{B}O_{P_i}\times {}^{B}R_{P_i}{T}_{Pi})+{\displaystyle \sum }_{i=1}^4{}^{B}R_{P_i}{\tau }_{di}$$

(11)

Define the transform matrix

$$\Psi =R_T^{-1}$$

(12)

From (8), we have

$$w_B=\Psi \dot{r}$$

(13)

It follows from (10) and (12) that

$$\begin{array}{c}{\Psi }^T{I}_B\Psi \ddot{r}=-{\Psi }^T{I}_B\dot{\Psi }\dot{r}-{\Psi }^T{w}_B\times I_B{w}_B+{\Psi }^T \tau \\ =-\left[{\Psi }^T{I}_B\dot{\Psi }+{\Psi }^T\left(\Psi \dot{r}\times I_B\Psi \right)\right]\dot{r}+{\Psi }^T\tau \end{array}$$

(14)

Considering the perturbation torque ${\tau }_d$, we obtain

$$H\left(r\right)\ddot{r}+C\left(r,\dot{r}\right)\dot{r}={\Psi }^T\left(\tau +{\tau }_d\right)$$

(15)

where

$$H\left(r\right)={\Psi }^T{I}_B\Psi$$

(16)

$$C\left(r,\dot{r}\right)=\left[{\Psi }^T{I}_B\dot{\Psi }+{\Psi }^T\left(\Psi \dot{r}\times I_B\Psi \right)\right]$$

(17)

$$\Psi \left(r\right)=\left[\begin{array}{ccc}1& 0& -s_{\theta }\\ 0& c_{\varphi }& c_{\theta }{s}_{\varphi }\\ 0& -s_{\varphi }& c_{\theta }{c}_{\varphi }\end{array}\right]$$

(18)

and $H\left(r\right) \in R^{3\times 3}$ is the inertia matrix, $C\left(r,\dot{r}\right)\dot{r}\in R^3$ represents the centrifugal and Coriolis forces. $\tau ={\left[\begin{array}{ccc}{\tau }_{\varphi }& {\tau }_{\theta }& {\tau }_{\psi }\end{array}\right]}^T\in R^3$ is the vector of torques and ${\tau }_d\in R^3$ is the perturbation torque.

The velocity in $F_w$ is

$$\dot{p}={}^W{R}_B{V}_B$$

(19)

The derivative of velocity in $F_B$ can be expressed as

$${\dot{V}}_B=-w_B\times V_B+{}^{W}R_B^T{\left[\begin{array}{ccc}0& 0& -g\end{array}\right]}^T+\frac{f}{m}$$

(20)

where

$${}^W{R}_B=\left[\begin{array}{ccc}{c}_{\theta }{c}_{\psi }& s_{\varphi }{s}_{\theta }{c}_{\psi }-c_{\varphi }{s}_{\psi }& c_{\varphi }{s}_{\theta }{c}_{\psi }+s_{\varphi }{s}_{\psi }\\ c_{\theta }{s}_{\psi }& s_{\varphi }{s}_{\theta }{s}_{\psi }+c_{\varphi }{c}_{\psi }& c_{\varphi }{s}_{\theta }{s}_{\psi }-s_{\varphi }{c}_{\psi }\\ -s_{\theta }& s_{\varphi }{c}_{\theta }& c_{\varphi }{c}_{\theta }\end{array}\right]$$

and

$$f={\displaystyle \sum }_{i=1}^4{}^{B}R_{P_i}{T}_{Pi}$$

(21)

where $p={\left[\begin{array}{ccc}x& y& z\end{array}\right]}^T\in R^3$. $f={\left[\begin{array}{ccc}{f}_x& f_y& f_z\end{array}\right]}^T\in R^3$ is the vector of forces.

Taking the derivative of (19), ignoring ${}^W{\dot{R}}_B$ and using (20), the translational dynamics becomes

$$m\ddot{p}={}^W{R}_B=\left(-w_B\times V_B+f\right)-{\left[\begin{array}{ccc}0& 0& mg\end{array}\right]}^T+u_d$$

(22)

where $u_d\in R^3$ is the perturbation force in $F_w$.

2.2. Over-Actuated, Fully Actuated, and Under-Actuated Modes

Denote $\alpha ={\left[{\alpha }_1 {\alpha }_2 {\alpha }_3 {\alpha }_4\right]}^T$,$w={\left[w_1 w_2 w_3 w_4\right]}^T$, $s_i=\sin {\alpha }_i$, and $c_i=\cos {\alpha }_i$, one can arrange (21) and (11) as

$$\left[\begin{array}{c}f\\ \tau \end{array}\right]=\left[\begin{array}{c}{K}_1\left(\alpha \right)\\ K_2\left(\alpha \right)\end{array}\right]U\left(w\right)$$

(23)

where

$$\begin{gathered} U={\left[\begin{array}{ccc}{w}_1^2& \begin{array}{cc}{w}_2^2& w_3^2\end{array}& w_4^2\end{array}\right]}^T \\ K_1\left(\alpha \right)=\left[\begin{array}{ccc}0& k_f{s}_2& \begin{array}{cc} 0& -k_f{s}_4\end{array}\\ -k_f{s}_1& 0& \begin{array}{cc}{k}_f{s}_3 & 0\end{array}\\ k_f{c}_1& k_f{c}_2& \begin{array}{cc}{k}_f{c}_3& k_f{c}_4\end{array}\end{array}\right] \end{gathered}$$

(24)

$$\begin{array}{c}{K}_2\left(\alpha \right)\hfill \\ =\left[\begin{array}{cccc}0& L{k}_f{c}_2-k_m{s}_2& 0& -L{k}_f{c}_4+k_m{s}_4\\ -L{k}_f{s}_1-k_m{s}_1& 0& L{k}_f{c}_3+k_m{s}_3& 0\\ -L{k}_f{s}_1+k_m{c}_1& -L{k}_f{s}_2-k_m{c}_2& -L{k}_f{s}_3+k_m{s}_3& -L{k}_f{s}_4-k_m{s}_4\end{array}\right]\hfill \end{array}$$

(25)

Remark 1.

Over-actuated and fully actuated modes.

For over-actuated mode, the vector of tilt angles is

$$\alpha ={\left[{\alpha }_1 {\alpha }_2 {\alpha }_3 {\alpha }_4\right]}^T$$

By setting ${ \alpha }_3=-{ \alpha }_1,{ \alpha }_4=-{ \alpha }_2$, the vector of tilt angles for fully actuated mode is

$$\alpha ={\left[{\alpha }_1 {\alpha }_2 {\alpha }_1 {\alpha }_2\right]}^T$$

Remark 1.

Under-actuated mode.

By setting $\alpha ={\left[\begin{array}{ccc}0& \begin{array}{cc}0& 0\end{array}& 0\end{array}\right]}^T$, the force and the torque in (23) for the under-actuated mode can be reduced as

$$\left[\begin{array}{c}{f}_z\\ {\tau }_{\varphi }\\ {\tau }_{\theta }\\ {\tau }_{\psi }\end{array}\right]=\left[\begin{array}{cccc}{k}_f& k_f& k_f& k_f\\ 0& L{k}_f& 0& -L{k}_f\\ -L{k}_f& 0& L{k}_f& 0\\ k_m& -k_m& k_m& -k_m\end{array}\right]U\left(w\right)$$

(26)

3. Sliding Mode Path following and Control Allocation

In this section, we first propose the sliding mode-based attitude and position following control via torque and force in (23). Then, we present the control allocation from the control torque and force to the speed and tilt angle of four rotors. Figure 2 illustrates the TRQ control scheme.

3.1. Attitude and Position following SMC

Define $s_1\in R^3$

$${\dot{r}}_r={\dot{r}}_d-{\mathsf{\Lambda }}_1\left(r-r_d\right)$$

(27)

and

$$s_1=\dot{r}-{\dot{r}}_r=\dot{r}-{\dot{r}}_d+{\mathsf{\Lambda }}_1\left(r-r_d\right)$$

(28)

where $r_d$ is the desired attitude and ${\dot{r}}_d$ is the desired angular velocity.

Now, we propose the following control for attitude following to exploit the structure of the rotational dynamics:

$$\tau ={\Psi }^{-T}\left[\widehat{H}{\ddot{r}}_r+\widehat{C}{\dot{r}}_r-K_1 SGN\left(s_1\right)-K_3{s}_1-K_4\tilde{r}\right]$$

(29)

where $\tilde{r}=r-r_d$ and $\widehat{(·)}$ denotes the nominal of $(·)$. $K_1, K_3, K_4$ are positive diagonal matrices, $sgn(·)$ is the sign function, and

$$SGN\left({\left[x_1 x_2 x_3\right]}^T\right)={\left[sgn\left(x_1\right) sgn\left(x_2\right) sgn\left(x_3\right)\right]}^T$$

(30)

We can now define $s_2\in R^3$

$$s_2=\dot{p}-{\dot{p}}_d+{\mathsf{\Lambda }}_2\left(p-p_d\right)$$

(31)

where $p_d$ is the desired position and ${\dot{p}}_d$ is the desired velocity.

The position following control is proposed to alleviate the chattering effects as follows:

$$f={}^W{R}_B^{-1}\left(u+\left[\begin{array}{c}0\\ 0\\ mg\end{array}\right] \right)$$

(32)

where $u$ is designed as follows:

$$\dot{u}=-\left(K_2+{\mathsf{\Lambda }}_2\right)u+\widehat{m}(\left(K_2+{\mathsf{\Lambda }}_2\right){\ddot{p}}_d+{\stackrel{⃛}{p}}_d-K_2{\mathsf{\Lambda }}_2\left(\dot{p}-{\dot{p}}_d\right)-{\mathsf{\Lambda }}_3{s}_2-{\mathsf{\Lambda }}_4 SGN\left(s_2\right))$$

(33)

where $K_2, {\mathsf{\Lambda }}_2,{ \mathsf{\Lambda }}_3, {\mathsf{\Lambda }}_4$ are positive diagonal matrices.

3.2. Control Allocation

3.2.1. Fully Actuated Mode

We use the following assumption for the fully actuated quadcopter system

$${\alpha }_3=-{\alpha }_1, {\alpha }_4=-{\alpha }_2$$

(34)

Now, we propose the following steps to compute ${\alpha }_i$ and $w_i$:

Step 1: Initially, set the tilt angles (${\alpha }_1={\alpha }_2=0)$.

Step 2: Compute $f$ and $\tau$ from (32) and (29).

Step 3: Compute the rotor velocities.

$${\left[\begin{array}{c}{w}_1^2\\ w_2^2\\ w_3^2\\ w_4^2\end{array}\right]=\left[\begin{array}{cccc}{k}_f{c}_1& k_f{c}_2& k_f{c}_3& k_f{c}_4\\ 0& L{k}_f{c}_2-k_m{s}_2& 0& -L{k}_f{c}_4+k_m{s}_4\\ -L{k}_f{c}_1-k_m{s}_1& 0& L{k}_f{c}_3+k_m{s}_3& 0\\ -L{k}_f{s}_1+k_m{c}_1& -L{k}_f{s}_2-k_m{c}_2& -L{k}_f{s}_3+k_m{c}_3& -L{k}_f{s}_4-k_m{c}_4\end{array}\right]}^{-1}\left[\begin{array}{c}{f}_z\\ {\tau }_{\varphi }\\ {\tau }_{\theta }\\ {\tau }_{\Psi }\end{array}\right]$$

(35)

where $s_i=\sin {\alpha }_i$ and $c_i=\cos {\alpha }_i \left(i=1, 2, 3, 4\right)$.

Step 4: Compute the tilt angles from (23) and (24) using (34) as follows:

$${\alpha }_1={\sin }^{-1}\left(\frac{-f_y}{k_f\left(w_1^2+w_3^2\right)}\right)=-{\alpha }_3$$

(36)

$${\alpha }_2={\sin }^{-1}\left(\frac{f_x}{k_f\left(w_2^2+w_4^2\right)}\right)=-{\alpha }_4$$

(37)

Step 5: Go to Step 2 to continue the iteration.

3.2.2. Over-Actuated Mode

We propose the steps to compute ${\alpha }_i$ and $w_i$:

Step 1: Initially, set the tilt angles ${\alpha }_i=0 \left( i=1,2,3,4\right)$.

Step 2: Compute $f$ and $\tau$ from (32) and (29).

Step 3: Compute the rotor velocities from (35).

Step 4: Compute the tilt angles from (23)–(25) as follows:

$$\left(k_f{s}_2\right)w_2^2+\left(-k_f{s}_4\right)w_4^2={\tau }_{\varphi }$$

(38)

$$\left(L{k}_f{c}_2-k_m{s}_2\right)w_2^2+\left(-L{k}_f{c}_4+k_m{s}_4\right)w_4^2={\tau }_{\varphi }$$

(39)

$$\left(-k_f{s}_1\right)w_1^2+\left(k_f{s}_3\right)w_3^2={\tau }_{\theta }$$

(40)

$$\left(-L{k}_f{c}_1-k_m{s}_1\right)w_1^2+\left(L{k}_f{c}_3+k_m{s}_3\right)w_3^2={\tau }_{\theta }$$

(41)

where $s_i=\sin {\alpha }_i$ and $c_i=\cos {\alpha }_i\left(i=1, 2, 3, 4\right)$. Using the triangular identities $s_i^2+c_i^2=1 \left(i=1, 2, 3, 4\right),$ one can use the numerical method to solve for ${\alpha }_i$ in the system of nonlinear equations.

Step 5: Go to Step 2 to continue the iteration.

3.2.3. Under-Actuated Mode

Notice that, due to the lack of control degrees of freedom, the desired attitude ${\varphi }_d$ and ${\theta }_d$ is not arbitrary for the under-actuated quadrotor.

One can obtain ${\varphi }_d$ and ${\theta }_d$ by

$${\varphi }_d={\sin }^{-1}\left(\frac{u_x{s}_{\psi d}-u_y{c}_{\psi d}}{\sqrt{u_{x }^2+u_{y }^2+{\left(u_z+mg\right)}^2}}\right)$$

(42)

$${\theta }_d={\tan }^{-1}\left(\frac{u_x{c}_{\psi d}+u_y{s}_{\psi d}}{u_z+mg}\right)$$

(43)

The vector of $w_i^2$ is

$$\left[\begin{array}{c}{w}_1^2\\ w_2^2\\ w_3^2\\ w_4^2\end{array}\right]={\left[\begin{array}{cccc}{k}_f& k_f& k_f& k_f\\ 0& -L{k}_f& 0& L{k}_f\\ -L{k}_f& 0& L{k}_f& 0\\ k_m& -k_m& k_m& -k_m\end{array}\right]}^{-1}\left[\begin{array}{c}f\\ {\tau }_{\varphi }\\ {\tau }_{\theta }\\ {\tau }_{\psi }\end{array}\right]$$

(44)

4. Stability Analysis

This section presents the stability analysis of the SMC scheme. Let us use ${\lambda }_M\left(A\right), {\lambda }_m\left(A\right)$ for the largest and smallest eigenvalue of a matrix $A$. We denote the Euclidean norm for an $n\times 1$ vector $x$ by $\Vert x\Vert =\sqrt{x^{T}x}$. The inertia matrix is symmetric, positive definite, and bounded by $0<{\lambda }_m\left(H\right)\le \Vert H\left(r\right)\Vert \le {\lambda }_M\left(H\right).$ The matrix $\dot{H}\left(r\right)-2C\left(r,\dot{r}\right)$ is skew-symmetric.

4.1. Sliding Mode Attitude following Control

Theorem 1.

Consider the dynamic model described in (15) and the control for attitude following in (29). The attitude following error dynamics is exponentially stable if the switching gain satisfies the following condition.

$${\lambda }_m(K_1)\ge \left(\Vert \tilde{H}\Vert \Vert {\ddot{r}}_r\Vert +\Vert \tilde{C}\Vert \Vert {\dot{r}}_r\Vert +\Vert {\tau }_d\Vert \right)+{\epsilon }_1$$

(45)

where${\epsilon }_1$is a positive constant.

Proof. 

$\widehat{H}$ and $\widehat{C}$ represent the nominal $H$ and $C$, where $\tilde{H}=H-\widehat{H}$ and $\tilde{C}=C-\widehat{C}.$

The rotational dynamics can be expressed as follows:

$$\widehat{H}\left(q\right)\ddot{r}+\widehat{C}\left(r,\dot{r}\right)\dot{q}={\Psi }^T\left(\tau +{\tau }_d\right)+h_1\left(r,\dot{r},\ddot{r}\right)$$

(46)

$$h_1\left(r,\dot{r},\ddot{r}\right)=-\tilde{H}\left(r\right)\ddot{r}-\tilde{C}\left(r,\dot{r}\right)\dot{r}$$

Define

$${\dot{r}}_r={\dot{r}}_d-{\mathsf{\Lambda }}_1\left(r-r_d\right)$$

(47)

and

$$s_1=\dot{r}-{\dot{r}}_r=\dot{r}-{\dot{r}}_d+{\mathsf{\Lambda }}_1\left(r-r_d\right)$$

(48)

It follows from (48) that

$${\dot{s}}_1=\ddot{r}-{\ddot{r}}_r=\ddot{r}-{\ddot{r}}_d+{\mathsf{\Lambda }}_1\left(\dot{r}-{\dot{r}}_d\right)$$

(49)

Now, we propose the control

$$\tau ={\Psi }^{-T}\left[\widehat{H}{\ddot{r}}_r+\widehat{C}{\dot{r}}_r-K_1 SGN\left(s_1\right)-K_3{s}_1-K_4\tilde{r}\right]$$

(50)

where $\tilde{r}=r-r_d$ and $K_1, K_3,$ and $K_4$ are diagonal matrices. □

Define the Lyapunov function

$$V_1=\frac{1}{2}{s}_1^{T}M\left(r\right)s_1+\frac{1}{2}{\tilde{r}}^T{K}_4\tilde{r}$$

(51)

Using (50) and taking derivative of $V_1$ yield

$${\dot{V}}_1=s_1^{T}H{\dot{s}}_1+\frac{1}{2}{s}_1^T\dot{H}{s}_1+{\tilde{r}}^T{K}_4\dot{\tilde{r}}$$

(52)

If the switching gain meets the condition as follows

$${\lambda }_m(K_1)\ge \left(\Vert \tilde{H}\Vert \Vert {\ddot{r}}_r\Vert +\Vert \tilde{C}\Vert \Vert {\dot{r}}_r\Vert +\Vert {\tau }_d\Vert \right)+{\epsilon }_1$$

(53)

where ${\epsilon }_1$ is a positive constant.

From (52), we have

$${\dot{V}}_1\le -{\epsilon }_1 s_1^{T}SGN\left(s_1\right)-s_1^T{K}_3{s}_1-{\tilde{r}}^T{K}_4\tilde{r}<0 , s_1\ne 0$$

(54)

The following adaptation law can replace the switching gain $K_1$

$$K_1=diag\left(\left[k_1 k_2 k_3\right]\right)$$

(55)

$$k_i\left(t\right)=k_{ci}\left|{\eta }_i\right|+k_{mi}$$

where $k_{ci}>0, k_{mi}>0$ and ${\eta }_i$ is the obtained by filtering the $sgn\left(s_{1i}\right)$ using a low-pass filter

$${\mathsf{\zeta }}_{\mathrm{i}} {\dot{\eta }}_i+{\eta }_i=sgn\left(s_{1i}\right), {\eta }_i\left(0\right)=0$$

(56)

where ${\zeta }_i$ is a positive constant.

4.2. Sliding Mode Position following Control

Theorem 2.

Consider the translational dynamic model described in (21) and the control for position following in (32)–(33). The position following error dynamics is then asymptotically stable.

Proof. 

The translational dynamics is

$$\ddot{p}=\frac{1}{m}u+\frac{u_d}{m}$$

(57)

where

$$u=\left[\begin{array}{c}{u}_x\\ u_y\\ u_z\end{array}\right]={}^W{R}_{B}f-\left[\begin{array}{c}0\\ 0\\ mg\end{array}\right]$$

(58)

The nominal dynamics is

$$\ddot{p}=\frac{1}{\widehat{m}}u+\frac{{\widehat{u}}_d}{\widehat{m}}$$

(59)

where $\widehat{m}$ is the nominal mass and ${\widehat{u}}_d=0$.

The sliding surface $s_2\in R^3$ is

$$s_2=\dot{p}-{\dot{p}}_d+{\mathsf{\Lambda }}_2\left(p-p_d\right)$$

(60)

Using (57) yields

$${\dot{s}}_2=\frac{1}{\widehat{m}}u-{\ddot{p}}_d+{\mathsf{\Lambda }}_2\left(\dot{p}-{\dot{p}}_d\right)$$

(61)

and

$${\dot{s}}_2=\frac{1}{\widehat{m}}\dot{u}-{\stackrel{⃛}{p}}_d+{\mathsf{\Lambda }}_2\left({\dot{s}}_2-{\mathsf{\Lambda }}_2\left(\dot{p}-{\dot{p}}_d\right) \right)$$

(62)

Define the Lyapunov function

$$V_2=\frac{1}{2}{s}_2^T{\mathsf{\Lambda }}_3{s}_2+\frac{1}{2}{\dot{s}}_2^T{\dot{s}}_2+\gamma ABS\left(s_2\right)$$

(63)

where

$$\gamma =\left[{\gamma }_1 {\gamma }_2 {\gamma }_3\right]$$

It follows from (63) that

$${\dot{V}}_2={\dot{s}}_2^T\left({\ddot{s}}_2+{\mathsf{\Lambda }}_3{s}_2+{\mathsf{\Lambda }}_4 SGN\left(s_2\right)\right)$$

(64)

where ${\mathsf{\Lambda }}_4$ is a diagonal matrix with diagonal elements $\left[{\gamma }_1 {\gamma }_2 {\gamma }_3\right]$.

Then

$${\ddot{s}}_2+{\mathsf{\Lambda }}_3{s}_2+{\mathsf{\Lambda }}_4 SGN\left(s_2\right)=-K_2{\dot{s}}_2$$

(65)

and

$${\dot{V}}_2=-K_2{\dot{s}}_2^T{\dot{s}}_2$$

(66)

Using (62) and (65) yields

$$\dot{u}=\widehat{m}(-\left(K_2+{\mathsf{\Lambda }}_2\right){\dot{s}}_2-{\mathsf{\Lambda }}_3{s}_2-{\mathsf{\Lambda }}_4 SGN\left(s_2\right)+{\stackrel{⃛}{p}}_d+{\mathsf{\Lambda }}_2^2\left(\dot{p}-{\dot{p}}_d\right))$$

(67)

Substituting ${\dot{s}}_2$ from (61) into (64), we have

$$\dot{u}=-\left(K_2+{\mathsf{\Lambda }}_2\right)u+\widehat{m}(\left(K_2+{\mathsf{\Lambda }}_2\right){\ddot{p}}_d+{\stackrel{⃛}{p}}_d-K_2{\mathsf{\Lambda }}_2\left(\dot{p}-{\dot{p}}_d\right)-{\mathsf{\Lambda }}_3{s}_2-{\mathsf{\Lambda }}_4 SGN\left(s_2\right))$$

(68)

We can derive from LaSalle-Yoshizawa theorem and (66) that ${\dot{s}}_2\to 0.$ On the basis of (62) and the Barbalat’s lemma, one can conclude that ${\ddot{s}}_2\to 0$. Therefore, we have the following from (65)

$${\mathsf{\Lambda }}_3{s}_2=-{\mathsf{\Lambda }}_4 SGN\left(s_2\right)$$

(69)

which ensures that

$$s_2=0$$

(70)

□

5. Numerical Simulation

To illustrate the proposed control scheme’s design, we give an example of a fully actuated TRQ.

5.1. Simulation Parameters

Assuming $s_{q_i}=\sin q_i, c_{q_i}=\cos q_i,$ we have

$$\begin{array}{c}{H}_{11}=I_x,H_{12}=0, H_{13}=-I_x{s}_{\theta }\\ H_{22}=I_y{c}_{\varphi }^2+I_z{s}_{\varphi }^2, H_{23}=c_{\theta }{c}_{\varphi }{s}_{\varphi }\left(I_y-I_z\right)\\ H_{33}=I_x{s}_{\theta }^2+I_y{c}_{\theta }^2{s}_{\varphi }^2+I_z{c}_{\theta }^2{c}_{\varphi }^2\end{array}$$

The matrix of $C\left(r,\dot{r}\right)$ is

$$\begin{array}{c}{C}_{11}=0\\ C_{12}=-I_x\dot{\psi }{c}_{\theta }+\left(I_y-I_z\right)\left(\dot{\theta }{s}_{\varphi }{c}_{\varphi }+\dot{\psi }{c}_{\theta }{s}_{\varphi }^2-\dot{\psi }{c}_{\theta }{c}_{\varphi }^2\right)\\ C_{13}=-I_y\dot{\psi }{c}_{\theta }^2{s}_{\varphi }{c}_{\varphi }+I_z\dot{\psi }{c}_{\theta }^2{s}_{\varphi }{c}_{\varphi }\\ C_{21}=I_x\dot{\psi }{c}_{\theta }-\left(I_y-I_z\right)\left(\dot{\theta }{s}_{\varphi }{c}_{\varphi }+\dot{\psi }{c}_{\theta }{s}_{\varphi }^2-\dot{\psi }{c}_{\theta }{c}_{\varphi }^2\right)\\ C_{22}=-I_y\dot{\varphi }{s}_{\varphi }{c}_{\varphi }+I_z\dot{\varphi }{s}_{\varphi }{c}_{\varphi }\\ C_{23}=-I_x\dot{\psi }{s}_{\theta }{c}_{\theta }+I_y\dot{\psi }{s}_{\theta }{c}_{\theta }{s}_{\varphi }^2+I_z\dot{\psi }{s}_{\theta }{c}_{\theta }{c}_{\varphi }^2\\ C_{31}=-I_x\dot{\theta }{c}_{\theta }+I_y\dot{\psi }{c}_{\theta }^2{s}_{\varphi }{c}_{\varphi }-I_z\dot{\psi }{c}_{\theta }^2{s}_{\varphi }{c}_{\varphi }\\ C_{32}=I_x\dot{\psi }{s}_{\theta }{c}_{\theta }+(I_z-I_y)\left(\dot{\theta }{s}_{\theta }{s}_{\varphi }{c}_{\varphi }+\dot{\varphi }{c}_{\theta }{s}_{\varphi }^2-\dot{\varphi }{c}_{\theta }{c}_{\varphi }^2\right)-I_y\dot{\psi }{s}_{\theta }{c}_{\theta }{s}_{\varphi }^2-I_z\dot{\psi }{s}_{\theta }{c}_{\theta }{c}_{\varphi }^2 \\ C_{32}=I_x\dot{\psi }{s}_{\theta }{c}_{\theta }+(I_z-I_y)\left(\dot{\theta }{s}_{\theta }{s}_{\varphi }{c}_{\varphi }+\dot{\varphi }{c}_{\theta }{s}_{\varphi }^2-\dot{\varphi }{c}_{\theta }{c}_{\varphi }^2\right)-I_y\dot{\psi }{s}_{\theta }{c}_{\theta }{s}_{\varphi }^2-I_z\dot{\psi }{s}_{\theta }{c}_{\theta }{c}_{\varphi }^2\\ C_{33}=I_x\dot{\theta }{s}_{\theta }{c}_{\theta }+I_y\left(-\dot{\theta }{s}_{\theta }{c}_{\theta }{s}_{\varphi }^2+\dot{\varphi }{c}_{\theta }^2{s}_{\varphi }{c}_{\varphi }\right)-I_z\left(\dot{\theta }{s}_{\theta }{c}_{\theta }{c}_{\varphi }^2+\dot{\varphi }{c}_{\theta }^2{s}_{\varphi }{c}_{\varphi }\right)\end{array}$$

We employ the following variables for simulation:

$$\begin{array}{c}m=2\mathrm{kg}, L=0.275\mathrm{m},g=9.81\mathrm{m}/{\mathrm{s}}^2,\\ I_x=0.025{\mathrm{kgm}}^2, I_y=0.025{\mathrm{kgm}}^2,I_z=0.040{\mathrm{kgm}}^2,\\ k_m=2.67·{10}^{-7}{\mathrm{Ns}}^2, k_f=1.5·{10}^{-5}{\mathrm{Nms}}^2.\end{array}$$

with initial conditions

$$\left[\begin{array}{ccc}x\left(0\right)& y\left(0\right)& z\left(0\right)\end{array}\right]=\left[\begin{array}{ccc}0& 0& 0\end{array}\right]$$

and the desired positions

$$\left[\begin{array}{ccc}{x}_d\left(t_f\right)& y_d\left(t_f\right)& z_d\left(t_f\right)\end{array}\right]=\left[\begin{array}{ccc}20& 10& 5\end{array}\right]$$

where $t_f=20.$ The desired attitudes are

$${\varphi }_d=0, {\theta }_d=0, {\psi }_d=0$$

The desired path is defined as

$$\begin{array}{c}{x}_d\left(t\right)=2.5·{10}^{-2} t^3-1.875·{10}^{-3} t^4+3.75·{10}^{-5} t^5\\ y_d\left(t\right)=1.25·{10}^{-2} t^3-9.375·{10}^{-4} t^4+1.875·{10}^{-5} t^5\\ z_d\left(t\right)=6.25·{10}^{-3} t^3-4.6875·{10}^{-4} t^4+9.375·{10}^{-6} t^5\end{array}$$

Now, we use the following control parameters for simulation:

$$\begin{array}{c}{\mathsf{\Lambda }}_1=10 I_2 ,{\mathsf{\Lambda }}_2=4I_3, {\mathsf{\Lambda }}_3=40 I_3, {\mathsf{\Lambda }}_4=I_3,K_1=I_3,\\ K_2=4I_3,K_3=4I_3, K_4=10I_3,k_{ci}=4I_3, k_{mi}=0.1I_3, \left(i=1,2,3\right).\end{array}$$

5.2. Simulation Results

We present the simulation results of the proposed attitude and position following SMC control in Figure 3, Figure 4, Figure 5, Figure 6, Figure 7 and Figure 8. Figure 3 and Figure 4 show the attitude and position trajectories of the quadrotor with variable changes (weights increased to 125%). The simulation results in Figure 3 and Figure 4 show that the proposed SMC can successfully drive the quadrotor from the initial position through the desired path to the final destination while maintaining the desired attitude. Figure 5 and Figure 6 show the lift and steering torque produced by the four tilt-rotors of the TRQ. Figure 7 shows the path of the tilt angle with parameter deviation. The corresponding quadrotor speeds are shown in Figure 8.

Because the stability analysis in the previous section demonstrated robustness with respect to parameter uncertainty and external perturbations, we then further evaluated the impact of external perturbations on the TRQ. We used perturbation force [sin(4t) − sin(4t) 2sin(4t)] N and perturbation torque [0.1sin(2t) 0.1sin(2t) 0.1sin(2t)] Nm applied to TRQ for simulated motion. As shown in Figure 9, Figure 10, Figure 11, Figure 12, Figure 13 and Figure 14, we can see that the perturbation has little effect on the capability of the quadcopter because the proposed control and control assignment can reject the perturbation and return the state variables to the sliding surface.

In summary, the numerical simulation results clearly show that the proposed SMC schemes can accomplish the goal of trajectory tracking and counter the parametric variation and external disturbances in the rotation and translation of TRQ via control allocation.

6. Conclusions

This paper presents the dynamic modeling, path following, and control allocation of a TRQ. Two types of SMC are proposed to enhance the robustness and capability: one is the first-order sliding mode for attitude following and the other is the second-order sliding mode for position following. Considering the parameter changes and external perturbation, we show the stability analysis based on the Lyapunov theory that the proposed control scheme can ensure the error dynamics’ asymptotic stability for the position and attitude following. In the numerical simulation of the fully actuated mode, we demonstrated that the proposed SMC could achieve path following and attitude regulation goals in the presence of variable changes and external perturbations. The tilt-rotor quadrotor has more control degrees of freedom than the under-actuated quadrotor and, therefore, can make full use of the control redundancy to complete the simultaneous trajectory tracking and attitude control that a traditional quadrotor cannot do, and thus has a certain degree of actuator fault tolerance. In the future, we will integrate the sliding mode path following and control allocation into a fault-tolerant flight control.