<!DOCTYPE article PUBLIC "-//NLM//DTD JATS (Z39.96) Journal Archiving and Interchange DTD v1.0 20120330//EN" "JATS-archivearticle1.dtd">
<article xmlns:xlink="http://www.w3.org/1999/xlink">
  <front>
    <journal-meta />
    <article-meta>
      <title-group>
        <article-title>Synthesis of Optimal Discrete Controller for Robotic Vibroprotective System Control</article-title>
      </title-group>
      <contrib-group>
        <contrib contrib-type="author">
          <string-name>Belgorod</string-name>
          <xref ref-type="aff" rid="aff0">0</xref>
        </contrib>
        <contrib contrib-type="author">
          <string-name>Russia rl bgtu@intbel.ru</string-name>
          <email>bgtu@intbel.ru</email>
          <xref ref-type="aff" rid="aff0">0</xref>
        </contrib>
        <aff id="aff0">
          <label>0</label>
          <institution>Elena Gaponenko BSTU named after V. G. Shoukhov Kostyukov str.</institution>
          <addr-line>46, 308012 Belgorod, Russia Viktoria Kuzmina BSTU named after V. G. Shoukhov Kostyukov str. 46, 308012 Belgorod</addr-line>
          ,
          <country>Russia rl</country>
        </aff>
      </contrib-group>
      <fpage>489</fpage>
      <lpage>496</lpage>
      <abstract>
        <p>The article deals with the problem of constructing an optimal controller of an active vibration protection system under the action of low-frequency disturbances from the moving base. The relative movement of the object and the base, the accelerations of the object and the base are used as feedbacks. The problem is solved in a discrete domain, the controller is synthesized as multiply connected.The feedback coefficients of the stabilizing controller are obtained on the basis of the solution of the discrete Riccati equation. As a criterion of quality, the integral of the quadratic forms of control variables and control action is used. The possibility of using the observer of the system state to obtain an estimate of the absolute velocity of the object is considered. The observer works on a closed basis. The results of simulation modeling under the action of harmonic oscillations and \white noise" are presented. The results of the observer's work are presented.</p>
      </abstract>
    </article-meta>
  </front>
  <body>
    <sec id="sec-1">
      <title>Introduction</title>
      <p>The problem of protection from vibration is very relevant at the present time. Medical research shows that
elevated levels of vibration have an extremely unfavorable effect on operators of transport-technological equipment,
expressed in changing the functional state of the body, efficiency reducing and morbidity increasing. Areas of
frequencies are known in which vibration levels can affect the performance of production operations. The intensity
of the vibration that causes the marked phenomena depends on the structure of the object, its mass, duration of
exposure. The action of any vibration-proof device can be reduced to the formation of additional dynamic effects
that provide the necessary change in the vibrational eld. In this sense, the task of vibration protection can
be considered as a task of controlling the movement of a protected mechanical system, and dynamic in uences
that cause the corresponding change in parameters - as control actions. This interpretation of the role of the
vibration protection device is convenient for setting and solving various tasks of vibration protection; It allows
the use of the theory of automatic control for the analysis and synthesis of vibration protection systems.
2</p>
    </sec>
    <sec id="sec-2">
      <title>Synthesis of the Optimal Regulator</title>
      <p>Consider the scheme of the active system of vibration isolation, shown in Fig. 1.</p>
      <p>The system contains sensors, control ampli ers and actuators. As sensitive elements, sensors are used that
record the kinematic parameters of the object - displacement, velocity, acceleration. The signals from the sensors
characterize the quality of the vibration protection and are used to generate the control signals carried out by
the elements of the feedback loop. After ampli cation, the signals are fed to the actuator creating the control
action. Let us consider the problem of synthesis of optimal control using the example of a system with an
electromechanical actuator with a \screw-nut" pair. To describe this entire system, including the actuator, in
state space using the models obtained in [Rybak et al., 2014]. Given that z = x y, add in another equation in
the variable z, while also are conducting three state variables: x1 = x_ , x2 = z, x3 = IA.We obtain the following
system of equations:</p>
      <p>Or in vector-matrix form
8&gt;x_ 1 = Jr+m r1 r2</p>
      <p>kem r1
&lt;</p>
      <p>x_ 2 = x1 y_;
&gt;:x_ 3 =</p>
      <p>x3 + y;
kem
r1 L
x1</p>
      <p>R
L
x3 + L1
u + rk1emL</p>
      <p>y_</p>
      <p>X_ = AX + Bu + GY</p>
      <p>The system of equations (2) fully describes the behavior of the system with an electromechanical actuator
with the transmission of a \screw-nut" under the in uence of perturbing and control actions. Each particular
model of the electric motor corresponds to the matrix of the coefficients A, B input and the disturbance in uence
coefficient G. The problem of synthesis of an optimal regulator will be solved in a discrete domain, for which
the system of equations (2) is transformed into a discrete form. As a result, we obtain a system of equations.</p>
      <p>X [i + 1] = A∆X [i] + B∆u [i] + G∆Y [i];
[1 0 0]
where D = 0 1 0
of quality will take the integral of quadratic forms of controlled variables and manipulated species:
is the matrix of communications coordinates state and controlled variables. As a criterion
1
∫
0
J =
(q1 z12(t) + q2 z22(t) + r u2(t))dt ! min
(4)
(5)
(6)
(7)
(8)
(9)
where q1,q2,r are the weighting coefficients of the squares of the two controlled variables and manipulated
respectively, that characterize the contribution of each term in the criterion function. The weights should be
chosen empirically, based on the results of mathematical modeling. For discrete systems criterion function (6)
in the form:</p>
      <p>J =
1
∑(XT [i]DT
i=0</p>
      <p>Q D</p>
      <p>X [i] + r u [i]) ! min
where Q = [q01 q02] is the matrix of weighting factors under controlled variables. Thus, we have formulated
the task of management is to minimize the amplitude of the movement speed of the object (and hence the
amplitude of its acceleration) and to limit the level of movement of the object relative to the base, thus limiting
the available-resource management. Feedback gain matrix is given by</p>
      <p>F = (r + BT∆</p>
      <p>P</p>
      <p>B∆) 1</p>
      <p>BT∆</p>
      <p>P</p>
      <p>A∆;
T is entered to designate the sampling period. Because of the high complexity of mathematical calculations is
not appropriate to display the general form of matrices A∆ and B∆. Preferred to calculate the matrix A∆ B∆
in numerical form for each speci c pair of matrices A and B. Next, to simplify the entries, we return to the
notation without indices:A = A∆;B = B∆. We de ne the structure of the optimal discrete regulator in the form
of a matrix relation
where F = [f1 f2 f3] is the matrix of coefficients of feedbacks on state variables. In fact, the optimal controller
acts as a feedback on the state of the system[Rybak et al., 2016]. In order to solve the optimal control problem
of synthesis will form a vector Z of controlled variables
where P is a positive de nite square auxiliary matrix with dimension 3
Riccati equation</p>
      <sec id="sec-2-1">
        <title>3. The matrix P satis es the discrete</title>
        <p>P = DT</p>
        <p>Q</p>
        <p>D + AT∆</p>
        <p>P</p>
        <p>A∆</p>
        <p>AT∆</p>
        <p>P</p>
        <p>B∆(r + BT∆</p>
        <p>P</p>
        <p>B∆) 1</p>
        <p>BT∆</p>
        <p>P</p>
        <p>A∆
This equation has a solution if the pair (A, B) is completely controllable. Let us investigate the controllability
of the system for the continuous case (2). To do this, we form the matrix of control W</p>
        <p>According to the Kalman theorem on controllability, the system is completely controllable if rank(W) = n,
where n is the order of the system. In our case rank(W) = 3 , Hence the system is completely controllable.
Equation (9) has a unique positive de nite solution in the form of a symmetric matrix P, and such optimal
closedloop system is certainly stable, since all eigenvalues (A BF) modulo less than one. In order not to depend
on factors in uencing the convergence of the solution, we will use a method that is based on the de nition of
eigenvalues and matrix vectors and is performed in the following sequence: 1. First we nd the Hamiltonian of
dimension 2n 2n. In the particular case of regular matrix A (with a continuous sampling of the system it is
guaranteed that this matrix is nonsingular) form the Hamiltonian matrix H by the expression
H =
[A + Br 1BT (AT ) 1DT QD
(AT ) 1DT QD</p>
        <p>Br 1BT (AT ) 1]
(AT ) 1
Next, we nd all the eigenvalues of the matrix H, satisfying the equation</p>
        <p>IA =</p>
        <p>Jr + m r1 r2
kem r1
x</p>
        <p>Jr + m r1 r2
kem r1
y
Then the control law of the optimal regulator (14) takes the form
where i is the one of the eigenvalues of the matrix H,[ i] is the eigenvector corresponding to a given eigenvalue.</p>
        <p>i
2. Among the obtained eigenvalues f 1; 2; :::; 2ng, obviously, there are those whose absolute values are less
than one, and the corresponding eigenvectors (assuming their independence) can be written as
where i, i is the column vectors dimension n
less than one, because if i is own a number, and
1. Guaranteed there are n eigenvalues with absolute value
[ 1 ]</p>
        <p>is also an eigenvalue. 3. P values found from the
i
expression P = [ 1j 2j:::j n] [ 1j 2j:::j n] 1. Hence it is not difficult to calculate the optimal feedback coefficients
in expression (4). Thus, we obtain the control law of the optimal regulator in the form of feedback on the state
of the system
{u [i] ; ju [i]j
where Umax is maximum allowable applied voltage of the DC motor. Fig. 2 is a block diagram of a vibration
protection system with an optimal regulator, taking into account the control law (16), as well as constraints on
the control action, in which the absolute value of the voltage at the motor armature can not exceed the maximum
permissible value.
(17)
(18)
(19)</p>
        <p>For modeling we use a DC electric motor 2PN-90MU4 and synthesize the optimal regulator for a system with
this engine model and the \screw-nut" transmission. The mass of the object of stabilization is assumed m=100
Kg. Going to the discrete task, taking the sampling period T=0.01s, to obtain the following matrix A∆ and B∆
of equation (3):
2</p>
        <p>0:967
A∆ = 49:879 10 3
27:498</p>
      </sec>
      <sec id="sec-2-2">
        <title>We set the following weighting factors:</title>
        <p>[1 0]
Q = 0 1</p>
        <p>; r = 10 6:</p>
        <p>After the procedure for nding the feedback coefficients of the optimal controller described by equations (8),
(11) - (13), a matrix of feedback coefficients is obtained F = [560:960 603:156 0:927], for which mathematical
modeling is performed. As a disturbing action from the base, a signal having the spectral characteristic shown
in Fig. 3 and characteristic peaks at frequencies of 1.5; 3; 5; 8 Hz and a muffled noise background at other
frequencies.</p>
        <p>As a result of the simulation, the spectral characteristic of the resulting acceleration at the object is obtained,
Fig. 4. Comparing the two characteristics, it can be seen that the characteristic peaks at 1.5 and 3 Hz were
almost completely damped. The peaks at frequencies of 5 and 8 Hz also signi cantly decreased. This result
clearly demonstrates the effectiveness of the system with an electromechanical actuator and an optimal regulator
in suppressing perturbations of a complex species.
3</p>
      </sec>
    </sec>
    <sec id="sec-3">
      <title>Synthesis of the Observer of States</title>
      <p>Let us consider the possibility of using the observer of the state coordinates to obtain the magnitude of the
absolute velocity of the object x_ . This option has some advantages over direct integration of acceleration at the
site x, the main of which is higher noise immunity [Fedosov et al., 2000]. Consider the principle of constructing
an observing device. Let the controlled system be described by a vector equation</p>
      <p>To estimate the vector of state variables X, construct observing apparatus according to the equation
X_ = AX + Bu:</p>
      <p>X^_ = AX^ + Bu:</p>
      <p>In this case, setting the manipulated variable u on the system and the monitored device, the output of the
observer will have an accurate estimate X^ system state variables X (20). The proposed calculator works by an
open loop, and in real conditions, in the presence of unaccounted perturbations and an inaccurate speci cation
of the initial condition X^ (0) the values of the estimate and the vector of the state variables will diverge with
time[Tro mov et al., 1997].To compensate for this discrepancy construct observing device according to the
principle of a closed, using the measurement results Y part coordinates state vector X from the sensors according to
the equation Image The difference between the measuring vector estimate Y and measurement Y^ = CX^ we use
to improve the observer. For this purpose, monitored devices (21) introduce the feedback matrix K. We obtain
a closed observing device, described by equation X^_ = AX^ + Bu + K(Y CX^ ), called the Lewinberger observer.
Matrix K can be assigned arbitrarily, for example so as to provide stability and the observer damping transients
in the observing device for the desired time. Closed observer typically has two inputs: u - Effects on the control
and Y - from the measurements obtained from the sensors. Note that in our problem, it makes no sense to build
a complete observer of all state coordinates. Instead, a simpli ed system of differential equations
where 3 coordinates of state x1 = x_ , x2 = z, x3 = y_. In vector-matrix form the system (22) takes the form
8&gt;x_ 1 = x;
&lt;
where X^ is the vector coordinate the state observer; A^ is the matrix of observer coefficients; M is the vector
of the values measured by the sensors; H is the matrix of the coefficients of the measured quantities. We will
compose the observer's equation (24).</p>
      <p>X^_ = A^ X^ + HM + K(z</p>
      <p>C^ X^ );
where C^ = [0 1 0] is the matrix of the choice of the corrected value; K^ = [k1 k2 k3]T is a correction
matrix. The estimation of the absolute velocity of the object is given by the equation of the observer's exit:
x^_ = CoX^ , where Co = [1 0 0] is the matrix of the observer's output. It should be noted that in such a
system, no control action is given to the observer[Mita et al., 1994]. The block diagram of the observing device
constructed according to the expression (24) is shown in Fig. 5. Symbols x and y is the noise in the acceleration
measurement channels on the object and the base, respectively.</p>
      <p>We estimate the work of the observer. For modeling we use the system considered earlier without the
introduction of a control action. The root-mean-square deviations in the acceleration measurement channels are accepted
( x) = ( y) = 0:5. To nd the coefficients of the correction matrix K using coordinate descent procedure.
During this procedure, a disturbing effect was applied to the system f = 2 Hz. As a result, a correction matrix</p>
      <p>The results of the simulation of the system with the observer (24), obtained by the correction matrix and the
disturbing effect of the frequency are shown in Fig. 6.
Acknowledgments.</p>
      <p>This work was supported by the Russian Science Foundation, the agreement number 16-19-00148.</p>
    </sec>
  </body>
  <back>
    <ref-list>
      <ref id="ref1">
        <mixed-citation>
          [Rybak et al.,
          <year>2014</year>
          ] Rybak
          <string-name>
            <given-names>L.A.</given-names>
            ,
            <surname>Cherkashin</surname>
          </string-name>
          <string-name>
            <given-names>N. N.</given-names>
            ,
            <surname>Gunkin</surname>
          </string-name>
          <string-name>
            <given-names>A.A.</given-names>
            ,
            <surname>Chichvarin</surname>
          </string-name>
          <string-name>
            <surname>A.V.</surname>
          </string-name>
          (
          <year>2014</year>
          ).
          <article-title>Simulation of electromechanical drive with a hybrid stepper motor of robotic platform. Modern problems of science and education, 6</article-title>
          , URL: https://science-education.ru/ru/article/view?id=
          <fpage>17012</fpage>
        </mixed-citation>
      </ref>
      <ref id="ref2">
        <mixed-citation>
          [Rybak et al.,
          <year>2016</year>
          ] Rybak
          <string-name>
            <given-names>L.A.</given-names>
            ,
            <surname>Getman</surname>
          </string-name>
          <string-name>
            <given-names>Y.A.</given-names>
            ,
            <surname>Shipuilov</surname>
          </string-name>
          <string-name>
            <surname>I.P.</surname>
          </string-name>
          (
          <year>2016</year>
          ).
          <article-title>Research model robot-hexapod under static and dynamik loads</article-title>
          .
          <source>Vibroengineering PROCEDIA contains papers presented at the 22-nd Internftional Conference on VIBROENGINEERING. The main theme of this Conference is \Dynamics of Strongly Nonlinear Systems"</source>
          (pp.
          <fpage>527</fpage>
          -
          <lpage>530</lpage>
          ). Moscow, Russia.
        </mixed-citation>
      </ref>
      <ref id="ref3">
        <mixed-citation>
          [Fedosov et al.,
          <year>2000</year>
          ]
          <string-name>
            <given-names>E.A.</given-names>
            <surname>Fedosov</surname>
          </string-name>
          ,
          <string-name>
            <given-names>A.A.</given-names>
            <surname>Krasovsky</surname>
          </string-name>
          ,
          <string-name>
            <given-names>E.P.</given-names>
            <surname>Popov</surname>
          </string-name>
          , etc. (
          <year>2000</year>
          ). In E.A.
          <string-name>
            <surname>Fedosov</surname>
          </string-name>
          (Ed.).
          <article-title>Mechanical engineering</article-title>
          . Encyclopedia / Ed. Advice:
          <string-name>
            <surname>K.V.</surname>
          </string-name>
          <article-title>Frolov (previous) and others</article-title>
          . Moscow: Mechanical engineering.
          <source>Automatic control. Theory. V. 1-4.</source>
        </mixed-citation>
      </ref>
      <ref id="ref4">
        <mixed-citation>
          [Tro mov et al.,
          <year>1997</year>
          ] Tro mov
          <string-name>
            <given-names>A.I.</given-names>
            ,
            <surname>Egupov</surname>
          </string-name>
          <string-name>
            <given-names>N.D.</given-names>
            ,
            <surname>Dmitriev</surname>
          </string-name>
          <string-name>
            <surname>A.N.</surname>
          </string-name>
          (
          <year>1997</year>
          ).
          <article-title>In K.A</article-title>
          .
          <string-name>
            <surname>Pupkov</surname>
          </string-name>
          (Ed.)
          <article-title>Methods of the theory of automatic control, oriented to the use of computers. Linear stationary and nonstationary models: Textbook for high schools</article-title>
          . Moscow: Energoatomizdat.
        </mixed-citation>
      </ref>
      <ref id="ref5">
        <mixed-citation>
          [Mita et al.,
          <year>1994</year>
          ]
          <string-name>
            <given-names>Mita</given-names>
            <surname>Ts</surname>
          </string-name>
          .,
          <string-name>
            <surname>Hara</surname>
            <given-names>S.</given-names>
          </string-name>
          ,
          <string-name>
            <surname>Kondo</surname>
            <given-names>R.</given-names>
          </string-name>
          (
          <year>1994</year>
          ).
          <article-title>Introduction to digital control:</article-title>
          <source>Trans. from Japanese</source>
          . Moscow: Mir.
        </mixed-citation>
      </ref>
    </ref-list>
  </back>
</article>