2014 DAN 6DOF Dynamics Control
2014 DAN 6DOF Dynamics Control
net/publication/289261796
CITATIONS READS
5 392
10 authors, including:
5 PUBLICATIONS 17 CITATIONS
Saint Petersburg State University
244 PUBLICATIONS 5,477 CITATIONS
SEE PROFILE
SEE PROFILE
Petr E. Tovstik
Saint Petersburg State University
204 PUBLICATIONS 653 CITATIONS
SEE PROFILE
Some of the authors of this publication are also working on these related projects:
14th International Conference "Dynamical Systems - Theory and Applications" (DSTA 2017) - December 11-14, 2017, Lodz, Poland View project
All content following this page was uploaded by Nikolay Vladimirovich Kuznetsov on 27 December 2017.
MECHANICS
DOI: 10.1134/S102833581409002X
St. Petersburg State University, St. Petersburg, 198504 Russia Fig. 1. Kinematics of (a) the stand and (b) the pneumatic
email: leonov@math.spbu.ru, nkuznetsov239@mail.ru cylinder.
405
406 LEONOV et al.
∑F e
0
0 · = k kt ,
ω y = ϕ· cos θ sin ψ + θ cos ψ,
k=1
0
ω z = ψ· – ϕ· sin θ, (9)
0
P ⋅ J c ⋅ P ω· + ω × ( J c ⋅ P ω ) = M
T 0 T 0 0
∑ F (a
0 0 0 0
tion. We introduce the vector of generalized coordi = k k – r c ) × e kt , rc = P ⋅ rc ,
nates determining the platform position
k=1
q = { x 0, y 0, z 0, ϕ, θ, ψ } = { q 1, q 2, q 3, q 4, q 5, q 6 }. (4) where m and Jc are the platform mass with a load and
If values (4) are set, the pneumaticcylinder lengths its tensor of inertia with respect to the point C, g is the
0
0
lk = lk(qj) and their directions e kt are determined from acceleration of gravity, r·· is the acceleration of the
point O, and Fk are the forces acting with the platform
explicit formulas
on the part of rods. As F0 and M0, we designate the
0 0 0 0
B k A k = l k = l k e kt = r + P ⋅ a k – b k , main vector of forces Fk and their main moment with
(5) respect to the point C. The set of Eqs. (9) together with
k = 1, …, 6, Eqs. (8) has the 12th order and describes the motion of
0 the platform for the set forces.
where the vectors ak = OA k and b k = O 0 B k are
shown in Fig. 1a. On the contrary, if lk are set, the val If the motion q(t) of the platform is set, the vectors F0
ues of qj are determined from six nonlinear equations and M0 become known, and the forces Fk necessary for
obtaining this motion are found from Eqs. (9), which
l k = l k ( q j ), k, j = 1, …, 6. (6) can be written in the form
T 0 T
After the differentiation of Eqs. (6) with respect to A ⋅F = Ᏺ , F = { F 1, …, F 6 } ,
time, we obtain the set of linear equations relative to (10)
0 0 0 0 0 0 0 T
0
r· , ω0, which we write in the form Ᏺ = { F x, F y , F z , M x, M y , M z } ,
0 0 0 0 0 T
where the matrix A is the same as in Eq. (7).
A ⋅ V = i, V = { x· 0, y· 0, z· 0, ω x, ω y, ω z } ,
(7)
T
l = { l 1, l 2, l 3, l 4, l 5, l 6 } , 4. NUMERICAL EXAMPLE
where the matrix A is composed of the vector lines We consider the Stewart platform, the hinges Ak
0 0 and Bk of which are symmetrically arranged on the
Ak = { e kt , P · ak × e kt }, the superscript T designates
mobile and immobile circles of the radii Ra and Rb,
transposing, and the dot is the derivative with respect
respectively, occurring in the planes Oxy and O0x0y0.
to time.
· Let the minimal distance between the upper and
After solving set (7), the derivatives ϕ· , θ , and ψ· lower hinges be d (for example, A2A3 = B1B2 = d), and
are found from the formulas the angle at the rotation through which we obtain the
0 0 former arrangement of the hinges be 2π/3 (Fig. 2). We
ω y sin ψ + ω x cos ψ · accept that the distance between the planes of the
ϕ· =
0 0
, θ = ω y cos ψ – ω x sin ψ,
cos θ (8) upper and lower hinges is h. We consider that, in the
initial position, the center of gravity C of the platform
ψ· = ω z + ϕ· sin θ,
0
and a solid fastened on it are above the centers of the
and the values of qi(t) are obtained by the integration. circles, and zc > 0.
The vanishing of the determinant of the matrix Α Let Ra = 0.7608 m, Rb = 1 m, d = 0.2 m, h = 1.0196 m,
testifies to the exit on the boundary of the controllabil zc = 0.8 m, l = 1.255 m, and mg = 104 N. We assume in
ity region. addition that the tensor of inertia of the platform is
The control forces Fc are introduced from the for We consider the effect of a delay in the control writ
mula ing Eq. (20) and introducing the constant delay τ in
the control:
F = – Gδs – G f δs· ,
c
(18)
δs··( t ) – C * ⋅ δs ( t ) + A * ⋅ ( Gδs ( t – τ ) + G f δs· ( t – τ ) )
where the constants G ≥ 0 and Gf ≥ 0 are subject to (26)
err
choice from the condition of minimization of the vec + A err ⋅ f = 0.
tor δs. The difference of Eqs. (14) and (16) gives The delay is naturally related to the time, which is nec
–1 –1 essary for the pneumatic cylinders for formation of the
B ⋅ ( A 0 ) ⋅ δs·· – C ⋅ ( A 0 ) ⋅ δs
(19) control pressure corresponding to Eq. (18).
+ A 0 ⋅ ( Gδs + G f δs· ) + f = 0.
T err
Considering the delay as small, we introduce into
Eq. (26) the expansion
2
τ
6. INVESTIGATION OF Eq. (19) δs ( t – τ ) = δs ( t ) – τδs· ( t ) + δs··( t ). (27)
2
We rewrite Eq. (19) as
Then the characteristic equation for Eq. (26) takes the
δs·· – C * ⋅ δs + A * ⋅ ( Gδs + G f δs· ) + A err ⋅ f = 0, (20)
err
form
2
where det ( λ ( E – kA * ) + λA * ( G f – τG ) + GA * – C ) = 0, (28)
2
–1
C* = A0 ⋅ B ⋅ C ⋅ ( A0 ) ,
–1 –1 T
A* = A0 ⋅ B ⋅ A0 , τ G . It suffices to fulfill three condi
where k = τGf –
(21) 2
–1
A err = A 0 ⋅ B . tions for the asymptotic stability: the previously estab
lished condition G > 0.706, the inequalities Gf > τG,
For f err = 0, the zero solution of Eq. (20) is asymp and the positive definiteness of the matrix E – kA∗.
totically stable if all roots λ the characteristic equation
The last condition is fulfilled at
2
det ( λ E – C * + A * ( G + λG f ) ) = 0 (22) 1 ,
k < (29)
have negative material parts. ρ max
The matrix C∗ is symmetric positive, and the where ρmax is the largest eigenvalue of the matrix A∗.
matrix A∗ is symmetric and positively defined. From For the parameters under consideration, ρmax = 3.956.
here at once it follows that the zero solution is unstable For the coefficient Gf, we obtain a bilateral estimate
in the absence of a control (G = Gf = 0), is stable at a τG 1
reasonably large G, and is asymptotically stable at Gf > 0. τG < G f < + . (30)
2 τρ max
We present the numerical results for the platform with
the above parameters. The lefthand side of inequality (30) is less than the
righthand side if
At G = Gf = 0, Eq. (22) has an eightfold zero root
and two pairs of roots λ = ±0.887, which points to an 2 .
G < (31)
2
instability. The stability comes at G > 0.706, and the τ ρ max
mode of undamped oscillations takes place at Gf = 0.
The last inequality imposes the restriction on the coef
Let G Ⰷ 1 and Gf ~ 1. Then the main terms in ficient G in the presence of a delay.
Eq. (19) are
T
GA 0 ⋅ δs + f
err
= 0. (23) 7. CERTAIN NUMERICAL RESULTS
We consider the dynamics of a symmetric con
From here it follows that the estimate is valid in the trolled platform with the parameters described in Sec
absence of resonances: tion 4. The effect of the delay is disregarded. We con
err sider the model of complex motion of a solid partici
f
δs ∼ , (24) pating in one translational and two rotational motions.
G As the program motion, we take
where the vector norm is determined by the relation p t p
q 1 ( t ) = a sin νt, q 5 ( t ) = a sin νt, q 6 ( t ) = a sin νt,
s = max s k ( t ) . (25) p p p (32)
t, k q 2 ( t ) = q 3 ( t ) = q 4 ( t ) = 0,
where a is the set amplitude of linear and angular According to approximate formula (24), the func
oscillations (for simplicity, we consider the amplitudes tion η(ν) decreases approximately as 1/G with increas
of linear and angular oscillations in dimensionless ing G. At G ~ 3, the accepted way of control is inappli
variables as identical). cable (a more exact set of forces Fp is required).
We integrate the set of Eqs. (14) calculating the vec The function η(ν) considerably increases with fre
tor of the program displacements sp of pistons from quency ν.
exact formulas (5) and the program forces Fp in rods As the comparison of lines 1–4 and 5–8 shows, for
from approximate set (16) in which only linear terms relatively small values of η(ν) (for example, η(ν) <
are retained. 0.5), this function depends only weakly on the ampli
We estimate the quality of the control with the rel tude a. The dependence manifests itself only in the
ative error region where the described way of control is inapplica
ble.
δq ,
η = δq = q – q ,
p
q
p
= a, (33)
p
The dependence on the parameter Gf follows from
q the comparison of line 6 with lines 9 and 10. With
where the norm of the vector is determined by Eq. (25). increasing Gf, the function η(ν) decreases, and is more
considerable for higher frequencies ν.
We investigate the quality of the control in the
dependence of the feedback parameters G and Gf on The data in Table 1 are obtained under the assump
the oscillation amplitude a of the program motion and tion that the initial conditions for the real and program
on the oscillation frequency ν ≤ 5 (in the dimensional motions coincide, i.e.,
time, the frequency is limited by 2.5 Hz). First, we
q k = 0, k = 1, …, 6, q· 1 = q· 5 = q· 6 = νa,
consider that the initial conditions for the real and (34)
program motions coincide. q· 2 = q· 3 = q· 4 = 0 for t = 0,
In Table 1 for two values of the amplitude a and five
values of the oscillation frequency ν, we listed the val while the program forces in rods are calculated by the
ues of the function of quality of the control in depen method described.
dence on the feedback parameters G and Gf. The data However, it is technically difficult to provide the
in Table 1 enable us to make the following conclusions. implementation of the nonuniform initial conditions