6
Model Predictive Control with Reference Anisotropic Control for Robot Motion with Disturbed Measured Outputs Kvˇ etoslav Belda 1 , Arkadiy Kustov 2 , Alexander Yurchenkov 2 and Michael Tchaikovsky 2 Abstract— This paper introduces specific extension of model predictive control (MPC) with reference anisotropic control (Ha control) for a robot motion with disturbed measured outputs. The purpose is to exploit advance of flexible multi-step MPC and stabilizing (robust) properties of Ha control serving for disturbance attenuation of disturbed measured outputs. The linking of MPC and Ha control is derived as both a simple improvement of MPC by Ha control providing disturbance attenuation only and a modification of a cost function in MPC design by an additional tunable term weighting the proximity of MPC design to Ha control. Considered novel Ha control represents adjustable transition between H2 and Hcontrol i.e. between excited (trusting) and too conservative design. The proposed control design is based on state-space formula- tion that run in output feedback configuration complemented by state estimation based on anisotropic theory again. The theo- retical achievements are demonstrated by simulations using a state-space model describing dynamics of one specific over- actuated planar parallel kinematic machine, robot-manipulator. I. INTRODUCTION Efficient, accurate and safe motion control in various applications is the present issue for increasing robotisation in industrial enterprises. Exploitation of industrial robots in- fluences all branches of production from automotive to every day life products. The robotic appliances are still predomi- nantly controlled by various PID controllers and their modi- fications, usually implemented as a set of local controllers of drives. This concept does not consider dynamic linkages through the robot construction caused by inertia and gravity effects or friction. This drawback is overcome by surplus of input energy. Advanced model based control strategies, such as model predictive control (MPC) [1], [2], [3], [4], H 2 or H [5], [6], offers attractive properties. However, the strategies are not considerably robust against surrounding disturbances or they are able to reduce only energy consumption without increas- ing the production quality, specifically increasing of the mo- tion accuracy. The robustness property of MPC respecting imprecisely known model parameters and stochastic disturbances is not fully solved for real-time control of industrial machines [7]. This work was supported by The Czech Academy of Sciences, Institute of Information Theory and Automation; The Russian Academy of Sciences, Institute of Control Sciences of V. A. Trapeznikov; and partially by Russian Foundation for Basic Research (RFBR) 18-31-00067. 1 K. Belda is with The Czech Academy of Sciences, Institute of Infor- mation Theory and Automation, Pod Vod´ arenskou vˇ ı 4, 182 00 Prague 8, Czech Republic, [email protected] (corresponding author) 2 A.Yu. Kustov, A.V. Yurchenkov and M.M. Tchaikovsky are with Insti- tute of Control Sciences, RAS, Profsoyuznaya 65, 117997 Moscow, Russia [email protected], [email protected], [email protected] Problems of an insufficient disturbance attenuation of H 2 or excessive conservatism of H can be solved by a specific control design based on anisotropic control theory which measures statistic disturbance uncertainty in terms of a rel- ative entropy rate. The disturbance attenuation capabilities of the feedback control for specific controlled system are quantified by a specific anisotropic norm [8], firstly studied by I. G. Vladimirov [9], which represents a stochastic coun- terpart of the H norm. Minimisation of such norm leads to the control, which is less conservative and efficient in dis- turbance attenuation than H and H 2 norms respectively. The paper aims at compact introduction of specific inter- connection ways of MPC and anisotropic control (H a con- trol). The reason for exploration of such interconnection is to improve robustness of MPC but without increase of computational complexity and to avoid inadequate be- haviour H a control in an abrupt transitions of reference sig- nals, which is caused by one-ahead character of H a control. Due to the flexibility of MPC design, the H a control may be incorporated as a robust reference control or as a spe- cific disturbance attenuation component in the MPC design. The basic properties of MPC and H a control in motion con- trol were described in [10]. The control proposed here will be demonstrated with a dynamic model of the parallel kine- matic machine, robot-manipulator, depicted in Fig. 1. The paper is organized as follows. In section II, there is a formulation of dual goal problem that consists in the effort to meet reference signals simultaneously with the solution of the disturbance attenuation. Sections III, IV and V in- troduce anisotropic control and anisotropic estimation. Sec- tion VI deals with MPC design concept and its modifications using reference anisotropic control. Section VII demonstrates proposed control ways by simulation examples. Finally, sec- tion VIII summarizes the proposed ways and their practical use in motion control. Fig. 1. Over-actuated planar parallel kinematic machine [11]. 2020 European Control Conference (ECC) May 12-15, 2020. Saint Petersburg, Russia Copyright ©2020 EUCA 1111

Model Predictive Control with Reference Anisotropic Control ...library.utia.cas.cz/separaty/2020/AS/belda-0524380.pdfModel Predictive Control with Reference Anisotropic Control for

  • Upload
    others

  • View
    3

  • Download
    0

Embed Size (px)

Citation preview

  • Model Predictive Control with Reference Anisotropic Controlfor Robot Motion with Disturbed Measured Outputs

    Květoslav Belda1, Arkadiy Kustov2, Alexander Yurchenkov2 and Michael Tchaikovsky2

    Abstract— This paper introduces specific extension of modelpredictive control (MPC) with reference anisotropic control(Ha control) for a robot motion with disturbed measuredoutputs. The purpose is to exploit advance of flexible multi-stepMPC and stabilizing (robust) properties of Ha control servingfor disturbance attenuation of disturbed measured outputs.The linking of MPC and Ha control is derived as both a simpleimprovement of MPC by Ha control providing disturbanceattenuation only and a modification of a cost function in MPCdesign by an additional tunable term weighting the proximityof MPC design to Ha control. Considered novel Ha controlrepresents adjustable transition between H2 and H∞ controli.e. between excited (trusting) and too conservative design.The proposed control design is based on state-space formula-tion that run in output feedback configuration complementedby state estimation based on anisotropic theory again. The theo-retical achievements are demonstrated by simulations usinga state-space model describing dynamics of one specific over-actuated planar parallel kinematic machine, robot-manipulator.

    I. INTRODUCTION

    Efficient, accurate and safe motion control in variousapplications is the present issue for increasing robotisationin industrial enterprises. Exploitation of industrial robots in-fluences all branches of production from automotive to everyday life products. The robotic appliances are still predomi-nantly controlled by various PID controllers and their modi-fications, usually implemented as a set of local controllersof drives. This concept does not consider dynamic linkagesthrough the robot construction caused by inertia and gravityeffects or friction. This drawback is overcome by surplusof input energy.

    Advanced model based control strategies, such as modelpredictive control (MPC) [1], [2], [3], [4],H2 orH∞ [5], [6],offers attractive properties. However, the strategies are notconsiderably robust against surrounding disturbances or theyare able to reduce only energy consumption without increas-ing the production quality, specifically increasing of the mo-tion accuracy.

    The robustness property of MPC respecting impreciselyknown model parameters and stochastic disturbances is notfully solved for real-time control of industrial machines [7].

    This work was supported by The Czech Academy of Sciences, Instituteof Information Theory and Automation; The Russian Academy of Sciences,Institute of Control Sciences of V. A. Trapeznikov; and partially by RussianFoundation for Basic Research (RFBR) 18-31-00067.

    1K. Belda is with The Czech Academy of Sciences, Institute of Infor-mation Theory and Automation, Pod Vodárenskou věžı́ 4, 182 00 Prague 8,Czech Republic, [email protected] (corresponding author)

    2A. Yu. Kustov, A. V. Yurchenkov and M. M. Tchaikovsky are with Insti-tute of Control Sciences, RAS, Profsoyuznaya 65, 117997 Moscow, [email protected], [email protected],[email protected]

    Problems of an insufficient disturbance attenuation of H2or excessive conservatism of H∞ can be solved by a specificcontrol design based on anisotropic control theory whichmeasures statistic disturbance uncertainty in terms of a rel-ative entropy rate. The disturbance attenuation capabilitiesof the feedback control for specific controlled system arequantified by a specific anisotropic norm [8], firstly studiedby I. G. Vladimirov [9], which represents a stochastic coun-terpart of the H∞ norm. Minimisation of such norm leadsto the control, which is less conservative and efficient in dis-turbance attenuation than H∞ and H2 norms respectively.

    The paper aims at compact introduction of specific inter-connection ways of MPC and anisotropic control (Ha con-trol). The reason for exploration of such interconnectionis to improve robustness of MPC but without increaseof computational complexity and to avoid inadequate be-haviour Ha control in an abrupt transitions of reference sig-nals, which is caused by one-ahead character of Ha control.Due to the flexibility of MPC design, the Ha control maybe incorporated as a robust reference control or as a spe-cific disturbance attenuation component in the MPC design.The basic properties of MPC and Ha control in motion con-trol were described in [10]. The control proposed here willbe demonstrated with a dynamic model of the parallel kine-matic machine, robot-manipulator, depicted in Fig. 1.

    The paper is organized as follows. In section II, there isa formulation of dual goal problem that consists in the effortto meet reference signals simultaneously with the solutionof the disturbance attenuation. Sections III, IV and V in-troduce anisotropic control and anisotropic estimation. Sec-tion VI deals with MPC design concept and its modificationsusing reference anisotropic control. Section VII demonstratesproposed control ways by simulation examples. Finally, sec-tion VIII summarizes the proposed ways and their practicaluse in motion control.

    Fig. 1. Over-actuated planar parallel kinematic machine [11].

    2020 European Control Conference (ECC)May 12-15, 2020. Saint Petersburg, Russia

    Copyright ©2020 EUCA 1111

  • II. DUAL GOAL PROBLEMLet us consider the control task formulated as a dual goal

    problem. Specifically, the meeting desired reference trajec-tories and the disturbance attenuation in the state, usedin control design, should be ensured simultaneously. Thisproblem can be solved starting with the tracking controlalong a given reference trajectory, and then using the dis-turbance attenuation via a specific state estimation.

    In this paper, the model is considered as general discretelinear-like state-space model (simplifying notation: A(x∗k)→Ak, B(x∗k)→ Bk, considering ideal deterministic state x∗k )

    x∗k+1 = Ak x∗k +Bk ur, k

    z∗k = Cz x∗k +Dzr rk +Dzu ur, k

    y∗k = C x∗k

    (1)

    where Ak, Bk, C, y∗k, rk and ur, k are state, input and output

    matrices, and vectors of system outputs, reference inputsand control actions (system control inputs) respectively. Notethat the matrices are obtained, in case of robotic systems,e.g. by specific decompositions of nonlinear dynamic modelsbased on mathematical-physical analysis [12], [13]. Finally,Cz , Dzr and Dzu and z∗k are matrices of controlled out-put, reference and input and vector of controlled outputsrespectively. The vector of control actions ur, k correspondsto the required vector z∗k .

    In the real environment, a corrective control ua, k shouldbe considered to minimise the effects of the disturbancesto the output deviation. Then, the system with a real stochas-tic state xk can be generally defined as follows

    xk+1 = Ak xk +Bw wk +Bk uk

    zk = Cz xk +Dzw wk +Dzuuk

    + Dzr rk

    yk = C xk +Dywwk, uk = f(ur, k, ua, k)

    (2)

    III. BASIC ANISOTROPIC CONTROL LAWA control task of the robot motion can be specified such

    that a given robot should perform the desired user motiontrajectories represented by reference signals. The trackingof the reference signals is provided by a controller that takesinto account feedback from the system, reference signalsand the available mathematical model in the real (stochastic)environment. A suitable controller set can generally be ex-pressed as follows

    uHa, k = f(ur, k, ua, k) = KxHaxk +KrHark (3)

    To describe the whole closed-loop system, let us considerthe following matrix transfer function

    Tzw(z) = C(zI −A)−1B + D (4)

    that will be used in further explanation. It representsthe closed-loop system from the external disturbance inputW to the controlled output Z. Involved matrices in (4) aredefined by the following way[

    A B

    C D

    ]=

    [Ã+ B̃K B̃x

    C̃z +DzuK 0

    ](5)

    Individual submatrices arise from the generalized state-space model description (2) with parameters in the contextof the motion control. They are defined as follows

    Ã :=

    [A 00 Imr

    ], B̃w :=

    [Bw0

    ], B̃ :=

    [B0

    ],

    C̃z :=[Cz Dzr

    ], C̃ :=

    [C 0

    ](6)

    where means Ak → A and Bk → B and K := [Kx Kr ]represents the gain with respect to the control law (3) [10].

    IV. ANISOTROPIC CONTROL (DUAL PROBLEM)At first, let us define deviation system:xk+1 − x∗k+1= δxk+1 = A δxk +Bw wk +Bua,kzk − z∗k = δzk = Czδxk +Dzwwk +Dzuua,kyk − y∗k = δyk = C δxk +Dywwk

    ek = Ceδxk +Dewwk +Deuua,k

    (7)

    Thus, a linear discrete time invariant system (LDTI), validfor specific time interval, is considered: A(xk) ' A(x∗k)→Ak → A and B(xk) ' B(x∗k)→ Bk → B. Here, k denotesthe discrete time instances, k = 0, 1, . . . , N ; xk denotesthe Rnx -valued state; wk denotes the Rmw -valued inputdisturbances (more on this later); ua,k denotes the Rmu -valued control input; zk denotes the Rpz -valued controlledoutput; ek denotes the Rpe -valued output to be estimated;yk denotes the Rpy -valued measurements. All the matricesare known and have appropriate dimensions. In addition, wesuppose that the input disturbances wk are random direc-tionally generic vectors, i.e. P(wk = 0) = 0 ∀ k; moreover,the finite fragment w0, w1, . . . , wN of the sequence {wk}k>0forms the extended vector W0:N = (w

    T0 , . . . , w

    TN )

    T whichis supposed to be square integrable vector distributed abso-lutely continuously with respect to l-dimensional Lebesguemeasure mesl where l = mw(N + 1), i.e. W0:N ∈ Ll2.The simple, yet pretty fair way one can treat the vector W0:Nis to assume that it is a Gaussian distributed random vectorwith zero mean and nonsingular covariance matrix. Finally,we assume for this vector that the inequality A(W0:N ) ≤ ais fulfilled with some number a > 0.

    The first (control) problem is to find the unknown matricesAc, Bc, Cc, Dc of the control law{

    ξk+1 = Ac ξk + Bc δyk, ξ0 = 0

    ua, k = Cc ξk + Dc δyk(8)

    in order to minimise the upper bound γc of anisotropic normof the input-to-output matrix of the corresponding closedloop system

    δxk+1 = Axxδxk + Axξξk + Bxwk, δx0 = 0

    ξk+1 = Aξxδxk + Aξξξk + Bξwk, ξ0 = 0

    δzk = Czxδxk + Czξξk + Dzwk

    (9)

    i.e. to ensure |||F ccl|||a ≤ γc → min. Here, Axx = A+BDcC ,Axξ = BCc, Aξx = BcC , Aξξ = Ac, Bx = Bw+BDcDyw,Bξ = BcDyw, Czx = Cz +DzuDcC , Czξ = DzuCc, Dz =Dzw +DzuDcDyw.

    1112

  • The details of the dynamical output feedback controllerdesign can be found in [14, Theorem 2], the similar onefor static output controller is described in [15]. Althoughthe design has been done for time invariant systems on in-finite time horizon, the same can be obtained for the caseunder the study. It leads to the following convex optimisationproblem:

    γ2c → minη,γ2c ,Φ,X,Y,A,B,C,D

    subject to (10)

    X � 0, Y � 0, η > γ2c ,(det Φ)1/mw > e2a/l(η − γ2c ),

    [X ∗Inx Y

    ]� 0,

    ηImw − Φ ∗ ∗ ∗

    Bw +BDDyw Y ∗ ∗XB1 + BDyw Inx X ∗D1 +DzuDDyw 0 0 Ipz

    � 0,

    Y ∗ ∗ ∗ ∗ ∗Inx X ∗ ∗ ∗ ∗0 0 ηImw ∗ ∗ ∗

    AY+BC A+BDC Bw+BDDyw Y ∗ ∗A XA+BC XB1+BDyw Inx X ∗

    CzY+DzuC Cz+DzuDDyw Dzw+DzuDDyw 0 0 Ipz

    �0where unknown matrices A, B, C, D contain the controllermatrices.

    If the solution of the problem (10) is feasible, then the con-troller is to be set according to the expression[

    Ac BcCc Dc

    ]=

    [U−1 0

    0 Ipy

    ] [Π1 Π2Π3 Π4

    ] [V −T 0

    0 Ipy

    ](11)

    where Π4 = D, Π3 = C−DcC3Y , Π2 = B−XBDc, Π1 =A−UBcCY −XBCcV T−X(A+BDcC )Y . NonsingularRnx×nx -valued matrices U and V can be chosen arbitrarilybut the equality V UT = Inx − Y X has to be fulfilled.

    Once the controller has been found, the estimation prob-lem can be stated as follows.

    V. ANISOTROPIC ESTIMATION (DUAL PROBLEM)Given the dynamic part of the system (9) and additional

    output ek from the system (7)δxk+1 = Axxδxk + Axξξk + Bxwk, δxk = 0

    ξk+1 = Aξxδxk + Aξξξk + Bξwk, ξk = 0

    ek = Cexδxk + Ceξξk + Dewk

    (12)

    where Cex = Ce +DeuDc C , Ceξ = DeuCc, De = Dew +DeuDcDyw, the estimation problem is to find the matricesH , G of the estimatorδ̂xk+1 =Axxδ̂xk +Axξξk+H(yk − Cδ̂xk), δ̂x0 = 0êk = Cexδ̂xk + Ceξξk +G(yk − Cδ̂xk) (13)in order to minimise the upper bound γe of anisotropicnorm of the input-to-output matrix of the corresponding errorsystem {

    δ̃xk+1 = Aδ̃xk + Bwk, δ̃x0 = 0ẽk = Cδ̃xk +Dwk

    (14)

    i.e. to ensure |||F ecl|||a ≤ γe → min. Here, δ̃xk = δxk− δ̂xk isthe state estimation error, ẽk = ek − êk is output estimationerror, and matrices A, B, C, D are defined as follows: A =Axx − HC3, B = Bx − HDyw, C = Cex − GC and D =De −GDyw.

    A convex optimization approach was considered to solvethe filtration problem, e.g. in [16], [17]. The anisotropybased bounded real lemma guaranties that if exist posi-tive defined matrices R, S and L and scalar parameterq ∈

    [0, ‖F ecl‖

    −2∞

    )satisfying

    R � ATRA + qCTC + LTS−1L (15)

    S =(Imw − qD

    TD − qBTRB)−1

    (16)

    L = S(BTRA+ qDTC

    )(17)

    ln detS−1 ≥ 2a+ l ln(1− qγ2e ) (18)

    then anisotropic norm is bounded by γe. To reduce the filtra-tion problem to convex optimisation problem, let us definenew matrix variable Ψ � 0 and change variables as follows:ζ = q−1 � 0, R = ζR. It allows to avoid nonlinearityin (15) - (18) after applying Schur complement formula.The final inequalities receive the following form:

    R ∗ ∗ ∗0 ζImw ∗ ∗

    RAxx −XC −RBx + XD1 R ∗C −D 0 Ipe

    � 0, (19) ζImw −Ψ ∗ ∗RBx −XDyw R ∗

    D 0 Ipe

    � 0, (20)

    (det Ψ)1/mw > e2a/l(ζ − γ2e ), (21)

    where X = RH , matrices R, Ψ are positive definiteand inequality ζ−γ2e > 0 holds true. The convex optimisationfiltering problem takes the following form:

    γ2e → minζ,γ2e ,R,Ψ,X ,G,H

    (22)

    under conditions (19) - (21). After solving the system of con-vex inequalities, the matrix H in (13) is defined accordinglythe inverse change of variable H = R−1X .

    VI. MODIFICATION OF MPC DESIGNBY Ha CONTROL

    This section introduces two ways how to take advantagesof multi-step property of online MPC and robustness prop-erty of one-off Ha control designs. The first one considersusual MPC design with disturbance attenuation complementby Ha control and the second way takes Ha control lawincluding reference directly into multi-step MPC design.

    1113

  • A. MPC with Anisotropic Disturbance Attenuation

    MPC design [1] represents multi-step control concept thatcan be performed online. Optimisation of control actionstakes into account future reference signals and varyingstate-space matrices that can respect e.g. nonlinear dynam-ics of industrial robots [18]. The optimisation is performedwithin a finite time horizon ahead. In each discrete time in-stant, a specific quadratic function is minimised consideringregularly updated equations of predictions. These equationsexpress future outputs in relation to searched control actions.

    Let us start with brief overview of MPC design suitablefor its interconnection with Ha control that serves for dis-turbance attenuation only. MPC design shapes the controlactions with respect to reference signals, i.e. it representspowerful feed-forward and complementary feed-back part.Specifically, the quadratic cost function is defined as follows

    J =

    N∑j=1

    {||Qyr(ŷk+j − rk+j)||22 + ||Quur, k+j−1||22

    }= ||QY R(Ŷk+1 −Rk+1)||22 + ||QUUr, k||22 (23)

    where predictions Ŷk+1 with respect to unknown controlactions Ur, k are the following

    Ŷk+1 = [ ŷTk+1, · · ·, ŷTk+N ]T = Fx̂k +GUr, k (24)

    F =

    CA

    ...CAN−1

    CAN

    , G =CB 0 · · · 0

    .... . . . . .

    ...CAN−2B · · · CB 0CAN−1B · · · CAB CB

    (25)Rk+1 = [ r

    Tk+1, · · ·, rTk+N ]T (26)

    Ur, k = [uTr, k, · · ·, uTr, k+N−1]T (27)

    and QY R and QU represent square-roots of weights – controlparameters, selected e.g. as diagonal matrices with identicalscalar parameters relating to Y , R and U in the cost function(23), respectively.

    Then, according to [10], a deterministic part of controlactions for prediction horizon N can usually be given as fol-lows

    ur, k = M Ur, k = M(GTQTY RQY RG +Q

    TUQU

    )−1×GTQTY RQY R (Rk+1 − Fx̂k) (28)

    where matrix M is defined as follows

    M = [Imu, 0mu, · · · , 0mu] (29)

    and it serves for selection of appropriate control actionsin relation to the corresponding discrete time instant k.

    Sequentially, the resultant control law is given as follows

    uk = ur, k + ua, k (30)

    where ur, k is given by (28) and ua, k by (8). This modifica-tion represents fixed interconnection of MPC and Ha controlfor reference tracking and attenuation problem, respectively.

    B. Modified MPC Design with Reference Ha ControlThis subsection introduces a specific modification of MPC

    design as an extension of the cost function by one additionalterm including weighted difference between computed MPCcontrol actions and robust reference actions from off-lineHa control design. Such a modification enables user tun-ing proximity of MPC actions towards Ha control actionsfollowing from the control law (3). This ideas is propa-gated through the cost function or equations of predictionsrespectively. Hence, the quadratic cost function is expressedin compliance with this tuning as follows

    J =

    N∑j=1

    {||Qyr(ŷk+j − rk+j)||22

    + ||Q∆u(uk+j−1 − uHa, k+j−1)||22

    + ||Quuk+j−1||22}

    = ||QY R(Ŷk+1 −Rk+1)||22+ ||Q∆U (Uk −KXHa X̂k −KRHa Rk)||22+ ||QUUk||22 (31)

    whereX̂k = [x̂

    Tk , · · ·, x̂Tk+N−1]T (32)

    Rk = [rTk , · · ·, rTk+N−1]T (33)

    KXHa X̂k = L x̂k +MUk (34)

    L =

    KxHaI

    ...KxHaA

    N−2

    KxHaAN−1

    , M=

    0 0 · · · 0...

    . . . . . ....

    CAN−2B · · · CB 0CAN−1B · · · CAB CB

    (35)This quadratic cost function can be written as a product of itssquare-roots:

    J = JT J (36)

    where square-root J of the cost function J is as follows

    J =

    QY R 0 00 Q∆U 00 0 QU

    Ŷk+1 −Rk+1Uk −KXHaX̂k −KRHaRkUk

    =

    QY RFx̂k +QY RGUk −QY RRk+1Q∆U (I −M)Uk −Q∆U L x̂k −Q∆U KRHa RkQUUk

    (37)Considering minimisation of the square-root J as a specific

    solution of least-squares problem [19] then, let us take intoaccount the following algebraic equation: QY R GQ∆U (I −M)

    QU

    Uk = QY R (Rk+1 − Fx̂k)Q∆U (KRHaRk + L x̂k)

    0

    (38)or QY R G QY R (Rk+1 − Fx̂k)Q∆U (I −M) Q∆U (KRHaRk + L x̂k)

    QU 0

    [Uk−I]

    = 0(39)

    1114

  • Fig. 2. Time histories [s] of errors of system outputs and realized control actions for H2, H∞ and Ha controls.

    MPC

    Fig. 3. Time histories [s] of errors of system outputs and control actions for conventional MPC.

    tuned

    Fig. 4. Time histories [s] of errors of system outputs and control actions for tuned MPC [10].

    Fig. 5. Time histories [s] of errors of system outputs and control actions for proposed interconnection of MPC and Ha control.

    1115

  • The over-determined system (38) or (39) respectively can bewritten in condensed general form (40). It can be transformedto another form (41) by orthogonal-triangular decomposition[20] and solved for unknown Uk

    AUk = b (40)

    QTAUk = QT b assuming that A = Q R

    R1Uk = c1 (41)

    where QT is an orthogonal matrix that transforms ma-trix A into upper triangle R1 as it is indicated by the fol-lowing equation diagram

    A Uk = b

    @@@@

    R1

    0

    Uk = c1

    cz

    (42)

    Vector cz represents a loss vector, Euclidean norm ||cz||of which equals to the square-root of the optimal cost func-tion minimum, i.e. scalar value

    √J , where J = cTz cz . Only

    the first elements corresponding to uk are used from com-puted vector Uk, i.e. uk = MUk = M×f(Ur, k, UHa, k),where matrix M is defined as in previous subsection by (29).

    VII. SIMULATIONS

    Simulations in Fig. 2 – Fig. 5 demonstrate behavior of indi-vidual control approaches H2, H∞, Ha, conventional MPC,tuned MPC and proposed interconnection: modified MPCwith reference Ha control. All these control approaches wereapplied to the model of the robot shown in Fig. 1, consideringreference motion trajectory depicted in Fig. 6.

    The differences both in control errors and in controlactions are noticeable for all shown control approaches.The proposed interconnection depicted in Fig. 5 reachesthe smallest control actions at the smoothest trends of controlactions. The abrupt increase in errors and in control actionchattering is caused by artificial increase in disturbancesignal, see Fig. 7.

    drive 1

    drive 2

    drive 3

    drive 4movableplatform

    -0.3 -0.2 -0.1 0 0.1 0.2 0.3 [m]

    [m]

    0.3

    0.2

    0.1

    0

    -0.1

    -0.2

    -0.3

    [m]

    0.04

    0.02

    0

    -0.02

    -0.04

    -0.04 -0.02 0 0.02 0.04 [m]

    turningpointvt = 0

    turningpointvt = 0

    initial, final pointsvt = 0running pointvt 0

    1s

    2s

    3s

    4s

    5s6s

    7s

    0s

    Fig. 6. Wireframe robot model, testing ’S’-shape trajectory.

    Fig. 7. Time histories [s] of the disturbance signals wk .

    VIII. CONCLUSION

    The paper introduces the novel promising interconnectionof online flexible multi-step MPC design for reference signaltracking and off-line robust Ha control for disturbance atten-uation. State-space estimation based on anisotropic theoryis explained as well. The complexity of the design or com-putation is reasonable for real-time use and does not increasecompared to the individual design approaches used.

    REFERENCES[1] A. Ordis and D. Clarke, “A state-space description for GPC con-

    trollers,” Int. J. Systems SCI., vol. 24, no. 9, pp. 1727–1744, 1993.[2] J. Maciejowski, Predictive Control & Contraints. Prentice Hall, 2002.[3] K. Belda and D. Vošmik, “Explicit GPC of speed and pos. of PMSM

    drives,” IEEE Ind. Electron., vol. 63, no. 6, pp. 3889–3896, 2016.[4] K. Belda and L. Pavelková, “Online tuned model predict. control

    for robotics sys. with bounded noise,” in Proc. of the 22nd IEEE Int.Conf. Methods and Models in Autom. & Robotics, 2017, pp. 694–699.

    [5] K. Zhou, J. Doyle, and K. Glover, Robust and Optimal Control, 1996.[6] J. Doyle, K. Glover, P. Khargonekar, and B. Francis, “State-space

    solutions to standard H2 and H∞ control problems,” IEEE Trans.AC, vol. 34, pp. 831–847, 1989.

    [7] M. Zeilinger, M. Morari, and C. Jones, “Soft constr. MPC with robuststab. guarant.” IEEE Trans. AC, vol. 59, no. 5, pp. 1190–1202, 2014.

    [8] I. G. Vladimirov, P. Diamond, and P. Kloeden, “Anisotropy-basedperformance analysis of finite horizon linear discrete time varyingsystems,” Autom. and Remote Control, vol. 8, pp. 1265–1282, 2006.

    [9] I. G. Vladimirov, A. P. Kurdyukov, and A. V. Semyonov, “State-spacesolution to anisotropy-based stochastic H∞-optimization problem,”in Proc. of IFAC Congress, vol. 29, no. 1, 1996, pp. 3816–3821.[Online]. Available: https://doi.org/10.1016/S1474-6670(17)58274-9

    [10] K. Belda and M. M. Tchaikovsky, “Predictive and anisotropic controldesign for robot motion under stochastic disturbances,” in Proc.of the 17th European Control Conference, 2019, pp. 1374–1379.

    [11] K. Belda, “Robotic device, Ct. 301781 CZ, Ind. Prop. Office,” 2010.[12] K. Belda and V. Záda, “Predictive control for offset-free motion of

    industrial articulated robots,” in Proc. of the 22nd IEEE Int. Conf.Methods and Models in Autom. and Robotics, 2017, pp. 688–693.

    [13] K. Belda, “On-line parameter tuning of model predictive control,” inProc. of the 18th IFAC World Congress, 2011, pp. 5489–5494.

    [14] M. M. Tchaikovsky, A. P. Kurdyukov, and V. N. Timin, “Synthesisof anisotropic suboptimal controllers by convex optimization.”CoRR, vol. abs/1108.4982, pp. 1–38, 2011. [Online]. Available:http://arxiv.org/abs/1108.4982

    [15] M. M. Tchaikovsky, “Static output feedback anisotropic control designby LMI-based app.” in American Cont. Conf., 2012, pp. 5208–5213.

    [16] V. N. Timin, M. M. Tchaikovsky, and A. P. Kurdyukov, “A solutionto anisotropic suboptimal filtering problem by convex optimization,”Doklady Mathematics, vol. 85, no. 3, pp. 443–445, 2012.

    [17] M. M. Tchaikovsky, V. N. Timin, A. Y. Kustov, and A. P. Kurdyukov,“Numerical procedures for anisotropic analysis of time-invariant sys-tems and synthesis of suboptimal anisotropic controllers and filters,”Autom. and Remote Control, vol. 79, no. 1, pp. 128–144, 2018.

    [18] K. Belda, J. Böhm, and P. Pisa, “Concepts of model-based control andtrajectory planning for parallel robots,” in Proc. of 13th IASTED Int.Conf. on Robotics and Applications, 2007, pp. 15–20.

    [19] C. Lawson and R. Hanson, Solving least squares problems.Siam,1995.[20] H. Golub and G. Van, Matrix computation, London, UK, 1989.

    1116