한승용
(Seungyong Han)
1
이상문
(Sangmoon Lee)
2†
-
(School of Electronic Engineering, Kyungpook National University, Republic of Korea)
-
(School of Electronic Engineering, Kyungpook National University, Republic of Korea)
Copyright © The Korean Institute of Electrical Engineers(KIEE)
Key words
Multi-mobile robot system, Sampled-data, Leader-following control, MPC
1. Introduction
Recently, multi-mobile robot systems are widely used for military, surveillance, and
transportation
(1,2). When multiple robots move toward a target while maintaining a certain distance or
angle, this is called formation
(3). In the formation control techniques, the leader-following method has been adopted
by many researchers
(4,5,6). In this method, the leader tracks a predefined path and the follower maintains a
desired geometric configuration with the leader. When multiple robots tasks, the inception
of distributed robotics is important issues so that communication system has been
extensively studied.
The communication network has a number of benefits simple installation and maintenance,
and high reliability, increased flexibility and safety. Therefore, many of researchers
are focused on this topic
(7,8).
In networked control system, the input control is delayed according to network-induced
delays. The network-induced delays usually consist of two kinds of delays: the communication
delays between the controller and the following mobile robots and the communication
delays between the controller, the actuator and sampler. The delay may cause instability
and performance degradation so that the design of control scheme should be considered
with aspects to performances of whole systems
(9).
In this paper, we propose a sampled-data model predictive control for leader-following
multi-mobile robots in network system. To derive the condition, the LPV model
(10) is considered in continuous time which reduces the difference between the dynamics
of the nominal closed-loop system and the actual evolution of the state. It is explicitly
assumed that the LPV model is updated only at the sampling instants and that the control
signal is kept constant between two consecutive sampled by means of a zero order holder,
while the plant and the parameters evolve continuously in time. In the case of periodic
and aperiodic sampling time, the robustness should be guaranteed so that a quadratic
Lyapunov function is considered with new looped- functionals. To deal with the single
integral term in the derivative of the Lyapunov function, a generalized free- weighting-matrix
(GFWM)
(12) gives a less conservatism. Finally, we demonstrate the effectiveness of the proposed
approach via numerical simulation.
The main contributions of this paper are summarized as follows:
(1) In the modelling aspects, we attempt to consider the modelling of multi-mobile
robots in continuous time which is more accurate than the discrete time. Moreover,
The MPC technique is not only adequate for the Leader-Follower model represented by
error dynamics, but also consider the input saturation constraint.
(2) In the sampled-data LPV systems, based on constructing new looped-functionals
and using a GFWM integral inequality, the proposed sampled data MPC design method
for LPV systems can get a larger sampling interval upper bound than the existing one
(13).
Notations: Throughout this paper,
denotes the n dimensional Euclidean space, and
is the set of all n×mreal matrices, For symmetric matrices A and B, the notation
A
B(respectively, A
B) means that the matrix A-B is positive definite (respectively, non- negative). diag{...}
denotes the block diagonal matrix. * denotes the symmetric part. I denotes identity
matrix with appropriate dimensions. Sym(X) denotes X+X
T.
2. Problem formulation
Consider a multi robot system composed of a leader mobile robot and i=1,...n followers.
The mobile robots in two dimensions are shown in
Fig. 1.
그림. 1. 기준 좌표계에서 이동로봇의 궤적 추적 에러
Fig. 1. 1Trajectory tracking error of a mobile robot in a global coordinate frame
The dynamics of each follower can be represented as
which
is linear velocity, and
is angular velocity. The leader labeled as i=r has the same dynamics of the followers.
To set up the problem, error coordinates between global and local coordination is
considered by using the dynamics
(1),
By differentiating
(2) and substituting
(1) into the result, the error dynamics is obtained as
Further on linearizing
(3) around operating point
results in the following linear model
where
, and
. The system matrices A and B are
To consider the system’s less uncertainty, the range of
has
, then the all solutions of
(4) can be solved between A
1 and A
2
which A
1 is the minimum of the
, and A
2 is the maximum of the
.
The network-induced input delay is considered, so the control input is defined
where K
r,i is the control gain matrix for t∈[t
k,r,i t
k+1,r,i). Without loss of generality, it is assumed that the sampled time interval is bounded
by
where h
r,i(t)=t
k+1,r,i-t
k,r,i and h
M,r,i is the maximum sampled delay. Using sampled signals, the LPV systems of mobile robot
(4) is reformulated as delayed LPV model,
To maintain the constant distance between the leader and followers,
where l
x,i,l
y,i,l
θ,i is the safety distance between the leader and th robot in each coordinate.
Lemma 1.
(11) For any constant matrices of appropriate dimensions Θ
1,Θ
2,Ψ and a scalar τ(t)∈[0,τ
M], the following two conditions are equivalent:
Lemma 2.
(12) Consider X is a differentiable in [a,b]∈
n . For matrices R
0 and any matrices L and H, the following inequality holds:
where ε
0 is any vector and ε
1=X(b)-X(a),
Remark 1. From the proof of Lemma 5
(12), the generalized free-matrix inequality can be modified as
and
respectively.
3. Main Results
The main purpose of this paper is to design a sampled- data MPC. the essence of a
MPC scheme is to optimize predictions of process behavior over a sequence of future
control inputs. Therefore, the objective function to be minimized can be stated as
a quadratic function of the states and control inputs:
where Q,R are weighting matrices. For the given performance index, if the following
condition is satisfied
then the upper bound of the performance index can be derived instead of directly minimizing
performance index.
Before deriving conditions, following notations are defined.
d
r,i(t)=t-t
k,r,i,
e
1=[I 0 0 0], e
2=[0 I 0 0], ··· , e
4=[0 0 0 I],
F
1=[I -I 0 0], F
2=[I I 0 -2I],
s=[A
s M BY -M 0], s=1,2,
f
s=[A
s BK -I 0],
Theorem 1. For a given with maximum sampling interval h
M, the continuous system
(1) is asymptotically stabilizable if there exist matrices
,
, M,
,
, U
M,r,i and the control input at time instant t
k,r,i guarantees the performance index
(13) with γ
r,i.
where
,
,
,
,
,
with
,
,
.
In addition, the state feedback gains are given as K
r,i=YM
-1.
Proof. Choosing the following Lyapunov function for t∈[t
k, r, i, t
k+1,r, i] yields
where
,
Differentiate the Lyapunov function
From Lemma 2, the following holds
where L, H are auxiliary variables. Taking into account system dynamics
(8),
Summing up from (22) to (26) leads to
where
Pre-and post-multiplying with a matrix
, the followings are satisfied with Lemma 1.
where
and K
r,i=YM
-1. Using Schur complement, the equations in
(18) and
(19) are equivalent to those of
(11) and
(12). For every sampling instance, V
2,r,i and V
3,r,i vanish. Then, the upper bound of Lyapunov function is expressed in terms of V
1,r,i.
where γ
r,i denotes the bound of optimal performance index. The input saturation is considered
similar to the method in [14]
(14). This ends the proof.
4. Numerical Examples
The dynamical equation
(8) is considered as
where
,
,
.
The model parameters are calculated with a sampling time 0.8s. The sampling time h
r,1 is less than 0.8s. Along the reference trajectory (v
r=0.2, w
r=0.2), the input is constrained to
and
. The corresponding controller gain matrix is
Fig. 2 and
Fig. 3 show the simulation results which are obtained with the above controller gain, taking
Q=I, R=I, α=0.1.
그림. 2. 시스템 에러 응답
Fig. 2. The error response of the system
그림. 3. 입력제한을 고려한 샘플데이타 제어입력
Fig. 3. The sampled-data control input with constraints
그림. 4. 리더(r)와 첫 번째(i=1)추종 로봇의 시간 t=0,1 0~50(초)에서의 궤적
Fig. 4. The trajectory of each robot(r, i=1) at time t=0,1 0~50(sec)
5. Conclusions
The sampled-data MPC method for multi-mobile robot systems have been investigated
by considering polytopic LPV model. Based on the quadratic Lyapunov function approach,
sufficient conditions for the sampled-data MPC controller are derived by constructing
new looped-functionals. The proposed method guarantees a performance and stability
in much longer sampling delay than the existing paper. The effectiveness of the presented
method has been verified by illustration numerical simulation.