• 대한전기학회
Mobile QR Code QR CODE : The Transactions of the Korean Institute of Electrical Engineers
  • COPE
  • kcse
  • 한국과학기술단체총연합회
  • 한국학술지인용색인
  • Scopus
  • crossref
  • orcid

  1. (School of Electronic Engineering, Kyungpook National University, Republic of Korea)
  2. (School of Electronic Engineering, Kyungpook National University, Republic of Korea)



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, n denotes the n dimensional Euclidean space, and m × n 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+XT.

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

../../Resources/kiee/KIEE.2018.67.2.308/fig1.png

The dynamics of each follower can be represented as

(1)
x i ˙ = v i c o s ( θ i ) ,       y i ˙ = v i s i n ( θ i ) ,       θ i ˙ = w i

which v i ( m s e c ) is linear velocity, and w i ( r a d s e c ) 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),

(2)
x e , r , i y e , r , i θ e , r , i = cos θ i ( t ) sin θ i ( t ) 0 - sin θ i ( t ) cos θ i ( t ) 0 0 0 1 x r ( t ) - x i ( t ) y r ( t ) - y i ( t ) θ r ( t ) - θ i ( t )

By differentiating (2) and substituting (1) into the result, the error dynamics is obtained as

(3)
x ˙ e , r , i ( t ) = w i ( t ) y e , r , i ( t ) + v r c o s ( θ e , r , i ( t ) ) - v i ( t ) , y ˙ e , r , i ( t ) = - w i ( t ) x e , r , i ( t ) + v r s i n ( θ e , r , i ( t ) ) , θ ˙ e , r , i ( t ) = w r - w i ( t ) .

Further on linearizing (3) around operating point ( x ¯ e , r , i = 0 , y ¯ e , r , i = 0 , θ ¯ e , r , i = 0 , v ¯ i = v ^ , w ¯ i = w ^ ) results in the following linear model

(4)
X r , i ˙ ( t ) = A ( t ) X r , i ( t ) + B U r , i ( t )

where X r , i = [ x e , r , i - x ¯ e , r , i , y e , r , i - y ¯ e , r , i , θ e , r , i - θ ¯ e , r , i ] , and U r , i = [ v i - v ^ , w i - w ^ ] . The system matrices A and B are

(5)
A ( t ) = 0 w ^ ( t ) 0 - w ^ ( t ) 0 v r ( t ) 0 0 0 ,   B = - 1 0 0 0 0 - 1

To consider the system’s less uncertainty, the range of w ^ ( t ) has w ^ [ w r ( t ) - w ~ w r ( t ) + w ~ ] , then the all solutions of (4) can be solved between A1 and A2

A 1 ( t ) = 0 w r ( t ) - w ~ 0 - w r ( t ) - w ~ 0 v r ( t ) 0 0 0 ,     A 2 ( t ) = 0 w r ( t ) + w ~ 0 - w r ( t ) + w ~ 0 v r ( t ) 0 0 0

which A1 is the minimum of the w ^ , and A2 is the maximum of the w ^ .

The network-induced input delay is considered, so the control input is defined

(6)
U r , i ( t k , r , i ) = K r , i X r , i ( t k , r , i )

where Kr,i is the control gain matrix for t∈[tk,r,i tk+1,r,i). Without loss of generality, it is assumed that the sampled time interval is bounded by

(7)
h r , i ( t ) h M , r , i

where hr,i(t)=tk+1,r,i-tk,r,i and hM,r,i is the maximum sampled delay. Using sampled signals, the LPV systems of mobile robot (4) is reformulated as delayed LPV model,

(8)
X r , i ˙ ( t ) = A s ( t ) X r , i ( t ) + B U r , i ( t k , r , i ) ,       s = 1 , 2

To maintain the constant distance between the leader and followers,

(9)
X r , i ( t k , r , i ) = [ x e , r , i ( t k , r , i ) - l x , i , y e , r , i ( t k , r , i ) - l y , i , θ e , r , i ( t k , r , i ) - l θ , i ]

where lx,i,ly,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 Θ12,Ψ and a scalar τ(t)∈[0,τM], the following two conditions are equivalent:

(10)
1) τ ( t ) Θ 1 + ( τ M - τ ( t ) ) Θ 2 + Ψ < 0

(11)
2) τ M Θ 1 + Ψ < 0

(12)
τ M Θ 2 + Ψ < 0

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:

(13)
- a b X T ˙ ( s ) R X ˙ ( s ) d s S y m ( ϵ 0 T L ϵ 1 + ϵ 0 T H ϵ 2 ) + ( b - a ) e 0 T ( 3 L T R - 1 L + H T R - 1 H 3 ) ϵ 0

where ε0 is any vector and ε1=X(b)-X(a),

ϵ 2 = X ( b ) + X ( a ) - 2 b - a a b X ( s ) d s .

Remark 1. From the proof of Lemma 5(12), the generalized free-matrix inequality can be modified as

a b ϵ 0 T ( X T R - 1 X ) ϵ 0 d s = ( b - a ) ϵ 0 T ( X T R - 1 X ) ϵ 0

and

a b λ ( s ) ϵ 0 T ( H T R - 1 H ) λ ( s ) ϵ 0 d s = ( b - a ) 3 ϵ 0 T ( H T R - 1 H ) ϵ 0

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:

(14)
J r , i = 0 X r , i T ( t ) Q X r , i ( t ) + U r , i T ( t ) R U r , i ( t ) d t

where Q,R are weighting matrices. For the given performance index, if the following condition is satisfied

(15)
V ˙ r , i ( t ) + X r , i ( t ) Q 2 + U r , i ( t ) R 2 < 0

then the upper bound of the performance index can be derived instead of directly minimizing performance index.

Before deriving conditions, following notations are defined.

dr,i(t)=t-tk,r,i,

e1=[I 0 0 0], e2=[0 I 0 0], ··· , e4=[0 0 0 I],

F1=[I -I 0 0], F2=[I I 0 -2I],

f ¯ s=[As M BY -M 0], s=1,2,

fs=[As BK -I 0],

ζ r , i ( t k , r , i ) = [ X r , i T ( t ) X r , i T ( t k , r , i ) X r , i T ˙ ( t ) 1 t - t k , r , i t k , r , i t X r , i T ( s ) d s ] T .

Theorem 1. For a given with maximum sampling interval hM, the continuous system (1) is asymptotically stabilizable if there exist matrices P ˙ > 0 , S = S 1 S 2 * S 3 > 0 , M, L ¯ , H ¯ , UM,r,i and the control input at time instant tk,r,i guarantees the performance index (13) with γr,i.

(16)
m i n     γ r , i

(17)
1 X r , i t k , r , i * M T + M - P 0 0

(18)
Ξ 1 s < 0 ,       f o r       s = 1 , 2

(19)
Ξ 2 s < 0 ,       f o r       s = 1 , 2

(20)
M T + M - P 0 Y * U M , r , i 0

where

U M , r , i = u M , r , i 11 0 * u M , r , i 22 , u M , r , i 11 v i - v ^ max 2 u M , r , i 22 w i - w ^ max 2 ,

Ξ 1 s = Ξ 11 s Ξ 12 h M , r , i · L ¯ h M , r , i · H ¯ * Ξ 22 0 0 * * - h M , r , i · S ¯ 3 0 * * * - h M , r , i · S ¯ 3 ,

Ξ 2 s = Ξ 11 2 s Ξ 12 * Ξ 22 ,

Ξ 12 = d i a g [ M , Y ] ,

Ξ 22 = d i a g [ - γ r , i Q - 1 , - γ r , i R - 1 ] ,

with

Ξ 1 = e 1 T P 0 e 3 + ( e 1 T P 0 e 3 ) T + ( e 1 - e 2 ) T P ¯ 1 e 3 + ( ( e 1 - e 2 ) T P ¯ 1 e 3 ) T + S y m ( Z ¯ 1 F 1 + Z ¯ 2 F 2 ) - e 2 T S ¯ 2 ( e 1 - e 2 ) - ( e 2 T S ¯ 2 ( e 1 - e 2 ) ) T + ( e 1 + α e 4 ) T f ¯ i + ( ( e 1 + α e 4 ) T f ¯ i ) T ,

Ξ 2 = e 4 T P ¯ 1 e 1 + ( e 4 T P ¯ 1 e 1 ) T - e 2 T S ¯ 1 e 2 - e 4 T Z ¯ e 2 - ( e 4 T Z ¯ e 2 ) T ,

Ξ 3 = e 2 e 3 T S ¯ e 2 e 3 + e 1 T Z ¯ e 2 + e 1 T Z ¯ e 2 T .

In addition, the state feedback gains are given as Kr,i=YM-1.

Proof. Choosing the following Lyapunov function for t∈[tk, r, i, tk+1,r, i] yields

(21)
V r , i ( x t ) = V 1 , r , i ( t ) + V 2 , r , i ( t ) + V 3 , r , i ( t )

where

V 1 , r , i ( t ) = X r , i T ( t ) M - T P 0 M - 1 X r , i ( t ) ,

V 2 , r , i ( t ) = X r , i ( t ) - X r , i t k , r , i t k , r , i t X r , i ( s ) d s T P 1 X r , i ( t ) - X r , i t k , r , i t k , r , i t X k , r , i d s

V 3 , r , i ( t ) = t k + 1 , r , i - t t k , r , i t X r , i t k , r , i ] T X ˙ r , i ( t ) T S X r , i t k , r , i X ˙ r , i ( t ) d s + 2 t k , r , i t X r , i T ( s ) d s Z X r , i t k , r , i

Differentiate the Lyapunov function

(22)
V ˙ 1 , r , i ( t ) = 2 e 1 T M - T P 0 M - 1 e 3

(23)
V ˙ 2 , r , i ( t ) = 2 e 1 - e 2 d r , t ( t ) e 4 T P 1 e 3 e 1

(24)
V ˙ 3 , r , i ( t ) = - d r , i ( t ) e 2 T S 1 e 2 - 2 e 2 T S 2 ( e 1 - e 2 ) - 2 d r , i ( t ) e 4 T Z e 2 + ( h M , r , i - d r , i ( t ) ) ( e 2 e 3 T S e 2 e 3 + 2 e 1 T Z e 2 ) - t k , r i t X ˙ r , i T ( s ) S 3 X ˙ r , i ( s ) d s

From Lemma 2, the following holds

(25)
- t k , r , i t X ˙ r , i T ( s ) S 3 X ˙ r , i d s S y m ( ϵ 0 T L ϵ 1 + ϵ 0 T H ϵ 2 ) + d r , i ( t ) ϵ 0 T ( 3 L T S 3 - 1 L + H T S 3 - 1 H 3 ) ϵ 0

where L, H are auxiliary variables. Taking into account system dynamics (8),

(26)
2 [ X r , i T ( t ) M - 1 + α X ˙ r , i T ( t ) M - 1 ] [ - X ˙ r , i ( t ) + A s X r , i ( t ) + B K r , i X r , i ( t k , r , i ) ]

Summing up from (22) to (26) leads to

(27)
V ˙ r , i + X r , i T ( t ) Q X r , i ( t ) + U r , i T ( t ) R U r , i ( t ) ζ r , i ( t k , r , i ) Ξ ¯ ζ r , i ( t k , r , i )

where

(28)
Ξ ¯ = Ξ ¯ 1 + d r , i ( t ) Ξ ¯ 2 + ( h M , r , i - d r , i ( t ) ) Ξ ¯ 3 Ξ ¯ 1 = e 1 T P 0 e 3 + ( e 1 T P 0 e 3 ) T + ( e 1 - e 2 ) T P 1 e 3 + ( ( e 1 - e 2 ) T P 1 e 3 ) T + S y m ( Z 1 F 1 + Z 2 F 2 ) - e 2 T S 2 ( e 1 - e 2 ) - ( e 2 T S 2 ( e 1 - e 3 ) ) T + ( e 1 + α e 4 ) T f i + ( ( e 1 + α e 4 ) T f i ) T + e 1 T Q e 1 + e 2 T K r , i T R K r , i e 2   Ξ ¯ 2 = e 4 T P 1 e 1 + ( e 4 T P 1 e 1 ) T - e 2 T S 1 e 2 - e 4 T Z e 2 - ( e 4 T Z e 2 ) T + L T S 3 - 1 L + 1 3 H T S 3 - 1 H   Ξ ¯ 3 = e 2 e 3 T S e 2 e 3 + e 1 T Z e 2 + ( e 1 T Z e 2 ) T

Pre-and post-multiplying with a matrix γ r , i 1 2 × { d i a g M , M , M , M } , the followings are satisfied with Lemma 1.

(29)
Ξ 1 + h M , r , i Ξ 2 + h M , r , i ( L ¯ T S ¯ 3 - 1 L ¯ ) + 1 3 h M , r , i ( H ¯ T S ¯ 3 - 1 H ¯ ) < 0

(30)
Ξ 1 + h M , r , i Ξ 3 < 0

where S ¯ = M S M , L ¯ = M L M , H ¯ = M H M , and Kr,i=YM-1. Using Schur complement, the equations in (18) and (19) are equivalent to those of (11) and (12). For every sampling instance, V2,r,i and V3,r,i vanish. Then, the upper bound of Lyapunov function is expressed in terms of V1,r,i.

(31)
X r , i T ( t k , r , i ) M P 0 M X r , i ( t k , r , i ) γ 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

(32)
X ˙ r , 1 ( t ) = A s ( t ) X r , 1 ( t ) + B U r , 1 ( t - h r , 1 ( t ) )

where

A 1 ( t ) = 0 w r ( t ) - 0 . 03 0 - w r ( t ) - 0 . 03 0 v r 0 0 0 ,

A 2 ( t ) = 0 w ( t ) + 0 . 03 0 - w r ( t ) + 0 . 03 0 v r ( t ) 0 0 0 ,

B = - 1 0 0 0 0 - 1 .

The model parameters are calculated with a sampling time 0.8s. The sampling time hr,1 is less than 0.8s. Along the reference trajectory (vr=0.2, wr=0.2), the input is constrained to - 0 . 3 ( v 1 - v ^ ) 0 . 3 and - 0 . 3 ( w 1 - w ^ ) 0 . 3 ( w ~ = 0 . 03 ) . The corresponding controller gain matrix is

(33)
K r , 1 = 0 . 6775 - 0 . 1771 - 0 . 0906 - 0 . 0880 0 . 3650 0 . 7873

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

../../Resources/kiee/KIEE.2018.67.2.308/fig2.png

그림. 3. 입력제한을 고려한 샘플데이타 제어입력

Fig. 3. The sampled-data control input with constraints

../../Resources/kiee/KIEE.2018.67.2.308/fig3.png

그림. 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)

../../Resources/kiee/KIEE.2018.67.2.308/fig4.png

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.

Acknowledgements

This research was supported by Basic Science Research Program through the National Research Foundation of Korea (NRF) funded by the Ministry of Education, Science and Technology (2016R1D1A1B03930623).

References

1 
Murray R. M., 2007, Recent research in cooperative control of multi vehicle systems, Journal of Dynamic Systems, Measurement, and Control, Vol. 129, No. 5, pp. 571-583DOI
2 
McLurkin J., Rykowski J., John M., Kaseman Q., Lynch A. J., 2013, Using multi-robot systems for engineering education: Teaching and outreach with large numbers of an advanced, low cost robot, Vol. 56, No. 1, pp. 24-33DOI
3 
Chen Y. Q., Wang Z., 2005, Formation control: a review and a new consideration, In Intelligent Robots and Systems, IEEE, 2005 IEEE/RSJ International Conference, pp. 3181-3186DOI
4 
Das A. K., Fierro R., Kumar V., Ostrowski J. P., Spletzer J., Taylor C. J., 2002, A vision-based 60 formation control framework, IEEE Trans, Vol. 18, No. 5, pp. 813-825Google Search
5 
Zhu W., Jiang Z. P., 2015, Event-based leader-following consensus of multi-agent systems with input time delay, IEEE Trans, Vol. 60, No. 5, pp. 1362-1367DOI
6 
Wen G., Chen C. P., Liu Y. J., Liu Z., 2017, Neural network-based adaptive leader-following consensus control for a class of nonlinear multi agent state-delay systems, IEEE Trans,, Vol. 47, No. 8, pp. 1927-1934DOI
7 
Sheng L., Pan Y. J., Gong X., 2012, Consensus formation control for a class of networked multiple mobile robot systems, Journal of Control Science and Engineering, Vol. 2012, pp. 1-12DOI
8 
Hong Y., Chen G., Bushnell L., 2008, Distributed observers design for leader-following control of 70 multi-agent networks, Automatica, Vol. 44, No. 3, pp. 846-850DOI
9 
Ding L., Han Q. L., Guo G., 2013, Network-based leader- following consensus for distributed multi-agent systems, Automatica, Vol. 49, No. 7, pp. 2281-2286DOI
10 
Lucia W., Tedesco F., 2015, A networked-based receding horizon scheme for constrained LPV systems, European Journal of Control, Vol. 25, pp. 69-75DOI
11 
Yue D., Tian E., Zhang Y., Peng C., 2009, Delay-distribution-dependent stability and stabilization of T-S fuzzy systems with probabilistic interval delay, IEEE Trans, Vol. 39, No. 2, pp. 503-516DOI
12 
Zhang C. K., He Y., Jiang L., Lin W., Wu M., 2017, Delay-dependent stability analysis of neural networks with time-varying delay: A generalized free-weighting- matrix, Applied Mathematics and Computation, Vol. 294, No. 1, pp. 102-120DOI
13 
Kwon W., Lee S. M., 2017, Sampled-Data Model Predictive Tracking Control for Mobile Robot, IJCAS, Vol. 11, No. 4, pp. 456-459Google Search
14 
Fridman E., Dambrine M., 2009, Control under quantization, saturation and delay: An LMI approach, Automatica, Vol. 45, No. 10, pp. 2258-2264DOI

저자소개

한승용 (Seungyong Han)
../../Resources/kiee/KIEE.2018.67.2.308/au1.png

1992년 1월 15일생

2016년 영남대학교 물리학과 졸업(이학)

현재 경북대학교 전자공학부 석사과정

E-mail : dds8946@knu.ac.kr

이상문 (Sangmoon Lee)
../../Resources/kiee/KIEE.2018.67.2.308/au2.png

1973년 6월 15일생

1999년 경북대학교 전자공학과 졸업(공학)

2006년 포항공과대학교 전기전자공학부 졸업(공박)

현재 경북대학교 전자공학부 부교수

E-mail : moony@knu.ac.kr