Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
Automatica
journal homepage: www.elsevier.com/locate/automatica
focused on the axisymmetric spacecraft and only consider kine- • An approach to designing parameters for the MPC algorithm
matics, which is quite different from this paper in which we will is developed. Due to the fact that the terminal cost is time-
study the asymmetric underactuated spacecraft and consider com- varying and parameter-dependent, we develop conditions to
plete system model including kinematics and dynamics. construct a local stable set for the closed-loop system by using
It is well known that the model predictive control (MPC), also the time-varying control law in Morin and Samson (1997), and
known as receding horizon control, can provide almost optimal show that the terminal cost function is qualified as a local
control performance and well respect system constraints, which homogeneous Lyapunov function for such closed-loop system
has been widely implemented in the industry. This motivates the with appropriate parameters. Furthermore, an optimization
current study to solve the model predictive stabilization problem problem which combines the control input constraints and
of spacecraft with two bounded control torques. Note that the the local stable set is formulated for designing the terminal
model predictive stabilization problem for such underactuated
constraint.
systems is nontrivial, as the well-developed MPC strategies (Chen
• The theoretical conditions on ensuring algorithm feasibility
& Allgöwer, 1998; Li & Shi, 2014a,b; Michalska & Mayne, 1993) are
and closed-loop stability are established. Under the way
not valid and cannot be directly applied. This is because the design
of these MPCs (Chen & Allgöwer, 1998; Li & Shi, 2014a,b; Michalska of parameter design (i.e., Algorithm 2), we prove that the
& Mayne, 1993) heavily relies on a hypothesis that there exists designed MPC algorithm is iteratively feasible, and the closed-
a state feedback controller for corresponding linearized systems, loop system is asymptotically stable and the control input
which does not hold for the underactuated spacecraft dynamics. A constraints are satisfied. These theoretical results provide a
general MPC framework is proposed in Fontes (2001) which mainly useful tool for algorithm design and analysis in practical
depends on the stability condition SC5, however no way has been implementations.
provided to construct such a condition, and it is generally very hard Notations: We use the symbol R and R+ to denote the real space
to find such a condition for underactuated spacecraft.
and real space with positive numbers, respectively. We adopt
In the literature, most of the MPC strategies for spacecraft
‘‘T’’ to represent the matrix transposition, and col{x1 , x2 , . . . , xn }
control are focused on fully actuated models and/or linearized
to denote the column operation as [xT1 , xT2 , . . . , xTn ]T for column
ones. For example, a fixed-point MPC strategy with quadratic
vectors x1 , x2 , . . . , xn . For a column vector x ∈ Rn , its Euclidean
cost functions is developed for tracking attitude set points of a
full-actuated spacecraft in Guiggiani, Kolmanovsky, Patrinos, and norm (and its absolute value for n = 1) is denoted by |x|.
Bemporad (2014); an explicit model predictive control algorithm For a vector x ∈ R3 , its skew operation is written as S (x) =
is proposed for a linearized spacecraft model in Hegrenæ, Gravdahl, [0, x3 , −x2 ; −x3 , 0, x1 ; x2 , −x1 , 0]. Given a matrix P ∈ Rn×n , we
and Tøndel (2005); a nonlinear MPC algorithm is designed for use P > 0 (P > 0) to denote its positive definiteness (semi-positive
attitude control of full-actuated spacecraft on SO(3) in Kalabic, definiteness). For a symmetric matrix, we use ∗ to represent its
Gupta, Di Cairano, Bloch, and Kolmanovsky (2014), where the symmetric elements with respect to its main diagonal. For two sets
Lie group variational integrator based discrete-time model is U ⊆ Rn and W ⊆ Rn with U ⊆ W , define W \ U = {x ∈ Rn |x ∈
adopted. It is worth noting that for spacecraft with two control W , ̸∈ U}. We say that a function f belongs to the class C k , if its
torques, an MPC-based stabilization strategy has been designed derivatives up to the order of k exist and are continuous.
in Marchand and Alamir (2003), where a numeric approximation
of the system trajectory is utilized by Chebyshev’s polynomial 2. Problem formulation and preliminaries
basis, but the theoretical properties of the designed algorithm
are not studied. The theoretical results of MPC strategies for
underactuated underwater vehicles are developed in Li, Xie, 2.1. Problem statement
and Yan (2016) and Li and Yan (2016), but they cannot be
directly applied for underactuated spacecraft. Therefore, it is Consider a rigid spacecraft with two control torques as:
very necessary to investigate the model predictive stabilization
Ṙ = S (ω)R,
problem of underactuated spacecraft with practical constraints,
and further provide a rigorous analysis to uncover theoretical J ω̇ = S (ω)J ω + Bτ , (1)
properties of the designed MPC algorithm.
where R ∈ SO(3) is the rotation matrix from the body frame B to
In this study, we will study the MPC-based stabilization
problem of rigid spacecraft with two control torques and practical the inertial frame I, ω ∈ R3 is the angular velocity in the frame
control input constraints, and develop a systematic parameter- I, J = diag(j1 , j2 , j3 ) is the principal moments of inertia, τ =
design approach to ensure the theoretical properties of the col(τ1 , τ2 , 0) with τi , i = 1, 2, are torques driving the spacecraft,
designed MPC algorithm. The main contributions of this paper are and B = I3 . Note that there are only two control torques, making
three-fold: the system in (1) nonholonomic. The control torques are bounded
by
• A novel model predictive stabilization algorithm is designed
for rigid spacecraft with two bounded control torques. The τi ∈ Γi , i = 1, 2, (2)
novelty of the designed algorithm lies in that the design
of cost function makes full use of the homogeneity of the where Γi ⊆ R, contains zero as its interior point.
system dynamics. Different from the conventional MPCs (Chen Taking x = col(x1 , x2 , x3 ) = −k tan θ as in Morin and Samson
& Allgöwer, 1998; Li & Shi, 2014a,b; Li & Yan, 2015; Michalska (1997) and Morin et al. (1995), where ⃗ k is the unit vector around
& Mayne, 1993), where the cost functions use the Euclidean which R is rotated, θ ∈ (−π , π ) is the rotated angle, and k is
norm of the system states and control inputs, the stage cost coordinate of ⃗
k in the frame I, the system in (1) can be transformed
function is built on the homogeneous norm of partial system into the following form (Morin & Samson, 1997; Morin et al., 1995)
states, and the terminal cost function is time-varying and
captures the properties of system dynamics. In addition, the 1
ẋ = (ω + S (ω)x + (xT ω)x),
terminal constraint is imposed in terms of the time-varying cost 2
function unlike the conventional ones in which a terminal set is ω̇1 = c1 ω2 ω3 + u1 ,
constructed by using the time-invariant terminal cost function
ω̇2 = c2 ω1 ω3 + u2 ,
(Chen & Allgöwer, 1998; Li & Shi, 2014a,b; Michalska & Mayne,
1993). ω̇3 = c3 ω1 ω2 , (3)
146 H. Li et al. / Automatica 75 (2017) 144–153
with Γ̃i = Γi /ji . It is assumed that c3 ̸= 0, which is to ensure In addition, a reduced system for (6) can be obtained when defining
the nonlinear system in (3) is controllable. Otherwise, the state ω3 v1 = ω1 and v2 = ω2 as the control inputs:
cannot be controlled. Defining z , col(x, ω), the system in (3) can
also be written as ż = h(z , u), where h(z , u) = col( 12 (ω + S (ω)x + 1
η̇ = col(v1 , v2 , ω3 + v2 x1 − v1 x2 , 2c3 v1 v2 ), (7)
(xT ω)x), c1 ω2 ω3 + u1 , c2 ω1 ω3 + u2 , c3 ω1 ω2 ). 2
The objective of this study is to design an MPC algorithm to where η , col(x, ω3 ).
stabilize the system in (3) and respect the control bounds in (4).
By making using of the homogeneity of (5) and the property of
(7), a continuous time-varying feedback control can be designed as
2.2. Preliminaries of homogeneous systems in the following lemma.
1
f ( z , u) = col(ω1 , ω2 , ω3 + ω2 x1
2 3. Model predictive control algorithm
− ω1 x2 , 2u1 , 2u2 , 2c3 ω1 ω2 ),
1 This section first develops the result on how to design
g1 (z ) = col(ω3 x2 − ω2 x3 + ω1 x21 + ω2 x2 x1 , homogeneous Lyapunov functions for the averaged dynamics in
2
(10), and then the MPC algorithm is designed.
− ω3 x1 + ω1 x3 + ω1 x1 x2 + ω2 x22 ,
ω1 x1 x3 + ω2 x2 x3 , 2c1 ω2 ω3 , 2c2 ω1 ω3 , 0),
3.1. Homogeneous Lyapunov function design
1
g2 (z ) = (ω3 x3 x1 , ω3 x3 x2 , ω 2
3 x2 x3 , 0, 0, 0).
2 To facilitate the design of the cost function in MPC, we develop
It can be verified that, for a dilation δλr z = (λx1 , λx2 , λ2 x3 , λω1 , a class of homogeneous Lyapunov functions with appropriate
λω2 , λ2 ω3 ), g1 (z ) is of degree l1 = 2, and g2 (z ) is of degree l2 = 4. bounds for the system in (10) in the following lemma.
H. Li et al. / Automatica 75 (2017) 144–153 147
Lemma 2. For the system in (10), define the function V (x, ω3 ) , For the system in (3), the stage cost function at each time instant
ax41 + bx42 + cx23 + dω32 + ex3 ω3 . For large enough a > 0 and b > 0, if tk is constructed as
then V (x, ω3 ) is a Lyapunov function for (10). In addition, there exist where ρ(x, ω3 ) = (x41 + x42 + x23 + ω32 )1/4 , β = 4, Aρ > 0, Bu1 > 0,
constants K1 > 0 and K2 > 0 such that V (x, ω3 ) 6 K1 ρ 4 (x, ω3 ) and and Bu2 > 0 are scalar constants, which will be specified later. The
∂ V (x,ω3 ) terminal cost function is designed by
∂η
f0 (η) 6 −K2 ρ 4 (x, ω3 ).
F (z (tk + T ; tk ), tk + T )
Proof. Taking derivative of V (x, ω3 ) along the trajectory of (10),
one has V̇ (x, ω3 ) = −2ak1 x41 − 2bk2 x42 + [c (k1 − k2 ) + = W (η(tk + T ; tk ), tk ) + Φ (z (tk + T ; tk ), tk ),
c3 ek1 k2 ]x1 x2 x3 + [2dc3 k1 k2 + 1/2e(k1 − k2 )]x1 x2 ω3 − 1/2ec3 x23 − where
(c3 d − 1/2e)ω32 + (c − 1/2ec3 − c3 d)x3 ω3 . Due to the condition in ∂ V (x, ω3 )
(11), there exist ξ1 > 0, ξ2 > 0, β1 > 0 and β2 > 0 such that W (η, t ) , V (x, ω3 ) − ϵ(1 − cos(t /ϵ)) f1 (η)
∂η
V̇ (x, ω3 ) 6 −2ak1 x41 − 2bk2 x42 + [c (k1 − k2 ) + c3 ek1 k2 ]x1 x2 x3 1 ∂ V (x, ω3 )
ϵ sin(2t /ϵ)
− f2 (η), (14)
+ [2dc3 k1 k2 + 1/2e(k1 − k2 )]x1 x2 ω3 4 ∂η
− (ξ12 + ξ2 )x23 − (β12 + β2 )ω32 .
2
1 ωir +1 + r vir +1 (x, ω3 , t )
Φ (z , t ) , √ − vi (x, ω3 , t )ωi ,
r
On the other hand, there exist constants ξ3 > 0 and ξ4 > 0 such Remark 5. It is worth noting that for some small ϵ > 0, W (η, t )
that V (x, ω3 ) > ax41 + bx42 + (c + ξ3 )x23 + (d + ξ4 )ω32 > K1 ρ 4 (x, ω3 ), will be positive and equal to zero only when η = 0, and the
where K1 can be taken as min{a, b, (c + ξ3 ), (d + ξ4 )}. The proof is detailed design of ϵ will be given later. Φ (z , t ) is always positive
ωr +1 +r v r +1 (x,ω3 ,t ) ωi
completed. by noting that i i
r +1
− vir (x, ω3 , t )ωi = vi (x,ω3 ,t ) sr −
vi (x, ωi , t )ds > 0, i = 1, 2.
r
Remark 3. It can be verified that the Lyapunov function V (x, ω3 )
is a homogeneous function of degree 4 with respect to the Finally, the cost function is constructed by
dilation δλr (x, ω3 ) = (λx1 , λx2 , λ2 x3 , λ2 ω3 ), which differs from
J (z (s; tk ), u(s; tk ), s)
conventional Lyapunov functions. This homogeneity will be tk + T
utilized to construct Lyapunov functions for the time-varying and
, L(z (s; tk ), u(s; tk ), s)ds + F (z (tk + T ; tk ), tk + T ),
periodic system in (9). tk
Remark 4. It is worthwhile to note that in the proof of Lemma 2, where T > τ is the prediction horizon.
the way of designing K1 and K2 might be conservative. A less Based on the cost function, an optimization problem solved at
conservative way to design K1 and K2 can be found by solving the each time tk for the system in (3) is formulated as follows:
following matrix inequalities:
Problem P (tk , z (tk ), T ). minu(s;tk ) J (z (s; tk ), u(s; tk ), s), subject to
a − K1 0 0 0
∗ b − K1 0 0 ż (s; tk ) = h(z (s; tk ), u(s; tk )),
> 0, (12)
∗ ∗ c − K1 e/2 u1 (s; tk ) ∈ Γ̃1 , u2 (s; tk ) ∈ Γ̃2 , s ∈ [tk , tk + T ], (16)
∗ ∗ ∗ d − K1
F (z (tk + T ; tk ), tk + T ) 6 ε, (17)
c (k1 − k2 ) + c3 ek1 k2 2dc3 k1 k2 + e(k1 − k2 )/2
z (tk ; tk ) = z (tk ),
ā
2 2
where ε > 0 is called the terminal set level.
c − ec3 /2 − c3 d 6 0,
∗ −(0.5ec3 − K2 )
2
Unlike the conventional MPC strategies (Chen & Allgöwer,
∗ ∗ −(c3 d − e/2 − K2 ) 1998; Li & Shi, 2014a,b; Li, Shi, & Yan, 2016; Michalska & Mayne,
(13) 1993), where the cost functions are in quadratic forms, the
√ cost function in this study is time-varying and related to the
where ā = −2 (2ak1 − K2 )(2bk2 − K2 ). homogeneous norm of the system under study. In addition, the
terminal constraint in (17) is imposed by a level set associated with
3.2. Design of MPC algorithm the periodic time-varying terminal cost function, which differs
from the conventional one in Chen and Allgöwer (1998), Li and Shi
For the system in (3), define the sampling time instants as tk , (2014a,b), Li, Shi et al. (2016) and Michalska and Mayne (1993).
k = 0, 1, . . . . The sampling period τ > 0 is a constant, and Using the optimization Problem P , the model predictive
the MPC controller samples the system state col(x(tk ), w(tk )) at stabilization algorithm is designed as in Algorithm 1.
each sampling time instant. For the ease of presentation, denote Due to the nonholonomic property of the system in (3), the
the following control and state trajectories: u(s; tk )—a functional design of the parameters ε , Aρ , Bu1 and Bu2 will be nontrivial, and
to characterize the control input trajectory; u∗ (s; tk )—the optimal the detailed design approach is postponed to the next section.
control input trajectory; ū(s; tk )—a functional to characterize In practice, the detailed steps for implementing the MPC
the feasible control input trajectory. The corresponding state Algorithm 1 numerically are as follows: (1) Take an appropriate
trajectories are defined accordingly. prediction horizon T as in the continuous-time case; (2) Discretize
148 H. Li et al. / Automatica 75 (2017) 144–153
∂ V (x)
Algorithm 1 Model Predictive Stabilization Algorithm
δi = sup fi (x) ,
Require: Sampling period τ ; prediction horizon T ; other parame- ρλ (x)=1
r ∂ x
ters ϵ , ε , Aρ , Bu1 and Bu2 ; initial state z0 ; index k = 0. ∂ ∂ V (x)
Ensure: z (t0 ) = z0 . γi,j = sup fi (x) fj (x) .
1: while The control action is not stopped do ρλr (x)=1 ∂ x ∂x
2: Sample system state z (tk );
3: Solve Problem P to generate the optimal control trajectory In the next lemma, we extend Proposition 5 in Morin and
u∗ (s; tk ), s ∈ [tk , tk + T ]; Samson (1997) to the case that there are two integrators added to
4: Apply control u(s; tk ) = u∗ (s; tk ), s ∈ [tk , tk + τ ); a class of homogeneous time-periodic systems. Consider a system
5: k = k + 1. ẋ = f (x, v1 (x(1) , t ), v2 (x(2) , t ), t ), (20)
6: end while
where f (x, y1 , y2 , t ) : Rn × R × R × R → Rn , is a continu-
ous function with period T0 , x(1) = col(x1 , . . . , xm1 ) and x(2) =
the continuous-time system model by the sampling period τ > col(x1 , . . . , xm2 ), m1 6 n, m2 6 n, and the functions vi (x(i) , t ) :
0; (generally set the constant τ being small and ensure N = Rmi × R → R, i = 1, 2, are continuous with period T0 , differen-
T /τ be an integer.) (3) Set N as the prediction horizon in the tiable with respect to t, homogeneous of degree q with respect to
discrete-time implementation; (4) Discretize the continuous-time a dilation δλr x and belong to class C 1 on (Rmi \ {0}) × R.
control trajectory u(s; tk ), s ∈ [tk , tk + T ] as a control sequence
{u(k|k), u(k + 1|k), . . . , u(k + N − 1|k)}; (5) Discretize the Lemma 7. For the system in (20), suppose that it is homogeneous
cost function J (z (s; tk ), u(s; tk ), s) and obtain the cost function in of degree zero with respect to the dilation δλr x, and is asymptotically
discrete-time format. Through the above steps, the MPC algorithm stable at zero. Then, for large enough µ1 > 0 and µ2 > 0, the
1 can be executed numerically. following system
ẋ = f (x, y1 , y2 , t ),
4. Terminal set and parameter design
ẏ1 = −µ1 (y1 − v1 (x(1) , t )),
This section first provides a way to design a set within which ẏ2 = −µ2 (y2 − v2 (x(2) , t )), (21)
F (z , t ) is a local Lyapunov function for the system in (3) using
is asymptotically stable at zero.
the control law in Lemma 1. Then the parameter design algorithm
including the terminal constraint set design is developed. The proof of Lemma 7 is obtained by following the similar line
of Proposition 5 in Morin and Samson (1997). Since the parameter
design of the MPC strategy will need some intermediate results
4.1. A local stable set
which have not provided in Morin and Samson (1997), the proof
is presented in below.
Before proceeding, let us recall a result from Morin and Samson
Proof. Define δλr x = (λr1 x, . . . , λrn xn ) as the dilation with respect
(1997), which states that a class of time-varying and periodic
to which the system in (20) is of homogeneous degree zero, and
systems are exponentially stable if their averaged systems are
asymptotically stable and certain conditions are satisfied. Consider the homogeneous norm is denoted by ρ(x). Define δ̃λr (x, y1 , y2 ) =
the system
(λr1 x, . . . , λrn xn , λq y1 , λq y2 ) as the dilation associated with which
the system in (21) is of homogeneous degree zero, and the
p
homogeneous norm is denoted by ρ(x, y1 , y2 ). By taking l as an odd
ẋ = f0 (x) + gi (t /ϵ)fi (x), (18) integer such that l > max{ri /q, i = 1, . . . , max{m1 , m2 }}, as in
i=1 Morin and Samson (1997), it can be shown that vil (., .) are at least
where fi : Rn → Rn , i = 0, . . . , p, belonging to C 1 on Rn \ of class C 1 on Rmi × R.
By applying Theorem 2 in Rosier (1992), there exists a Lyapunov
{0}, are continuous and homogeneous vector fields, which have function V (x, t ) for the system in (20) which is with period T0 ,
homogeneous degree zero with respect to a dilation δλr x, gi , i = and homogeneous of degree β = (l + 1)q. Similar as in Morin
1, . . . , p, are continuous scalar periodic functions with period T0 and Samson (1997), define the following function W (x, y1 , y2 , t ) =
T
and satisfy 0 0 gi (s)ds = 0. The averaged system for (18) is defined V (x, t ) + i=1 √1µ φi (yi , x(i) , t ), where φi (yi , x(i) , t ) = l+11 (yli+1 +
2
as ẋ = f0 (x). i
where f (i) are the vector functions with their components are the
t
Ci = sup |gi (t )|, gi (s)ds ,
Ii = sup
first mi component of f .
t ∈R t ∈R 0
H. Li et al. / Automatica 75 (2017) 144–153 149
Due to the fact that V is a Lyapunov function for the system in Proof. According to Lemma 2, V (x, ω3 ) is a Lyapunov function for
(20) and homogeneous of degree β , there exists a constant K1 > 0 the system in (10) and satisfies the conditions of Lemma 6. As a
such that ∂∂Vx f (x, v1 (x(1) , t ), v2 (x(2) , t ), t ) + ∂∂Vt 6 −2K1 (ρ(x))β . result, by applying p = 2, g1 (t /ϵ) = sin(t /ϵ) and g2 (t /ϵ) =
By following the similar idea as in Morin and Samson (1997), it 1
2
cos(t /ϵ) in Lemma 6, for all ϵ ∈ (0, ϵ0 ), the function W (η, t )
can be verified that there exists a constant K2 > 0 such that defined in (14) is a Lyapunov function for the system in (9),
∂V
∂x
(f (x, y1 , y2 , t ) − f (x, v1 (x(1) , t ), v2 (x(2) , t ), t )) 6 K1 (ρ(x))β + ϵ0 is defined
where as in (19). In addition, Ẇ (η, t ) 6 −(α2 −
K2 [(y1 − v1 (x(1) , t ))r +1 + (y2 − v2 (x(2) , t ))r +1 ], where K2 is the ( pi=1 Ii (γi,0 + pj=1 Cj γi,j ))ϵ)ρ 4 (x, ω3 ).
constant such that Next consider the closed-loop system in (6) using the control
law in (8). By substituting y1 = ω1 , y2 = ω2 , x =
∂V
max (f (x, y1 , y2 , t ) col(x, ω3 ), δλr x = (λx1 , λx2 , λ2 x3 , λ2 ω3 ), δ̃λr (x, y1 , y2 ) = (λx1 , λx2 ,
ρ(x,y1 ,y2 )=1 ∂x λ2 x3 , λω1 , λω2 , λ2 ω3 ), q = 1, and l = 3 into Lemma 7, it follows
that the function F (z , t ) = W (η, t ) + Φ (z , t ) is a Lyapunov
(1) (2)
− f (x, v1 (x , t ), v2 (x , t ), t ) K1 (ρ(x))β
function for the system in (6) using the control law in (8), where
Φ (z , t ) is defined in (15).
+ K2 (y1 − v1 (x(1) , t ))r +1 + (y2 − v2 (x(2) , t ))r +1 6 1.
(22) Now consider the closed-loop system in (5) with the control
law given in (8). Taking the derivative of F (z , t ) with respect to
Furthermore, using the same way as in Morin and Samson (1997), it
∂φ t along the trajectory of the closed-loop system in (5), one has
can be shown that ∂ y ẏi = −µi yli − vil (x(i) , t ) yi − vil (x(i) , t ) 6 ∂ F (z ,t ) ∂ F (z ,t ) ∂ F (z ,t )
i Ḟ (z , t ) = ∂ z f (z , u) + ∂ t + ∂ z (g1 (z ) + g2 (z )). According
− 2l1−1 µi (yi − vi (x(i) , t ))l+1 . Finally, since the following function to Lemma 7, we have
∂φi (i) ∂φ (y ,x(i) ,t )
∂ x(i)
f (x,y1 ,y2 ,t )+ i i∂ t ∂ F (z , t ) ∂ F (z , t )
is homogeneous function of degree zero f ( z , u) +
(
(ρ(x))β + 2i=1 yi −vi (x(i) ,t ) )
l+1
∂z ∂t
and is well defined outside (x = 0, y1 = 0, y2 = 0), there exist 6 −A0 (µ1 , µ2 )ρ 4 (x, ω3 ) − C01 (µ1 , µ2 )(µ1 − v1 (x, ω3 , t ))4
∂φ
constants K3 > 0 and K4 > 0 such that (11) f (1) (x, y1 , y2 , t ) +
∂x − C02 (µ1 , µ2 )(ω2 − v2 (x, ω3 , t ))4 ,
∂φ1 (y1 ,x(1) ,t ) β
)) ( v1 (x(1) , t ))l+1 ], and
2
∂t
6 K 3 [(ρ( x + i =1 y1 − √
where A0 (µ1 , µ2 ) = K1 − √µ3 − √µ4 , C01 (µ1 , µ2 ) = 41 µ1 −
K K
∂φ2 (2) ( )
∂φ (y ,x ,t )
2
f (x, y1 , y2 , t ) + 2 2∂ t 6 K4 [(ρ(x))β + i=1 (y2 −
2 1 2
∂ x(2) √
K2 − √µ3 − √µ4 , C02 (µ1 , µ2 ) = 14 µ2 − K2 − √µ3 − √µ4 , with
K K K K
(2)
v2 (x , t )) l+1
], where K3 and K4 can be calculated as follows: 1 2 1 2
∂φ (y ,x(1) ,t )
∂φ1 (1) p p
∂ x(1) f (x, y1 , y2 , t ) + 1 1∂ t 1
K1 = α2 − Ii (γi,0 + Cj γi,j ) ϵ , (26)
K3 6 max , (23) 2
ρ(x,y1 ,y2 )=1 2 l+1 i =1 j=1
(ρ(x))β + yi − vi (x(i) , t )
i =1 and K2 , K3 and K4 being calculated as in (22)–(24) by replacing
∂φ (y ,x(2) ,t ) y1 = ω1 , y2 = ω2 , x = η, f (i) (x, y1 , y2 , t ) as (7), and vi (x(i) , t )
∂φ2 (2)
∂ x(2) f (x, y1 , y2 , t ) + 2 2∂ t as vi (x, ω3 , t ).
K4 6 max . (24)
Furthermore, since g1 (z ) is homogeneous of degree l1 = 2 with
ρ(x,y1 ,y2 )=1 2 l+1
(ρ(x))β + yi − vi (x(i) , t ) respect to δλr (x, ω) (which is defined in Theorem 8), there exists a
i =1 ∂ F (z ,t )
constant M1 > 0 such that ∂z
g1 (z ) 6 M1 ρ 6 (x, ω), where
By collectively considering the above results, one has Ẇ 6
∂ F (z , t )
l+1 l+1
−β1 (ρ(x))β − β2 y1 − v1 (x(1) , t ) − β3 y2 − v2 (x(2) , t )
g1 (z ) .
, M1 = max (27)
K K √
where β1 = (K1 − √µ3 − √µ4 ), β2 = ( 2l1−1 µ1 − K2 − √µ3 − √µ4 )
K K ρ(x,ω)=1 ∂z
1 2 1 2
√
and β3 = ( 2l1−1 µ2 − K2 − √µ3 − √µ4 ). The proof is completed by
K K Note that g2 (z ) is homogeneous of degree l2 = 4. By using the same
∂ F (z ,t )
1 2
reasoning, there exists a constant M2 > 0 such that ∂ z g2 (z ) 6
designing µ1 and µ2 large enough such that β1 > 0, β2 > 0 and
and β3 > 0. M2 ρ (x, ω), where
8
∂ F (z , t )
Based on Lemmas 6 and 7, in the next theorem, we provide a g2 (z ) .
M2 = max (28)
result on how to design an invariant set for the system in (3) with ρ(x,ω)=1 ∂z
the control law in (8).
As a result, one obtains that Ḟ (z , t ) 6 −A0 (µ1 , µ2 )ρ 4 (x, ω3 ) −
C01 (µ1 , µ2 )(ω1 −v1 (x, ω3 , t ))4 − C02 (µ1 , µ2 )(ω2 −v2 (x, ω3 , t ))4 +
Theorem 8. For the system in (3) with the control law in (8), define M1 ρ 6 (x, ω) + M2 ρ 8 (x, ω).
a dilation as δλr (x, ω) = (λx1 , λx2 , λ2 x3 , λω1 , λω2 , λ2 ω3 ), and the Note again that the function A0 (µ1 , µ2 )ρ 4 (x, ω3 ) + C01 (µ1 , µ2 )
homogeneous norm as ρ(x, ω) = (x41 + x42 + x23 + ω14 + ω24 + ω32 )1/4 . (ω1 − v1 (x, ω3 , t ))4 + C02 (µ1 , µ2 )(ω2 − v2 (x, ω3 , t ))4 is homo-
Then for large enough µ1 > 0 and µ2 > 0, there exist constants geneous of degree 4. As a result, there exists a constant K̄1 >
ϵ0 > 0 and ε0 > 0, such that for any ϵ ∈ (0, ϵ0 ) and ε ∈ (0, ε0 ], 0 such that M1 ρ 6 (x, ω) 6 K̄1 ρ 2 (x, ω)(A0 (µ1 , µ2 )ρ 4 (x, ω3 ) +
the set inclusion col(x, ω) ∈ Ωε (x, ω) implies Ḟ (z , t ) 6 0 along the C01 (µ1 , µ2 )(ω1 −v1 (x, ω3 , t ))4 + C02 (µ1 , µ2 )(ω2 −v2 (x, ω3 , t ))4 ),
trajectory of the closed-loop system in (3) using control in Lemma 1, where the constant K̄1 is calculated as
where the set Ωε (x, ω) , {(x, ω) ∈ R6 |ρ(x, ω) 6 ε}, the value of ϵ0
K̄1 = max M1 / A0 (µ1 , µ2 )ρ 4 (x, ω3 )
is calculated as in (19) and
ρ(x,ω)=1
with K̄1 in (29) and K̄2 in (30). K̄1 ρ 4 (x, ω)(A0 (µ1 , µ2 )ρ 4 (x, ω3 ) + C01 (µ1 , µ2 )(ω1 − v1 (x, ω3 , t ))4
150 H. Li et al. / Automatica 75 (2017) 144–153
+ C02 (µ1 , µ2 )(ω2 − v2 (x, ω3 , t ))4 ), where the constant K̄2 is Algorithm 2 Parameter Design
calculated as 1: Design V (x, ω3 ) according to the condition in (11);
2: Design K1 and K2 by solving (12) and (13);
K̄2 = max M2 / A0 (µ1 , µ2 )ρ (x, ω3 ) 4
ρ(x,ω)=1 3: Apply α1 = K1 and α2 = K2 , calculate δi , Ci , Ii and γi,j as in
Lemma 6, and calculate ϵ0 according to (19);
+ C01 (µ1 , µ2 )(ω1 − v1 (x, ω3 , t )) 4
4: Choose ϵ ∈ (0, ϵ0 );
+ C02 (µ1 , µ2 )(ω2 − v2 (x, ω3 , t ))4 .
(30) 5: Design K1 , K2 , K3 and K4 as in (26), (22), (23) and (24),
respectively;
Therefore, we arrive at 6: Design µ1 and µ2 according to (32), and calculate A0 (µ1 , µ2 ),
Ḟ (z , t ) 6 −Ξ (ρ(x, ω)) A0 (µ1 , µ2 )ρ 4 (x, ω3 ) C01 (µ1 , µ2 ), and C02 (µ1 , µ2 );
7: Calculate M1 and M2 according to (27) and (28);
+ C01 (µ1 , µ2 )(ω1 − v1 (x, ω3 , t ))4 8: Calculate K̄1 and K̄2 using (29) and (30);
+ C02 (µ1 , µ2 )(ω2 − v2 (x, ω3 , t ))4 , Solve ε0 according to (25);
(31) 9:
10: Solve the optimization problem Q to calculate εT , and design
where Ξ (ρ(x, ω)) = 1 − K̄1 ρ 2 (x, ω) − K̄2 ρ 4 (x, ω). Since ε0 is ε ∈ (0, εT ];
designed as in (25) in Theorem 8, it follows that Ξ (ρ(x, ω)) > 0 11: Design Aρ , Bu1 and Bu2 according to (33).
when 0 < ρ(x, ω) 6 ε0 . As a result, if µ1 and µ2 are designed such
that
Proof. The proof can be obtained by following the similar way as
A0 (µ1 , µ2 ) > 0, C01 (µ1 , µ2 ) > 0, and in Li and Shi (2014a,b) and Michalska and Mayne (1993) by noting
(32) that, at time tk+1 , ūi (s; tk+1 ), s ∈ [tk+1 , tk+1 + T ] is a feasible
C02 (µ1 , µ2 ) > 0,
solution, where
and 0 < ρ(x, ω) 6 ε0 , then Ḟ (z , t ) 6 0. That is, col(x, ω) ∈ ū(s; tk+1 ) = u∗ (s; tk ), s ∈ [tk+1 , tk + T ],
Ωε0 (x, ω) implies Ḟ (z , t ) 6 0. This completes the proof.
ū(s; tk+1 ) = col(u1 (s; tk+1 ), u2 (s; tk+1 )), s ∈ (tk + T , tk+1 + T ],
Remark 9. From the proof of Theorem 8, it can be seen that the with u∗ (s; tk ) being the optimal control input at time instant tk and
function F (z , t ) is a local Lyapunov function for the system in u1 (s; tk ) and u2 (s; tk ) defining as in (8).
(3) given that the parameters µ1 and µ2 are designed to satisfy
In next theorem, we show that the closed-loop system in (3)
the condition in (32), ϵ ∈ (0, ϵ0 ) and ε ∈ (0, ε0 ]. And the
is stabilized by the designed control Algorithm 1. Before that, we
corresponding local stable set is Ωε0 (x, ω).
recall a lemma which extends the Barbalat’s lemma (Slotine & Li,
1991).
4.2. Parameter design
Lemma 11 (Jiang and Nijmeijer (1999)). For any differentiable
Using the result in Theorem 8 and considering the control input function f : R+ → R, if limt →∞ f (t ) = 0, and its derivative can
constraints in (2), an upper bound of the terminal set level ε > 0 be written as f˙ (t ) = f0 (t ) + η(t ) with f0 being uniformly continuous
can be designed by the following optimization problem. and limt →∞ η(t ) = 0, then limt →∞ f˙ (t ) = 0 and limt →∞ f0 (t ) = 0.
Problem Q. Theorem 12. For the system in (3), if the control law is designed
by using Algorithm 1 in which the parameters are designed as in
εT = sup F (z , t ), subject to u1 (t ) ∈ Γ1 , u2 (t ) ∈ Γ2 , Algorithm 2, then the closed-loop system is locally asymptotically
z ∈Ωε0 (x,ω),t ∈R stable at the origin.
where u1 (t ) and u2 (t ) are given as in (8). Proof. Using the idea as in Fontes (2001), denote the optimal value
of the optimization problem P (t , z (t ), T −(t − tk )) by Wtk (t , z (t )),
In the optimization problem P (tk , z (tk ), T ), the terminal set
and define U (t , z (t )) , Wδ (t , z (t )), with δ = sup{tk 6 t }.
level ε is designed as ε ∈ (0, εT ]. The constants Aρ , Bu1 and Bu2
According to the principle of Dynamic programming, one can
are designed by
obtain that
Aρ ∈ (0, Ξ (ε)A0 ], Bu1 ∈ (0, Ξ (ε)C01 ] t
U (t , z (t )) = Wtk (tk , z (tk )) −
∗ ∗
L(z ∗ (s), u∗ (s), s)ds. (34)
and Bu2 ∈ (0, Ξ (ε)C02 ]. (33) tk
In summary, the steps for designing parameters in the opti- Note that Wtk (tk , z ∗ (tk )) = J (z ∗ (s; tk ), u∗ (s; tk ), s) and Wtk+1 (tk+1 ,
mization problem P (tk , z (tk ), T ) are detailed as in Algorithm 2. z ∗ (tk+1 )) 6 J (z̄ (s; tk+1 ), ū(s; tk+1 )). Thus,
Wtk+1 (tk+1 , z ∗ (tk+1 )) − Wtk (tk , z ∗ (tk ))
5. Feasibility and stability analysis
6 J (z̄ (s; tk+1 ), ū(s; tk+1 ), s) − J (z ∗ (s; tk ), u∗ (s; tk ), s).
This section first investigates the iterative feasibility problem Furthermore, by plugging the detailed terms into J (z̄ (s; tk+1 ),
of the optimization problem P (tk , z (tk ), T ), and then studies the ū(s; tk+1 ), s) − J (z ∗ (s; tk ), u∗ (s; tk ), s), we can get
closed-loop stability problem of (3) using the optimal control law
J (z̄ (s; tk+1 ), ū(s; tk+1 ), s) − J (z ∗ (s; tk ), u∗ (s; tk ), s)
by solving P (tk , z (tk ), T ). Before proceeding, we define all the
tk+1
initial states as Z0 under which Problem P (t0 , z (t0 ), T ) has a
=− L(zi∗ (s; tk ), u∗i (s; tk ), s)ds
solution. tk
tk+1 +T
Theorem 10. For any z (t0 ) ∈ Z0 , if the parameters are designed as + L(z̄ (s; tk ), ū(s; tk ), s)ds
in Algorithm 2, then the optimization Problem P (tk , z (tk ), T ) has at tk +T
least a solution for all tk > t0 , and the designed Algorithm 1 is feasible. + F (z̄ (tk+1 + T ; tk+1 ), tk+1 + T ) − F (z̄ (tk + T ; tk ), tk + T ).
H. Li et al. / Automatica 75 (2017) 144–153 151
tk + T
L(z̄ (s; tk ), ū(s; tk ), s)ds + F (z̄ (tk+1 + T ; tk+1 ), tk+1 + T ) −
F (z̄ (tk + T ; tk ), tk + T ) 6 0, and J (z̄ (s; tk+1 ), ū(s; tk+1 ), s) −
t
J (z ∗ (s; tk ), u∗ (s; tk ), s) = − t k+1 L(z ∗ (s; tk ), u∗ (s; tk ), s)ds. As a
k
result,
t
U (t , z ∗ (t )) − U (tk , z ∗ (tk )) 6 − L(z ∗ (s), u∗ (s), s)ds, (35)
tk
References Teel, A. R., & Sanfelice, R. G. (2008). On robust, global stabilization of the attitude
of an underactuated rigid body using hybrid feedback. In Proceedings of 2008
Brockett, R. W. (1982). Asymptotic stability and feedback stabilization. In Differen- American control conference (pp. 2909–2914).
tial geometry control theory (pp. 181–191). Tsiotras, P. (1996). Stabilization and optimality results for the attitude control
Byrnes, C. I., & Isidori, A. (1991). On the attitude stabilization of rigid spacecraft. problem. Journal of Guidance, Control, and Dynamics, 19(4), 772–779.
Automatica, 27(1), 87–95. Tsiotras, P. (1997). Optimal regulation and passivity results for axisymmetric rigid
Carravetta, F. (2014). Almost-global exponential state-feedback stabilization of an bodies using two controls. Journal of Guidance, Control, and Dynamics, 20(3),
underactuated rigid-body in 3D. In Proceedings of the IEEE 53rd annual conference 457–464.
on decision and control. CDC (pp. 5612–5617). Tsiotras, P., & Luo, J. (1997). Reduced-effort control laws for underactuated rigid
Casagrandea, D., Astolfi, A., & Parisini, T. (2008). Global asymptotic stabilization of spacecraft. Journal of Guidance, Control, and Dynamics, 20(6), 1089–1095.
the attitude and the angular rates of an underactuated non-symmetric rigid Tsiotras, P., & Luo, J. (2000). Control of underactuated spacecraft with bounded
body. Automatica, 44(7), 1781–1789. inputs. Automatica, 36(8), 1153–1169.
Chen, H., & Allgöwer, F. (1998). A quasi-infinite horizon nonlinear model predictive
control scheme with guaranteed stability. Automatica, 34(10), 1205–1217.
Fontes, F. A. C. C. (2001). A general framework to design stabilizing nonlinear model Huiping Li, received his B.Sc. and M.Sc. degrees in mechan-
predictive controllers. Systems & Control Letters, 42(2), 127–143. ical engineering and automatic control from Northwestern
Gui, H., & Vukovich, G. (2015). Robust adaptive spin-axis stabilization of a Polytechnical University, Xi’an, China, in 2006 and 2009,
symmetric spacecraft using two bounded torques. Advances in Space Research, respectively, his Ph.D. degree in mechanical engineering
56(11), 2495–2507. from University of Victoria, BC, Canada, in 2013. From May
Guiggiani, A., Kolmanovsky, I., Patrinos, P., & Bemporad, A. (2014). Fixed-point to October 2013, he was a Postdoctoral Research Fellow
constrained model predictive control of spacecraft attitude. arXiv:1411.0479. with the Department of Mechanical Engineering, Univer-
Hegrenæ, Ø., Gravdahl, J. T., & Tøndel, P. (2005). Spacecraft attitude control using sity of Victoria, BC. Since November 2013, he has been with
explicit model predictive control. Automatica, 41(12), 2107–2114. the School of Marine Science and Technology, Northwest-
Jiang, Z.-P., & Nijmeijer, H. (1999). A recursive technique for tracking control of ern Polytechnical University, Xi’an, where he is currently
nonholonomic systems in chained form. IEEE Transactions on Automatic Control, a Full Professor. His research interests include model pre-
44(2), 265–279. dictive control, networked control systems, multi-agent systems, and distributed
Kalabic, U., Gupta, R., Di Cairano, S., Bloch, A., & Kolmanovsky, I. (2014). Constrained and cooperative control of underwater vehicles. He was a Guest Technical Editor
spacecraft attitude control on so(3) using reference governors and nonlinear for a Special Section in IEEE/ASME Transactions on Mechatronics.
model predictive control. In Proceedings of the 2014 American control conference.
ACC (pp. 5586–5593).
Li, H., & Shi, Y. (2014a). Distributed receding horizon control of large-scale nonlinear
systems: Handling communication delays and disturbances. Automatica, 50(4), Weisheng Yan, received the B.Sc., M.Sc. and Ph.D. degrees
1264–1271. in mechanical engineering and automatic control from
Li, H., & Shi, Y. (2014b). Robust distributed model predictive control of constrained Northwestern Polytechnical University (NWPU), Xi’an,
continuous-time nonlinear systems: A robustness constraint approach. IEEE China, in 1990, 1993 and 1999, respectively. Since
Transactions on Automatic Control, 59(6), 1673–1678. 1993, he has been with the Department of Mechanical
Li, H., Shi, Y., & Yan, W. (2016). Distributed receding horizon control of constrained Engineering and Automation, School of Marine Science
nonlinear vehicle formations with guaranteed γ -gain stability. Automatica, 68, and Technology, NWPU, Xi’an, China, as Lecturer (1993),
148–154. Associate Professor (1999) and Full Professor (2003). From
Li, H., Xie, P., & Yan, W. (2016). Receding horizon formation tracking control of 2003 to 2013, he served as the Dean of the Department of
constrained underactuated autonomous underwater vehicles. IEEE Transactions Mechanical Engineering and Automation. Since 2013, he
on Industrial Electronics, http://dx.doi.org/10.1109/TIE.2016.2589921. has been serving as the Associate Dean of the School. His
Li, H., & Yan, W. (2015). Receding horizon control based consensus scheme in research interests are mainly focused on advanced control theory and control of
general linear multi-agent systems. Automatica, 49(7), 1031–1036. underwater vehicles.
Li, H., & Yan, W. (2016). Model predictive stabilization of constrained underactuated
autonomous underwater vehicles with guaranteed feasibility and stability.
IEEE/ASME Transactions on Mechatronics, http://dx.doi.org/10.1109/TMECH.
2016.2587288. Yang Shi received the Ph.D. degree in electrical and
Marchand, N., & Alamir, M. (2003). Receding horizon stabilization of a rigid computer engineering from the University of Alberta,
spacecraft with two actuators. Journal of Dynamic Systems, Measurements, and Edmonton, AB, Canada, in 2005. From 2005 to 2009, he
Control, 125(3), 489–491. was an Assistant Professor and Associate Professor in
MCloskey, R. T., & Murray, R. M. (1997). Exponential stabilization of driftless the Department of Mechanical Engineering, University of
nonlinear control systems using homogeneous feedback. IEEE Transactions on Saskatchewan, Saskatoon, Saskatchewan, Canada. In 2009,
Automatic Control, 42(5), 614–628. he joined the University of Victoria, and now he is a
Michalska, H., & Mayne, D. Q. (1993). Robust receding horizon control of Professor in the Department of Mechanical Engineering,
constrained nonlinear systems. IEEE Transactions on Automatic Control, 38(11), University of Victoria, Victoria, British Columbia, Canada.
1623–1633. His current research interests include networked and
Morin, P., & Samson, C. (1997). Time-varying exponential stabilization of a rigid distributed systems, model predictive control, system
spacecraft with two control torques. IEEE Transactions on Automatic Control, identification, mechatronics, navigation and control of autonomous systems (AUV
42(4), 528–534. and UAV), and energy system applications.
Morin, P., Samson, C., Pomet, J.-B., & Jiang, Z.-P. (1995). Time-varying feedback Dr. Shi received the University of Saskatchewan Student Union Teaching
stabilization of the attitude of a rigid spacecraft with two controls. Systems & Excellence Award in 2007, the Faculty of Engineering Teaching Excellence Award at
Control Letters, 25(5), 375–385. the University of Victoria in 2012. He received the JSPS Invitation Fellowship (short-
Pomet, J.-B., & Samson, C. (1993). Time-varying exponential stabilization of term), and was a Visiting Professor at the University of Tokyo during Nov–Dec
nonholonomic systems in power form. Rr-2126, INRIA. 2013. He serves as Associate Editor for IEEE Trans. Control Systems Technology,
Rosier, L. (1992). Homogeneous lyapunov function for homogeneous continuous IEEE/ASME Trans. Mechatronics, IEEE Trans. Fuzzy Systems, IET Control Theory and
vector field. Systems & Control Letters, 19, 467–473. Applications, ASME Journal of Dynamic Systems, Measurement, and Control. He is
Slotine, J.-J. E., & Li, W. (1991). Applied nonlinear control. Englewood Cliffs: Prentice currently a senior member of IEEE, a member of ASME, and a registered Professional
Hall. Engineer in British Columbia, Canada.