Open access peer-reviewed chapter - ONLINE FIRST

Robust Hybrid Model Reference Adaptive Control and Output-Feedback Linearization with Applications to Quadcopter UAVs

Written By

Giri M. Kumar, Mattia Gramuglia and Andrea L’Afflitto

Submitted: 30 January 2024 Reviewed: 02 February 2024 Published: 02 April 2024

DOI: 10.5772/intechopen.1004814

Latest Adaptive Control Systems IntechOpen
Latest Adaptive Control Systems Edited by Petros Ioannou

From the Edited Volume

Latest Adaptive Control Systems [Working Title]

Dr. Petros Ioannou

Chapter metrics overview

8 Chapter Downloads

View Full Metrics

Abstract

This chapter presents the first robust model reference adaptive control (MRAC) system for hybrid, time-varying plants affected by parametric, matched, and unmatched uncertainties as well as uncertainties in the plant’s discrete-time dynamics. This continuous-time component of this MRAC system comprises both an adaptive law and a control law that are analogous to the adaptive law and control law of classical MRAC systems. The discrete-time component of the proposed MRAC system comprises a resetting mechanism that counters the effect of resetting events in the plant dynamics. The mechanisms that guarantee robustness to unmatched uncertainties extend the well-known σ-modification and e-modification of MRAC as well as the use of continuous projection operators to a hybrid systems framework. This adaptive control framework is applied to the problem of controlling output-feedback linearized dynamical models while switching among multiple feedback-linearizing output signals according to any user-defined algorithm that is compatible with the conditions sufficient for the existence of the linearizing diffeomorphism. As an example, we solve the problem of controlling the dynamics of a quadcopter unmanned aerial vehicle (UAV) tasked with following both a user-defined trajectory and a user-defined attitude, and not just a user-defined yaw angle as it occurs in the overwhelming majority of works on this topic.

Keywords

  • hybrid dynamical systems
  • robust model reference adaptive control
  • output-feedback linearization
  • uncertain systems
  • quadcopters

1. Introduction

This chapter presents the first robust model reference adaptive control (MRAC) system for hybrid plants affected by parametric, matched, and unmatched uncertainties. Hybrid plants comprise dynamical models of processes that can be captured by means of both differential and difference equations. Differential equations allow describing continuous-time phenomena, whereas difference equations allow describing discrete-time phenomena. Examples of such plants include mechanical systems, whose continuous-time dynamics experience instantaneous variations due to external solicitations, elastic effects, or sudden variations in the characterizing parameters such as friction coefficients [1, 2]. Additional examples of such plants include those systems, whose dynamics are affected by continuous-time effects, both exogenous, such as disturbances, and endogenous, such as control inputs, as well as by discrete-time effects, such as decision variables drawn from a countable set of possible choices [3]. The proposed MRAC system is proven to be robust to uncertainties in both the plant’s continuous-time dynamics and in its discrete-time dynamics.

The proposed results extend the results presented in [4], which propose the first MRAC system for nonlinear hybrid plants, whose dynamics are affected by matched and parametric uncertainties, to the case wherein the plant dynamics are affected by unmatched uncertainties as well. This extension has been possible by leveraging the first generalization of the LaSalle-Yoshizawa theorem to prove the pre-attractivity of compact sets for nonlinear, time-varying, hybrid systems. Furthermore, this chapter extends for the first time classical results such as the e-modification of MRAC [5], the σ-modification of MRAC [6], and the use of continuous projection operators [7] to nonlinear, time-varying, uncertain hybrid plants. Specifically, the proposed MRAC system robustifies the results in [4] with mechanisms that are analogous to the aforementioned classical robustifications of MRAC, while retaining its peculiar resetting mechanism of the reference model’s dynamics. Such a mechanism, which is impossible to deduce applying classical Lyapunov-like sufficient conditions predicated assuming continuity of the system’s dynamics with respect to time and Lipschitz continuity with respect to the state, allows the state of the reference model to instantaneously reduce the trajectory tracking error and ease its convergence to zero. The time at which these resetting events in the reference model occur is computed as the time at which the energy injected into the controlled system by the uncertain discrete-time dynamics exceeds the energy dissipated by the control system’s continuous-time dynamics.

The application of the proposed robust hybrid MRAC system is unique and opens the way to new research ideas in the context of output-feedback linearization [8]. Indeed, the proposed adaptive control system is applied to regulate output-feedback linearized dynamical systems, whose measured output, which defines the feedback-linearizing diffeomorphism, is arbitrarily switched by the user over a countable set of alternative options. To illustrate this idea, we consider the problem of controlling a quadcopter UAV by means of an output-feedback linearizing system, which serves as a baseline controller, and a robust MRAC system to improve the tracking performance despite uncertainties and disturbances. The overwhelming literature on the control of quadcopter UAVs by means of output-feedback linearization consider only one measured output, namely, the UAV’s position and yaw angle; see [9, 10, 11] for some of the latest references on this topic of a conspicuous list. To the authors’ knowledge, alternative output functions, such as the UAV’s position and any of the other two Euler’s angles, which are commonly available for measurement using any commercial-off-the-shelf autopilot, such as those based on PX4 [12] or Ardupilot [13] to name two of the most popular ones, are not considered. The reasons for this choice substantially stem from the fact that output-feedback linearization with respect to the vehicle’s position and yaw angle only requires a non-zero total thrust at all times, which is realistic in most problems of practical interest, where free fall of the UAV is not required. Output-feedback linearization with respect to the vehicle’s position and either pitch or roll angle requires additional constraints on the vehicle’s attitude, which do not allow hovering and pose challenges in near-equilibrium maneuvers. Furthermore, most applications considered so far can be performed by simply tasking the UAV to follow some user-defined trajectory for its center of mass and some yaw angle. Indeed, onboard vision-based sensors, such as cameras or Lidars, are generally aligned with the UAV’s roll axis and quadcopter UAVs usually operate in near-hover conditions. The proposed idea of using a hybrid MRAC system to regulate the feedback-linearized equations of motion of a quadcopter UAV allows the user to arbitrarily choose the measured output and control all six of the UAV’s degrees of freedom by cycling through multiple output functions, and not only four degrees of freedom, as it occurs in existing control architectures for this class of aerial robots.

Numerical simulations prove the effectiveness of the proposed robust hybrid MRAC framework and its applicability to a variable output-feedback linearizing framework. Numerical evidence also shows how the proposed user-defined reference trajectory, yaw, pitch, and roll angles are impossible to follow without the proposed hybrid framework.

This chapter is structured as follows. In Section 2, we present the notation used in this chapter. In Section 3, we present a sufficient condition on the pre-attractivity of compact sets for nonlinear, time-varying hybrid plants. Section 4 illustrates the first key result of this chapter, namely a robust MRAC system for hybrid plants. Successively, the equations of motion of a quadcopter UAV are recalled in Section 5. Section 6 presents the second key result of this chapter, namely the application of the proposed adaptive hybrid system control framework to the feedback-linearized equations of motion of a quadcopter UAV. In Section 7, we discuss the applicability and the features of the proposed results by means of a numerical example. Finally, Section 8 draws conclusions and outlines future work directions.

Advertisement

2. Mathematical notation

Let N denote the set of positive integers, R the set of real numbers, Rn the set of n×1 real column vectors, and Rn×m the set of n×m real matrices. The interior of the set SRn is denoted by S, the boundary of SRn is denoted by E, and the closure of S is denoted by S¯. The open ball of radius ρ>0 centered at xRn is denoted by ρx.

The transpose of BRn×m is denoted by BT, and the zero vector in Rn is denoted by 0n or 0, the zero n×m matrix in Rn×m is denoted by 0n×m or 0, and the identity matrix in Rn×n is denoted by 1n. The diagonal matrix whose entries are give by x1,,xn is denoted by diagx1xn. The block-diagonal matrix formed by MiRni×ni, i=1,,p, is denoted by M=blockdiagM1Mp. The distance between the point xRn and the set S is denoted by distxS ([14], p. 16). We write for the Euclidean vector norm and the corresponding equi-induced matrix norm ([15], Def. 9.4.1).

Advertisement

3. A sufficient condition on uniform pre-attractivity of compact sets

In this section, we recall elements of hybrid systems theory, which are essential to our discussion and recall the first extension of the LaSalle-Yoshizawa theorem to time-varying, nonlinear, hybrid dynamical system. Time-varying, hybrid dynamical systems can be captured by

ẋt=fctxt,txtD,E1
xt+=gdtxt,txtD,E2

with xt0=x0 and initial time t00. Let ZRn be an open set such that 0Z. The flow map, fc:t0×ZRn is Lebesgue integrable, locally bounded, and such that fct0n=0n for all tt0. The jump map gd:t0×ZRn is continuous and locally bounded. A resetting event occurs whenever txtD for some tt0. The resetting time before tt0 is defined as tkminttk1:tsttk1xk1D for all kN, where s:t0×0×ZZ denotes the flow of solutions of (1) and (2). The system (1) and (2) is assumed to be left-continuous ([16], Def. 12.1). We also assume that t0x0D. The case whereby t0x0D can be addressed applying similar arguments. In this chapter, we consider Krasovskii solutions of (1) and (2) [17] and make the following assumption to avoid beating, that is, to prevent solutions of (1) and (2) from incurring into the same resetting event multiple times in zero time.

Assumption 3.1 Consider the system given by (1) and (2). If txtD¯\D, then there exists ε>0 such that, for all δ0ε, st+δtxtD Furthermore, if tkxtkDD, then there exists ε>0 such that, for all δ0ε, stk+δtkxtk+D.

The following result provides a sufficient condition for uniform boundedness and the convergence of complete solutions of (1) and (2) to a compact set. To state this result, let x:t0Z denote a solution of (1) and (2). Furthermore, let V:t0×ZR be absolutely continuous over compact intervals of t0 not containing resetting times in their interior for each xZ, and, for each tt0, Lipschitz continuous and regular over Z; for the definition of regular functions and the notion of derivative of regular functions, see ([18], pp. 63–64; [19], p. 39; and [20]).

Let W:ZR be absolutely continuous and nonnegative definite. Let t¯kt0, kN¯, such that t¯0=t0, t¯1=t1, if j=1k1V(tj+x(tj+))V(tjxtj)>0, kN\1, along a solution of (1) and (2), then

t¯k=inftt0:t0tWxτdτj=1k1V(tj+x(tj+))V(tjx(tj)),E3

and if j=1k1V(tj+x(tj+))V(tjxtj)0, then t¯k=t1. Finally, the critical times are defined as

t̂kmaxtkt¯k.E4

Theorem 1.1 ([4], Th. 2) Consider the hybrid, time-varying, nonlinear dynamical system given by (1) and (2), and assume that all solutions of (1) and (2) are complete. Let V:t0×ZR be absolutely continuous in its first argument over compact intervals of t0R¯+ that do not contain resetting times in their interior for each xZ and Lipschitz continuous and regular in the second argument for each tt0. Assume that t̂ktk for all kN¯, k=1V(tk+x(tk+))V(tkx(tk)) exists and is finite, and

W1xVtxW2x,txt0×Z,E5
V̇txWx,txt0×Z\A¯D,E6

where W1,W2:ZR are positive-definite, A¯Z is compact and such that 0A^, and W:ZR is continuously differentiable on Z\0n, nonnegative-definite, and such that Wx>0 for all xZ\A¯. Let r>0 and c>0 be such that BrA¯Z and c<minxBrA¯W1x. If xt0xBrA¯:W2xc, then every maximal solution xt, tt0, of (1) and (2) is bounded uniformly in tkkN¯ and such that limtdistxtA¯=0 uniformly in tkkN¯. Additionally, if Z=Rn and both W1 and W2 are radially unbounded, then every maximal solution x of (1) and (2) is uniformly bounded in tkkN¯ and such that limtdistxtA¯=0 for all x0Rn uniformly in tkkN¯.Theorem 1.1 provides Lyapunov-like sufficient conditions on the local and global uniform pre-attractivity of the compact set A¯ ([21], Def. 7.1), that is, on the property whereby complete solutions of (1) and (2) converge to A¯. This result extends a notorious theorem for uniform ultimate boundedness ([22], Def. 4.6) of nonlinear time-varying dynamical systems that are continuous in time and Lipschitz continuous in the state vector, namely Theorem 4.18 of [22].

Advertisement

4. Robust model reference adaptive control for hybrid systems

This section presents the first key contribution of this chapter, namely present the first MRAC system robust to parametric, matched, and unmatched uncertainties. Section 4.1 outlines the plant and reference model dynamics. Section 4.2 presents three robust control systems, which extend the classical e-modification of MRAC [5], the σ-modification of MRAC [6], and the use of continuous projection operators [7] to hybrid plants. Finally, Section 4.3 leverages the results of Section 3 and proves the effectiveness of these control systems.

4.1 Plant and reference model dynamics

In this section, we present multiple robust MRAC schemes for nonlinear, time-varying, hybrid plants with modeling and parametric uncertainties, and uncertainties in the resetting events. To this goal, consider the plant model

ẋtσ̇t=Aσtxt+Bσtut+Θ˜σtTΦ˜σt(txt)0+ξσtt0,xt0σt0=x0σ0,txtDσt,E7
xt+σt+=gd,σttxt,txtDσt,E8

where xσ:t0Rn denotes the plant state, σ:t0Σ denotes the mode, ΣN comprises the first σmax positive integers, the piecewise continuous function u:t0Rm denotes the control input, AσRn×n, σΣ, is unknown, the mapping σAσ is unknown, BσRn×m is known, the pair AσBσ is controllable, Θ˜σRN˜σ×m is unknown, the mapping σΘ˜σ is unknown, the regressor vector Φ˜σ:t0×RnRN˜σ is Lipschitz continuous and known, ξσ:t0Rn is unknown, piecewise continuous, and such that ξσtξσ,max, ξσ,max0 is known, the mapping σξσ is unknown, and the mapping σξσ,max is known. The i-th resetting time of the resetting event Dσi1, iσN×Σ is given by

tplant,i=mint>tplant,i1:tsσi1ttplant,i1xi1Dσi1,E9

where σi1iNΣ, sσi1tplant,i1xi1 denotes the flow of the plant (7) and (8) originated by the Dσi1 resetting event at time tplant,i1 and from the initial condition xi1. In this chapter, the jump map gd,σ, σΣ, is known and uncontrollable, and the resetting events DσσΣt0×Rn are unknown. We also assume that, with any piecewise continuous control input u, (7) and (8) verify Assumption 3.1. In problems involving mechanical systems subject to elastic collisions, Assumption 3.1 is verified if collisions do not occur in arbitrarily small time intervals, which is a realistic modeling assumption.

Next, consider the reference model

ẋreftσ̇t=Aref,σtxreft+Bref,σtrt0,xreft0σt0=xref,0σ0,txreftDref,σt,E10
xreft+σt+=gd,ref,σttxreft,txreftDref,σt,E11

where Aref,σRn×n, σΣ, is Hurwitz and such that

Aref,σ=Aσ+BσKx,σTE12

for some Kx,σRn×m, Bref,σRn×m is such that

Bref,σ=BσKr,σTE13

for some Kr,σRm×m, and the reference command input r:t0Rm is piecewise continuous and bounded. The reference model’s dynamics capture the desired closed-loop system’s dynamics. The jump map gd,ref,σ and the set of resetting events Dref,σσΣ are presented in the following. The matching conditions (12) and (13) signify that, for each mode, the reference model dynamics can be mimicked by the controlled plant dynamics.

4.2 Control system outline

Our goal is to derive adaptive control laws to steer the trajectories of (7) and (8) toward the trajectories of the reference model (10) and (11), despite uncertainties in the plant model. To this goal, let

etxtxreft,tt0,E14

denote the trajectory tracking error. Furthermore, define

ΦσtxxTrTtΦ˜σT(tx)T,σtxΣ×t0×Rn,E15
ΘσKx,σTKr,σTΘ˜σTT,E16
Φ¯σtxχΣ1σΦ1T(tx)χΣpσΦpT(tx)T,E17
ΘΘ1TΘpTT,E18

and N2n+m+σ=1pNσ, and note that

ėtσ̇t=Aref,σtet+BσtutΘTΦ¯σt(txt)0+ξσtt0,et0σt0=x0xref,0σ0,(txt)Dσt(txreft)Dref,σt,E19
et+σt+=gd,σttxtgd,ref,σttxreft,(txt)Dσt(txreft)Dref,σt,E20

where represents the operator and, represents the operator or, ΣjΣ denotes the j-th of σmax partitions of Σ, and χΣj:Σj01 symbolizes the indicator function.

Remark 4.1 The hybrid dynamical systems given by (7) and (8), (10) and (11), and (19) and (20) can be reduced to the same form as (1) and (2) by proceeding as in [17].To pursue our goal, consider also the control law

ηΘ̂Φ¯σtx=Θ̂TΦ¯σtx,σtxΘ̂Σ×t0×Rn×RN×m,E21

and the adaptive laws

Θ̂̇t=Θ̂dtγσtΘ̂tσmod.,E22
Θ̂̇t=Θ̂dtγσteTPσtBσtΘ̂temod.,E23
Θ̂̇t=ProjσtΘ̂tΘ̂dtproj.operator,E24

with

Θ̂dtΓσtΦ¯σttxteTtPσtBσt,E25

Θ̂t0=Θ̂0, and tt0. These adaptive laws are to be considered as alternatives to one another, and capture extensions to hybrid systems of the the σ-modification of MRAC [6], the e-modification of MRAC [5], and the projection operator [23], respectively. In (22)(24), the adaptive rate matrix ΓσRN×N, σΣ, is positive-definite, γσ>0, PσRn×n is the positive-definite and such that

0n×n=Aref,σTPσ+PσAref,σ+Qσ,E26

and QσRn×n is user-defined and positive-definite. To define the matrix projection operator in (24), firstly consider the definition of vector projection operator.

Definition 4.1 Let XRn be convex, and let hσ:XR, σΣ, denote a continuously differentiable convex function over X such that infxXhσx<0. The vector projection operator induced by hσ over X is defined as projσ:X×RnRn, σΣ, such that if xxdSσ, then

projσxxdxdhσxhσxxThσxxhσxxhσxxTxd,E27

and if xxdSσ, then

projσxxdxd,E28

where SσxxdX×Rn:hσx>0hσxxxd>0 and σΣ.

Definition 4.2 ([24], Ch. 11) Let XiRN be convex, i=1,,m, and let hσ,i:XiR, σΣ, denote a continuously differentiable convex function over Xi such that infπXihσ,iπ<0. The matrix projection operator induced by hσ,i, σiΣ×1m, over j=1mXi is defined as Projσ:i=1mXi×RN×mRN×m such that

ProjσXXd=projσx1xd,1projσ(xmxd,m),XXdi=1mXi×RN×m,E29

where X=x1xm and Xd=xd,1xd,m.The functions hσ,i, σiΣ×1m, employed to define the vector projection operator, and, hence, the matrix projection operator must be chosen carefully. Indeed, for each σΣ and for all i1m, the solution of

Ẋt=ProjσXtẊt,Xt0=X0,tt0,E30

is such that xitΩ¯σ,i,1 for all tt0, where

Ω¯σ,i,1xiXi:hσ,ix1.E31

Thus, hσ,i must be chosen so that, for each kN and for each i1m, θ̂itkΩ¯σtk+,1, where θ̂i denotes the i-th column of Θ̂.

Next, consider the Lyapunov function candidate

VteΔΘeTPσte+trΔΘTΓ1ΔΘ,tεΔΘt0×Rn×RN×m,E32

where ΔΘtΘ̂tΘ, and we define

Weλ¯minQσσΣe2,eRn,E33

where λ¯minQσσΣminλminQσσΣ. Each of the adaptive laws (22)(24) are switched dynamical systems, that is, they experience discontinuities in their dynamics, but not in their state matrices. Thus, the adaptive gains are computed as Carathéodory continuous solutions of (22)(24). Thus, discontinuities of VtetΘ̂t, tt0, are exclusively due to discontinuities in eTtPσtet.

The set of resetting events of the reference model are defined as Dref,σiwtref,iw×Rn, iwN×N, where

tref,iwinf{t>maxtplant,itref,iw1:t0tWeτdτj=1k1V(tj+etj+Θ̂tj)V(tjetjΘ̂tj)},E34

and k designates the generic index for resetting times. Thus, we partition the set of resetting times of (19) and (20) as tkkN=tplant,iiNiNttran,iwwN. The jump maps gd,ref,σtxref σtxrefΣ×t0×Rn, are such that

xreftref,iw+=xtref,iweTtref,iwPσtref,iwetref,iwzref,iwhrefTtref,iwetref,iwhreftref,iwetref,iwPσtref,iw+12hreftref,iwetref,iw,iwN×N,E35

where href:t0×RnRM is such that

hrefTtεhreftε>0,tεt0×Rn\0,E36

zref,iw0eTtref,iwPσtref,iwetref,iw and is user-defined, the series i=1w=1zref,iw is convergent, and Pσ12Rn×n, σΣ, is symmetric, positive-definite, and such that Pσ=Pσ12Pσ12. An interpretation of the resetting time (34) is the following. This is the time at which the energy injected into the controlled system by the uncertain discrete-time dynamics exceeds the energy dissipated by the control system’s continuous-time dynamics.

To improve the closed-loop trajectory tracking error dynamics at isolated time instants, consider the user-defined time instants i,wNt˜ref,iw, where t˜ref,iw>maxtplant,itref,iw1, iwN×N, and set

xreft˜ref,iw+=xt˜ref,iw,iwN×N.E37

Rearranging the indexes of the plant’s resetting events, these user-defined resetting times will be considered resetting times of the plant, that is, we will set iNwNt˜tran,iwiNtplant,i.

4.3 Main result

The effectiveness of the control law (21) and of the three alternative adaptive laws (22)(24) is captured by the following result. For the statement of this result, if we employ the adaptive laws (22) or (23), then let

A¯=eΔΘ:eceΔΘFcΔΘ,E38

where ΔΘtΘ̂tΘ, tt0. Alternatively, if we employ the adaptive law (24), then let

A¯=eΘ̂:ecemaxσΣhσcoljΘ̂1j=1m.E39

Expressions for ce and cΔΘ are omitted for brevity, and can be deduced by proceeding as in ([24], p. 325).

Theorem 1.2 Consider the trajectory tracking error dynamics (19) and (20), the control law (21), the adaptive laws (22)(24), and the reference model (10) and (11). Assume that ut=ηΘ̂tΦ¯σtxt, tt0 and the matching conditions (12) and (13) are verified. Additionally, if using the adaptive law (24), assume that θiΩ¯σ,i,1 for all σiΣ×1m, where θi denotes the i-th column of Θ given by (18) and Ω¯σ,i,1 is defined in (31). Then, both the trajectory tracking error e and the adaptive gain matrix Θ̂ are bounded uniformly in tkkN¯. Furthermore, there exists a compact set A¯ given by (38) when using (22) or (23) or given by (39) when using (24) such that limtdist(etΔΘt)A¯=0.

Proof: Only the key passages of this proof are presented for brevity. The Lyapunov function candidate (32) is such that

W1eΘ̂VteΘ̂W2eΘ̂,teΔΘt0×Rn×RN×N,E40

where

W1eΘ̂λ¯minPσσΣe2+trΔΘTΓ1ΔΘ,
W2eΘ̂λ¯maxPσσΣe2+trΔΘTΓ1ΔΘ

are radially unbounded. Thus, following classical arguments such as those exposed in ([24], Ch. 11) or ([25], Ch. 8) for each of the adaptive laws (22)(24), we can prove that V̇tetΘ̂t<0 for all eΘ̂A¯, where A¯ is compact and such that 0A.

Next, proceeding as in the proof of Theorem 4 in [4], we can prove that Assumption 3.1 is verified by (19) and (20) and

k=1Vtk+etk+Θ̂tkVtketkΘ̂tk

exists and is finite. Thus, Theorem 1.1 implies that maximal solutions of (19) and (20) and of (22)(24) are uniformly bounded in tkkN¯, and limtdistxtA¯=0 for all e0Θ̂0Rn×RN×m uniformly in tkkN¯.

Advertisement

5. Equations of motion of a quadcopter UAV

In this section, we present the equations of motion of a quadcopter UAV. To this goal, let UAV’s mass be denoted by m>0, let the UAV’s matrix of inertia be captured by the diagonal, positive-definite matrix IdiagI11I22I33R3×3, and let the gravitational acceleration be denoted by g>0. Finally, let the UAV’s position be captured by r:t0R3, the UAV’s roll angle be denoted by ϕ:t0π2π2, the UAV’s pitch angle be denoted by θ:t0π2π2, the UAV’s yaw angle be denoted by ψ:t002π, the UAV’s velocity with respect to the inertial reference frame I be denoted by v:t0R3, the UAV’s angular velocity with respect to I be denoted by ω:t0R3, and the the UAV’s state vector be denoted by xtrTtϕtθtψtvTtωTtT. Note that the UAV’s state vector is usually readily available by employing any commercial-off-the-shelf autopilot system such as those based on PX4 [12] or Ardupilot [13].

Neglecting the inertial counter-torque and the gyroscopic effect [26], the UAV’s continuous-time dynamics are given by

ṙt=vt,rt0=r0,tt0,E41
v̇t=1mRϕtθtψt00u1tT00gT12mρSRTϕtθtψtCDvtvt,vt0=v0,E42
ϕ̇tθ̇tψ̇t=Γ1ϕtθtωt,ϕt0θt0ψt0=ϕ0θ0ψ0,E43
ω̇t=I1u2tu3tu4tω×tt,ωt0=ω0,E44

where the rotation matrix

Rϕθψcosψsinψ0sinψcosψ0001cosθ0sinθ010sinθ0cosθ1000cosϕsinϕ0sinϕcosϕ,ϕθψπ2π2×π2π2×02π,E45

captures the UAV’s attitude relative to the inertial reference frame I ([27], Ch. 1), ρ>0 captures the air density, which is considered unknown, S>0 captures the UAV’s cross section area, which is considered unknown, CDR3×3 is diagonal, positive-definite, captures the UAV’s drag coefficients, and is unknown, and

Γϕθ10sinθ0cosϕcosθsinϕ0sinϕcosθcosϕ.E46

We recall that Γϕθ is invertible for all ϕθπ2π2×π2π2 ([27], Ch. 1).

The total thrust force produced by the UAV’s propellers is defined as

u1t10δt,tt0,E47

where

δ̇t=0τ100δt+0J1η1t,u1t0u̇1t0=u1,0u1,0,d,E48

captures the motors’ dynamics, τ>0 denotes a time constant, J>0 captures the motors’ inertia, and η1:0R denotes the total thrust force’s virtual control input. The roll moment produced by the UAV’s propellers is denoted by u2, the pitch moment produced by the UAV’s propellers is denoted by u3, and the yaw moment produced by the UAV’s propellers is denoted by u4. The UAV’s control input is defined as utu1tu2tu3tu4tT, tt0, and the vector of thrust forces produced by each propeller is defined as

TtMT,uut,tt0,k0nw1,E49

where the ith component of T, i=1,,4, namely Ti:0t0, denotes the thrust force produced by the ith propeller, MT,u14102l1cT112l10cT1102l1cT112l10cT1, l>0 denotes the distance of the propellers from the vehicle’s barycenter, and cT>0 denotes the propellers’ drag coefficient [26].

Quadcopter UAVs are under-actuated and, in particular, only four of their six degrees of freedom can be controlled directly [26]. In this chapter, we are interested in steering the UAV’s position and attitude along user-defined reference trajectories by controlling the UAV’s position and cyclically controlling at high frequency one of the three Euler angles ϕ, θ, and ψ at the time.

Advertisement

6. Output-feedback linearization of multi-rotor UAVs

In this section, we discuss the output-feedback linearization problem of the plant model given by (41)(44) and (48). Specifically, in Sections 6.1, 6.2, and 6.3, we discuss the output-feedback linearization problem employing the UAV position and yaw angle, the UAV position and pitch angle, and the UAV position and roll angle as measured outputs, respectively. In Section 6.4, we unify the framework presented in Sections 6.1–6.3 and illustrate how the problem of controlling the output-feedback linearized dynamics can be reduced to the problem of controlling an MRAC system. In Section 6.5, which presents the key result of this chapter, we apply the MRAC framework for hybrid plants presented in Section 4 to control a multi-rotor UAV, such as a quadcopter or an X8-copter. As already remarked in Section 1, this result is groundbreaking because, thus far, the control of multi-rotor UAVs by means of output-feedback linearization allows to impose the reference trajectory for the vehicle’s position and only one of the three angles that capture its attitude.

6.1 Feedback linearization relative to position and yaw angle

To feedback-linearize (41)(44) relative to the vehicle’s position vector and yaw angle, we set z3trTtψtT, tt0, as a linearizing output, and applying Proposition 5.1.2 of [8], and we verify that the dynamical system given by (41)(44) and (48) has vector relative degree 4,4,4,2. Thus, if CD=03×3, then

r4tψ¨t=f3rtϕtθtψtωtu1t+G31rtϕtθtψtu1tη1tu2tu3tu4t,rt0ṙt0=r0v0,r¨t0rt0=a0j0,ψt0ψ̇t0=ψ0ψd,0,tt0,E50

where

G31rϕθψu1mR˜ϕθψ03×1I33cψcθsϕu1cϕI33cθsψsϕu1cϕI33sθsϕu1cϕI33cθmcϕ,E51
R˜ϕθψsϕsψ+cϕcψsθcϕsψsθcψsϕcϕcθI11cϕsψcψsϕsθu1I11cϕcψ+sψsϕsθu1I11cθsϕu1I22cψcθu1I22cθsψu1I22sθu1,E52

cαcosα, αR, sαsinα, and f3:R3×π2π2×π2π2×02π×R3×RR4; an expression for f3 is omitted for brevity. It holds that

detG3rϕθψu1=u12cosϕm3detIcosθ,rϕθψu1R3×π2π2×π2π2×02π×0,E53

and, hence, G3 is invertible if and only if u10 since ϕπ2π2. Furthermore, G31 is well-defined if and only if u10 since ϕπ2π2. Remarkably, if I11=I22=u1=τ=J=1, then R˜ is a rotation matrix. The hypothesis whereby CD=03×3 will be lifted in Section 6.5 below.

6.2 Feedback linearization relative to position and pitch angle

By proceeding as in Section 6.1, and setting z2trTtθtT, tt0, as a linearizing output, the dynamical system given by (41)(44) and (48) has vector relative degree 4,4,4,2, and, if CD=03×3, then

r4tθ¨t=f2rtϕtθtψtωtu1t+G21rtϕtθtψtu1tη1tu2tu3tu4t,rt0ṙt0=r0v0,r¨t0rt0=a0j0,θt0θ̇t0=θ0θd,0,tt0,E54

where

G21rϕθψu1mR˜ϕθψ03×1I33cϕcψcθu1sϕI33cϕcθsψu1sϕI33cϕsθu1sϕI33msϕ,E55

f2:R3×π2π2×π2π2×02π×R3×RR4; an expression for f2 is omitted for brevity. It holds that

detG2rϕθψu1=u12sinϕm3detI,rϕθψu1R3×π2π2×π2π2×02π×0,E56

and, hence, G2 is invertible if and only if u10 and ϕ0 since ϕπ2π2. Furthermore, G21 is well-defined if and only if u10 and ϕ0.

6.3 Feedback linearization relative to position and roll angle

Setting z1trTtϕtT, t0, as a linearizing output, the dynamical system given by (41)(44) and (48) has vector relative degree 4,4,4,2, and, if CD=03×3, then

r4tϕ¨t=f1rtϕtθtψtωtu1t+G11rtϕtθtψtu1tη1tu2tu3tu4t,rt0ṙt0=r0v0,r¨t0rt0=a0j0,ϕt0ϕ̇t0=ϕ0ϕd,0,tt0,E57

where

G11rϕθψu1mR˜ϕθψ03×1I33cθsψu1sθI33cψcθu1sθI33sϕu1cϕsθI33cθmcϕsθ,E58

f1:R3×π2π2×π2π2×02π×R3×RR4; an expression for f1 is omitted for brevity. It holds that

detG1rϕθψu1=u12cosϕtanθm3detI,rϕθψu1R3×π2π2×π2π2×02π×0,E59

and hence, G1 is invertible if and only if u10 and θ0 since ϕπ2π2. Furthermore, G11 is well-defined if and only if u10 and θ0.

6.4 Feedback linearization with MRAC augmentation

In light of the results in Sections 6.1–6.3, let

ζσrϕθψωu1λσGσrϕθψωu1(fσrϕθψωu1+Ar,0r+Ar,1ṙ+Ar,2r¨+Ar,3r¨Ay,σ,0yσ+Ay,σ,1ẏσ+BrBy,σλσ),rϕθψωu1λσR3×π2π2×π2π2×02π×R3×R×R4,E60

denote the baseline feedback-linearizing control input, where σ1,2,3, y1=ϕ, y2=θ, y3=ψ,

A˜r03×31303×303×303×303×31303×303×303×303×313Ar,0Ar,1Ar,2Ar,3R12×12,A˜y,σ01Ay,σ,0Ay,σ,1R2×2,E61

are Hurwitz,

B˜r09×4BrR12×4,B˜y,σ01×4By,σR2×4,E62

and the pairs A˜rB˜r and A˜y,σB˜y,σ are controllable. If

η1tu2tu3tu4tT=ζσt,tt0,E63

for some σ1,2,3, where ζσt denotes ζσrtϕtθtψtωtu1tλσt for brevity, then the UAV’s equations of motion (41)(44) are output-feedback-linearized and

χ̇σt=Aσχσt+Bσλσt,χσt0=χσ,0,tt0,E64

where χσtrTtṙTtr¨Ttr¨TtyσtẏσtTR14, AσblockdiagA˜rA˜y,σR14×14, BσB˜rTB˜y,σTTR14×4, and the initial condition χσ,0R14 deduced from (50), (54), and (57).

Fixed σ1,2,3, to account for the fact that, in general, CD03×3, we generalize (64) and consider the plant model

χ̇σt=Aσχσt+BσΛσλσt+ΘσTΦσ(tχσt)+ξσt02,χσt0=χσ,0,tt0,E65

where ΛσR4×4 is diagonal, positive-definite, and unknown. By setting Λσ=diagm1m1m1Iσσ1, σ1,2,3, this matrix can be employed to account for uncertainties in the UAV’s mass and moment of inertia corresponding to the selected linearizing output signal zσ. The unmatched uncertainty

ξσt03Tξdrag,σT(tvt)06TTR12,E66

where

ξdrag,σtv12mρSRTϕtθtψtCDvv,tvt0×R3\03,E67

captures the effect of aerodynamic forces, which are not explicitly accounted for in the feedback-linearizing control law (60). The regressor vector Φσ:t0×R14RNσ includes the baseline controller and matched parametric uncertainties not accounted for in the feedback-linearization process. To capture uncertainties in the feedback-linearized plant dynamics, such as uncertainties in the location of the UAV’s center of mass, such a regressor vector can be constructed to be an explicit function of the UAV’s translational and angular position as well as of the UAV’s rotational position and velocity, thus linking explicitly (65) to (41)(44). Explicit expressions of Φσ, σ1,2,3, will be presented in future works.

Having reduced the feedback-linearized equations of motion of the UAV to the classical form or MRAC, we can compute the virtual control input λσ so that the feedback-linearized plant trajectory χσ follows the reference trajectory χref,σ:t0R14 such that

χ̇ref,σt=Aref,σχref,σ+Bref,σrσt,χref,σt0=χref,σ,0,tt0,E68

where Aref,σR14×14 is Hurwitz, Bref,σR14×4 is such that the pair Aref,σBref,σ is controllable, and rσ:t0R4 denotes the user-defined reference command input. Fixing σ1,2,3, this task can be attained by employing a robust MRAC system or any other nonlinear robust control technique, such as sliding mode or any of its higher-order variations.

Since Aσ is user-defined and Hurwitz, σ1,2,3, and both Bσ and Bref,σ are user-defined, it is possible to set Aref,σ=Aσ and Bref,σ=Bσ. Furthermore, r can be designed so that χref,σ follows the user-defined signal χuser,σ:t0R14, whose first 12 components capture the desired position, velocity, acceleration, and jerk, and whose last 2 components capture the desired trajectory for the UAV’s measured angle and angular rate.

6.5 Hybrid MRAC and feedback linearization

If σ:t01,2,3 is a function of time, then the control system presented in Section 4 can be applied to compute the virtual control input λσ. Indeed, (65) is in the same form as the continuous-time plant dynamics given by (8) with Θ˜σt=0 and Σ=1,2,3. Similarly, (68) is in the same form as the continuous-time reference model dynamics given by (10).

The sets of resetting events SσσΣ, which characterize the switching among the lineatizing outputs zσtt, tt0, are provided by Algorithm 1. This algorithm assumes that the user provides a four time continuously differentiable desired trajectory for the UAV’s position and a twice continuously differentiable desired trajectory for the yaw, pitch, and roll angles. The user-defined trajectories for the roll and pitch angles are such that ϕusertϕminϕmax, tt0, and θusertθminθmax, where 0<ϕmin<ϕmax and 0<θmin<θmax.

Algorithm 1: Algorithm for multi-output feedback linearization.

1: tt0 Initialize the last switching time variable

2: for tt0 do

3: TitsatTitTi,minTi,max, i14 Enforce saturation

constraints on thrust force Tit

4: if σt=3ttΔTmin then

5: if ϕtϕmax OR θtθmax then

6: σtargmaxϕtϕmaxθtθmax

7: tt

8: end if

9: else if σt=2 & (ϕtϕmin OR ϕtϕmax)&ttΔTmin then

Enforce constraints on G2

10: σtargmaxσ13ez,σttεσ

11: tt

12: else if σt=1 (θtθmin OR θtθmax)ttΔTmin then

Enforce the constraints on G1

13: σtargmaxσ23ez,σttεσ

14: tt

15: end if

16: if ez,σtt>εσttΔTmin then If any of the tracking errors is too large and enough time has passed since the last switching

17: σtargmaxσ1,2,3ez,σttεσ

18: tt

19: end if

20: end for

To present Algorithm 1, let the user-defined variable ΔTmin>0 denote the dwell time of the plant model, that is, the minimum time between two consecutive switching of the index σ. Furthermore, for each σ1,2,3, let εσ>0 denote the user-defined tolerance on the output signal tracking error

ez,σttCχσttχref,σtt,tt0,E69

where C1303×303×603×203×31303×603×202×302×302×612R8×14. Additionally, let Ti,min>0, i1,2,3,4, and Ti,max>Ti,min denote the minimum and maximum allowed thrust for the ith motor, respectively. Finally, let

satααminαmaxminαmaxmaxααmin,ααminαmaxR×R×R,E70

denote the saturation function, where αmin<αmax.

Advertisement

7. Numerical simulation results

In this section, we illustrate the applicability of the proposed results by means of a numerical simulation. In this simulation, the UAV is tasked with ascending and moving at a constant velocity along the X-axis of the inertial reference frame for t05 s, hovering for t510 s, following an upward spiral trajectory for t1030 s, descending along the same spiral for t3050 s, translating along the bissetriz of the horizontal plane at a constant velocity for t5060 s, and hovering until the end of the mission. Furthermore, the user requires that the UAV’s yaw, pitch, and roll angles follow predefined trajectories within a margin of 5 degrees at all times. The user-defined yaw and roll angles are constant at all times, and the user-defined pitch angle is linearly increasing in the ascending and descending phases of the spiral trajectory and constant everywhere else; for details, see Figure 1. It is worthwhile to remark that this reference attitude poses a significant challenge. Indeed, as discussed in Sections 6.2 and 6.3, if σ=2, that is, if the feedback linearizing output comprises the UAV’s position and pitch angle, then the roll angle can not be equal to zero, Similarly, if σ=1, that is, if the feedback linearizing output comprises the UAV’s position and roll angle, then the pitch angle can not be set to zero. Furthermore, to follow the reference spiral trajectory imposed by the user, the roll and pitch angles must vary sinusoidally.

Figure 1.

Euler angles capturing the attitude of the UAV. At t=0 s, the feedback linearizing output is set as σ=1. At t=16.0953 s, shortly after the UAV is tasked with hovering, applying Algorithm 1, the control system switches feedback linearizing output to σ=2. Finally, at t=50.0362 s, before the UAV is tasked with moving sideways in the horizontal plane, applying Algorithm 1, the control system sets σ=3. In this stage, after a brief transient, the yaw angle closely follows its reference trajectory.

Figure 2 shows the thrust force and the time derivative of the thrust force needed by the UAV to follow the user-defined trajectory. Both u1t, t0, and u̇1t show profiles that are compatible with the performances of commercial-off-the-shelf electric motors for Class 1 quadcopter UAVs.

Figure 2.

Total thrust and time derivative of the total thrust. The total thrust and its derivative lie within bounds that are typical for commercial-off-the-shelf motors of Class 1 quadcopter UAVs.

In this simulation, the UAV’s mass is m=2 kg and its central matrix of inertia is given by I=diag0.010,0.010,0.015 kg m2. The matrix of aerodynamic coefficient is set equal to CD=0.00113. The estimated mass is 2.2 kg and the estimated matrix of inertia is given by diag0.020,0.015,0.025 kg m2. The adaptive rate matrix is set as Γσ=9102122 for all σ1,2,3. We set

Br=13031111,By,σ=111,E71

and both A˜r and A˜y,σ were designed through the pole placement method, imposing eigenvalues 4.752.52.62.981.212.31.61.81.51.6 for the translational dynamics, eigenvalues 47 for σ=3 and eigenvalues 48 for σ12. The σ-modification of the MRAC, that is, the adaptive law (22) is employed with γσ=0.01 for all σ1,2,3.

Figure 3 shows the UAV trajectory as a function of time. It is apparent how the UAV closely follows the reference trajectory at all times. Figure 1 shows the UAV attitude by means of the yaw, pitch, and roll angles. The reference angle as well as the user-defined angle are shown only for those stages in which the mode is active. At t=0 s, the feedback linearizing output is set as σ=1. At t=16.0953 s, shortly after the UAV is tasked with hovering, applying Algorithm 1, the control system switches feedback linearizing output to σ=2. Finally, at t=50.0362 s, before the UAV is tasked with moving sideways in the horizontal plane, applying Algorithm 1, the control system sets σ=3. In this stage, after a brief transient, the yaw angle closely follows its reference trajectory. Numerical evidence show that, without the proposed hybrid system, this maneuver would not be possible by setting σt1 or σt2 for all t0, that is, without the proposed control system.

Figure 3.

Trajectory of the center of mass of the UAV as a function of time. In all modes, the vehicle’s trajectory closely follows the user-defined trajectory despite uncertainties and the drag force.

Advertisement

8. Conclusion

This chapter presented the first robust MRAC system applicable to time-varying, hybrid plant models affected by parametric, matched, and unmatched uncertainties in the continuous-time dynamics as well as uncertainties in the discrete-time dynamics. These results have been applied to the problem of controlling the feedback-linearized dynamics of a quadcopter UAV and tasking the vehicle to follow both a user-defined trajectory and a user-defined attitude. This result is unprecedented because, due to the UAV’s underactuation, existing works on the control of quadcopters allow regulating arbitrarily only four of its six degrees of freedom. The proposed approach, instead, allows the user to impose reference trajectories for each of the UAV’s six degrees of freedom. Future work directions concern the extension of the proposed approach from a specific application, namely quadcopter UAVs, to generic plant models.

Future work directions involve further extensions of the proposed hybrid MRAC framework for the control of output-feedback linearized systems to cases wherein the feedback-linearizing output is affected by noise. Additional work directions include problems wherein the feedback-linearizing output is not readily available for measurement but needs to be deduced from the measured output.

Advertisement

Acknowledgments

This research was in part performed with the support of NSF through the Grant no. 2137159 and the US Army Research Lab under Grant no. W911QX2320001.

Advertisement

Conflict of interest

The authors declare no conflict of interest.

Abbreviations

MRAC

model reference adaptive control

UAV

unmanned aerial vehicle

References

  1. 1. Cortes J. Discontinuous dynamical systems. IEEE Control Systems Magazine. 2008;28(3):36-73
  2. 2. Anderson RB, Marshall JA, L’Afflitto A, Dotterweich JM. Model reference adaptive control of switched dynamical systems with applications to aerial robotics. Journal of Intelligent & Robotic Systems. 2020;100(3):1265-1281
  3. 3. Lin H, Antsaklis P. Hybrid Dynamical Systems: Fundamentals and Methods, Ser. Advanced Textbooks in Control and Signal Processing. London, UK: Springer; 2021
  4. 4. L'Afflitto A. AfflittoModel reference adaptive control for nonlinear time-varying hybrid dynamical systems. International Journal of Adaptive Control and Signal Processing. 2023;37(8):2162-2183
  5. 5. Narendra K, Annaswamy A. A new adaptive law for robust adaptation without persistent excitation. IEEE Transactions on Automatic Control. 1987;32(2):134-145
  6. 6. Ioannou P, Kokotovic P. Adaptive Systems with Reduced Models. New York, NY: Springer; 1983
  7. 7. Ioannou P, Fidan B. Adaptive Control Tutorial. Philadelphia, PA: Society for Industrial and Applied Mathematics; 2006
  8. 8. Isidori A. Nonlinear Control Systems. New York, NY: Springer; 1995
  9. 9. Malo Tamayo AJ, Villaseñor Rios CA, Ibarra Zannatha JM, Orozco Soto SM. Quadrotor Input-Output Linearization and Cascade Control. IFAC-PapersOnLine. 2018;51(13):437-442. ISSN: 2405-8963. DOI: 10.1016/j.ifacol.2018.07.317
  10. 10. Lotufo MA, Colangelo L, Novara C. Control design for uav quadrotors via embedded model control. Transactions on Control Systems Technology. 2020;28(5):1741-1756
  11. 11. Daga GD, Thosar AG. Feedback linearization of quadrotor. In: Shrivastava V, Bansal JC, Panigrahi BK, editors. Power Engineering and Intelligent Systems. Singapore: Springer; 2024. pp. 137-151
  12. 12. PX4 Website. Available from: https://px4.io/ [Accessed: February 12, 2024]
  13. 13. Ardupilot Website. Available from: https://ardupilot.org/ [Accessed: February 12, 2024]
  14. 14. Kreyszig E. Introductory Functional Analysis with Applications. New York, NY: Wiley; 1989
  15. 15. Bernstein DS. Matrix Mathematics: Theory, Facts, and Formulas. 2nd ed. Princeton, NJ: Princeton University Press; 2009
  16. 16. Haddad WM, Chellaboina VS, Nersesov SG. Impulsive and Hybrid Dynamical Systems: Stability, Dissipativity, and Control. Princeton, NJ: Princeton; 2014
  17. 17. Sanfelice RG, Goebel R, Teel AR. Generalized solutions to hybrid dynamical systems. Control, Optimisation and Calculus of Variations. 2008;14(4):699-724
  18. 18. Bardi M, Capuzzo-Dolcetta I. Optimal Control and Viscosity Solutions of Hamilton-Jacobi-Bellman Equations. Boston, MA: Birkhäuser; 2008
  19. 19. Clarke FH. Optimization and Nonsmooth Analysis. Philadelphia, PA: Society of Industrial and Applied Mathematics; 1989
  20. 20. Fischer N, Kamalapurkar R, Dixon WE. LaSalle-Yoshizawa corollaries for nonsmooth systems. IEEE Transactions on Automatic Control. 2013;58(9):2333-2338
  21. 21. Goebel R, Sanfelice R, Teel A. Hybrid Dynamical Systems: Modeling, Stability, and Robustness. Princeton University Press; 2012. Available form: http://www.jstor.org/stable/j.ctt7s02z. ISBN: 9780691153896
  22. 22. Khalil HK. Nonlinear Systems. Princeton, NJ: Prentice Hall; 2002
  23. 23. Pomet JB, Praly L. Adaptive nonlinear regulation: estimation from the Lyapunov equation. IEEE Transactions on Automatic Control. 1992;37(6):729-740
  24. 24. Lavretsky E, Wise K. Robust and Adaptive Control: With Aerospace Applications. London, UK: Springer; 2012
  25. 25. Ioannou P, Sun J. Robust Adaptive Control, Ser. Dover Books on Electrical Engineering Series. Upper Saddle River, NJ: Dover Publications; 2012
  26. 26. L’Afflitto A, Anderson RB, Mohammadi K. An introduction to nonlinear robust control for unmanned quadrotor aircraft. IEEE Control Systems Magazine. 2018;38(3):102-121
  27. 27. L’Afflitto A. A Mathematical Perspective on Flight Dynamics and Control. London, UK: Springer; 2017

Written By

Giri M. Kumar, Mattia Gramuglia and Andrea L’Afflitto

Submitted: 30 January 2024 Reviewed: 02 February 2024 Published: 02 April 2024