Научная статья на тему 'Constructing dynamic equations of constrained mechanical systems'

Constructing dynamic equations of constrained mechanical systems Текст научной статьи по специальности «Математика»

CC BY
158
42
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ДИССИПАТИВНАЯ ФУНКЦИЯ / DISSIPATIVE FORCE / ИЗБЫТОЧНЫЕ ПЕРЕМЕННЫЕ / EXCESS VARIABLES / IDEAL CONSTRAINTS / ФУНКЦИЯ ЛАГРАНЖА / LAGRANGE EQUATION / NON-IDEAL CONSTRAINTS / УСТОЙЧИВОСТЬ / STABILITY / КРИТЕРИЙ РАУСА–ГУРВИЦА / ROUTH-HURWITZ CRITERION FOR STABILITY / STATE-SPACE EQUATION / ИДЕАЛЬНЫЕ СВЯЗИ / НЕИДЕАЛЬНЫЕ СВЯЗИ / ПРОСТРАНСТВО СОСТОЯНИЙ

Аннотация научной статьи по математике, автор научной работы — Deressa Chernet Tuge

In this paper constructing equation of mechanical systems based on their kinetic energy, potential energy and dissipative force is discussed. Both the holonomic and non-holonomic constraints are considered. Equations of constraint forces resulting from ideal and non-ideal nature of the constraints are developed.It is shown that, the constraint force is a sum of two forces resulting from the ideal and non-ideal nature of the constraints. An explicit equation of the acceleration of the system is developed basing on the constraint forces from the nature of the constraints. For investigating the deviation of the system from the trajectory of the constraint equations, excess variables are included in the equations of the constraints. The stability of the system is based on determining the sign of constants emerging from developing the Lagrange’s equation of motion for the constraints. The determination of the sign of the constants is made based on Routh-Hurwitz Criterion for Stability. An example is used to demonstrate each of the equations developed in the paper and constructing state-space equation of the system.

i Надоели баннеры? Вы всегда можете отключить рекламу.
iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

Текст научной работы на тему «Constructing dynamic equations of constrained mechanical systems»

UDC 531.3

Constructing Dynamic Equations of Constrained Mechanical

Systems

Chernet Tuge Deressa

Department of Mathematics Jimma University Jimma, Ethiopia

In this paper constructing equation of mechanical systems based on their kinetic energy, potential energy and dissipative force is discussed. Both the holonomic and non-holonomic constraints are considered. Equations of constraint forces resulting from ideal and non-ideal nature of the constraints are developed.It is shown that, the constraint force is a sum of two forces resulting from the ideal and non-ideal nature of the constraints. An explicit equation of the acceleration of the system is developed basing on the constraint forces from the nature of the constraints. For investigating the deviation of the system from the trajectory of the constraint equations, excess variables are included in the equations of the constraints. The stability of the system is based on determining the sign of constants emerging from developing the Lagrange's equation of motion for the constraints. The determination of the sign of the constants is made based on Routh-Hurwitz Criterion for Stability.

An example is used to demonstrate each of the equations developed in the paper and constructing state-space equation of the system.

Key words and phrases: dissipative force, excess variables, ideal constraints, Lagrange equation, non-ideal constraints, stability, Routh-Hurwitz criterion for stability, state-space equation.

1. Introduction

In an article by R.G. Mukharlyamov [1], constructing equation of mechanical system when the kinetic energy, potential energy and dissipative forces are known is detailed. Both holonomic and non-holonomic constraints are considered. In order to investigate the stability of constraints, excess variables are used.All the discussions made by R.G. Mukharlyamov in [1] were for Ideal constraints. In an article by Udwa-dia F. [2,3] constructing equation of mechanical system involving both the ideal and non-ideal constraints is discussed. The method detailed is so general that it makes the ideal constraints only a particular case.The issue of constraint stabilization is not included in Udwadia F. The idea for developing this paper is mainly an insight from investigating the above two articles. In this paper, firstly, a new idea of developing equation of mechanical system simultaneously from Lagrange's equation of motion for a constrained mechanical system and Lagrange's equation of motion for the constraints is discussed. In other words dynamic equation for the constraints is developed and is used for investigation of asymptotic stability of the system.Secondly, the equation of a constraint force generated as a result of constraining a system is developed. In constructing an equation for the constraint forces, a general case that involves both the ideal and non-ideal situation of the constraints is considered. It is discussed that, the constraint force is a sum of two forces resulting from the ideal and non-ideal nature of the constraints which agrees with what is discussed in [2,4]. It is also shown that, from the general equation of the constraint forces,it is possible to develop an equation for only ideal constraints by taking into account the D'Alembert-Lagrange principle of the work done by virtual displacement.It should be noted that this paper brings about new idea in that, the excess variables are included in all the equations developed, as a result of which we have new constants that need to be determined in order to make the system asymptotically stable. Thirdly, an explicit equation of the acceleration of the system is developed basing on the constraint forces from the ideal and non-ideal nature of the constraints.

The fourth point involved in this paper is determining the constants, obtained as a result of equations of motion of the constraint equations, so that the system becomes

asymptotically stable. With this regard, we use Routh-Hurwitz criterion for stability in determining the region of stability [4,5].

A further discussion in this paper is made using an example provided. In the example each of the methods developed are demonstrated.Moreover it is discussed that the method developed in this paper can easily be extended to develop statespace equation of the system which is a power full approach in dynamic system for multiple input and multiple out put situation of linear and non-linear system analysis [4,5].

In summery, some of the advantages of the approach developed in this paper are:

1. An explicit equation of the acceleration of a system can be constructed with relatively minimum steps. This is because, we don't need to calculate Lagrange's multipliers in the method developed in this paper.

2. Problems that result from the redundant constraints,such as rank deficiency of the Jacobian matrix, can be managed.

3. The stability of the system can easily be made usingRouth-Hurwitz criterion for stability even at singular points.

4. Since the equation resulting from the method can be developed into state-space equation, it can be used for further investigations, such as controllability and control design of complex systems.

2. Equations of Mechanical System.

In this section discussion is made on the construction of equation of motion for mechanical systems.

Let T° = T°(q,q) , V0 = V0(q), D° = D°(q,q) be respectively, the kinetic en-ergy,potential energy and dissipative function of an unconstrained mechanical system, where q = (q1, q2.,qn) is n generalized coordinate. Moreover, we shall assume that this system is subjected to a set of m = h + s consistent equality constraints of the form:

<%,i) = 0, (1) # M,i) = 0, (2)

where <P is an h vector and W is an s vector.

Construction of dynamic equations of mechanical systems, are usually based on the assumption that, if constraint equations at the position and velocity level are satisfied at t = t0 then are satisfied for all t > t0. But in reality this is not the case. If a constraint equation at an acceleration level is used, for instance, the position and velocity level acceleration equations suffers drift phenomena. Ones these equations deviate from the exact value at some time t ^ t0 the error will keep on accumulating. This creates problem in stabilization and control design of mechanical systems [1,6].

For instance let us consider a holonomic case given in equation (1) such that <P = £,<& = 5 which deviates from the exact value &(q, t) = 0, then from the differential

equation <P = 0 we obtain = 5t + e.This indicates that deviation of the constraint equation from the exact value at time t ^ t0 accumulates in linear manner for all time. We note that, this is when the constraints at the acceleration level is used to construct model of mechanical system to get Ordinary Differential Equations.

In order to stabilize the constraints in (1) and (2) it is necessary to take account of the deviation from equations (1) , (2) and introduce a corresponding correction to the dynamic equation of the system [1,6]. Let the deviation of the constraints be denoted by y,y and p called excess variables [1] such that:

&(q,t) = y, q + = y, & (q,q,t) = p, (3)

where: $ = (01, &2,..., &h), y = (y1, y2,..., yh), & = (Wh+1 ,Wh+2,... ,Wh+s),

P = (i/h+1 yh+2 yh+s)

The mechanical system is determined by the generalized coordinates, q, у and the generalized velocities q, r where

r = (y1,y2,,,,yh,yh+1,,,,ym)T,

r = (y\f,...,yh,yh+\yh+2,...,yh+)T = (y,p)T■

Let L1 represent Lagrangian for the constraints such that:

L1 = L1(y, Г), T1 = T\y, Г), V1 = V\y), D1 = D1(y, Г),

where L, T, D and V respectively represents the Lagrangian, the Kinetic Energy, the Dissipative Function and the Potential Energy of the constrained mechanical system such that:L = L(q, y, q, Г), T = T(q, y, q, r),D = D(q, y, q, Г), V = V(q, y), L(q, q, 0, 0) = L0(q,q),L = L0 + L1 ,L0 = T0 — V 0,L1 = T1 — V 1,D(q,q, 0,0) = D0(q,q). Here L0 is the Lagrangian of the an unconstrained system. We now expand the constraint equations by Taylor expansion method, around у = 0, r = 0. That is for sufficiently small values of the variables у and r we obtain:

m h

2T1 = £ (avk)yryk, 2V1 = £ (vvk)yryk,

r,k=1 r,k=1

m

and the dissipative force 2R1 = — Y1 (crk)УГVk■

r,k=1

Now let us obtain the Lagrange's equation, for the constraints, based on T1, V1, R1 and L1 = T1 - V1

dL1 1 .dyq ,k 1 ™ Vyk

df = (°'k] W" + 2 Kk}WV =

1 m i m

= 2 ^ (a'qk yk + 2 ^ (avk)5ki r, i = 1, 2,...,m,

q,k=1 q,k=1

where 5ij = 1, when i = j, and is 0, when i = j:

dL1 i i

rn

= 2Y,(ai k)yk + ôZfa* )yq ■

Qyi lkJ" 2

y k=l q= 1

Since aik = aki and the summation in dices are dummy, the above expression can be simplified as

1 ^ m m m m m

¿ = 2^(aik ^k + 2^(avi = 2^(avi + 2^(aiv ^ = 2^(aiv ^

k=l q=1 q=1 q=1 q=l

Hence:

d dL1 1

dt д f 2

■ =1

)yq (4)

A similar analysis for the potential energy and dissipative force gives:

dL1 1

)y

y V=1

■q 9R1 _ ^ ^ , ) .

dyi _ 2^(Civ)V

V

AT r , ddL1 dL1 dR1 , .

Now from the equation: — ---_ — we obtain:

at oy% oy% oy%

(5)

Yj(aiv )yv (viv )yv _ - Yj (civ )y

Let

A _

/ a-1,1 a-2,1

^=1

a1,2

a-2,2

^q=1

\am,1 am,2

^q=1

( C-1,1 C1,2 ••• C1,m\ C-2,1 C2,2 ••• C2,m

c _

m,1 Cm,2

Cm,,m/

{ V1,1 V1,2 V2,1 V2,2

w _ -

V1,h 0 ••• Ü1,m\ V2,h 0 • • • Ü2,№

Vh,1 Vh,2 ••• Vh,h 0 0 0 0 0 0

\°m, 1 0rn,2

Now equation (6) can be given as:

0m,h

0h,

0m,m/

Aï- _ -Cï - Wr,

where r and r are defined above. Equation (7) can be reduced to:

ï _ — Bï — Kr,

where B _ A-1C and K _ A-1W.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

(6)

(7)

(8)

Remark 1. The matrices A, C and W contain the elements a,ij, Cij and hij for the different constraint equations, do not account for the coupling between the different constraints and hence the entries off the diagonals can be taken to be zero and therefore the matrices in this case are each diagonal matrices. For example A can be expressed as [7,8]:

(d1,1 0 0 a2,2

00

0 0

id1,1 0

0

d>2,2

am,mJ \ 0 0

0 0

d>m,m/

_ aP.

So that the different coefficients can be seen as a single factor a multiplied by a proportionality factor du for each constraint equation. The matrices C and ^can be

a

0

a

treated in the same way.Moreover, from the above discussion it can be seen that each of the values an, cu and ha may be different for each constraint equations. However, for a wide range of purposes, the use of single scalar values for an, cu and h^m every constraint equation is an acceptable solution, and it is frequently found in the literature. It can then be concluded that the matrices A, C and W can be taken to be a single factor each, say a, c and h respectively [7,8].

Equation (8) can also be written as a system of first order differential equations shown below.

dr

— = r,

dr (9)

dr = -Br - Kr. d - -

From Lagrange's equation for the constrained mechanical system and equation (8) we obtain the following system of Differential Equations given in (10) below.

™ • r d dL dL , d dL1 dL1 OR1 .

That is from — -— —— = Qex + Q^ and —---= — it results:

dt oq oq dt oy% oy% oy%

M q = Lq + Qex + QC + Mq, r = —Br — K r,

(10)

dL

where M is the mass matrix of the unconstrained system, Lq = —, Qex is an external

force, Q = Lq + Qex — Mq, Qc is a constraint force applied on the system as a result of the constraints. B and K are constant matrices of size m by m. From Remark 1 we can assume B and K to be constants.

3. Construction of the Constraint Force Qc

In this section we shall discuss the construction of equation for the constraint force Qc. It is shown that Qc is a sum of two terms resulting from the ideal and non-ideal nature of the constraints. By considering the D'Alembert-Lagrange principle of virtual displacement, it is shown that the force due to the non-ideal nature of the constraints will add up to zero.

Differentiating (1) twice, (2) once , replace r by:

r = ($ q q + $qq + $ t) + (&q q + Vqq + &t)-

Then equation (10) with Q = Lq + Qex — Mq becomes

(q = M-lQc + M-1Q, (11)

\($q + Vq )q = —Br — K r — ($ q q + $ t + Vq q + Vt).

Multiplying the first part of (11) by $q + Vq and solving for Qc from the two equations leads to:

($q + Vq )M-lQc = — B r — K r — (Vt + Vq q + $q q + $ t) — ($q + Vq)M-1Q. (12)

Let A = ($q + Vq)M-1, b = — Br — Kr — (Vt + Vqq + $qq + $t), ($q + Vq)M-1Q = AQ. Note also that:

$q + Vq = ($1, ,...,$hq, 0,0,..., 0f + (0, 0,..., 0, , Vh-+2,..., Vh-+S)T.

Then we can write equation (12) as:

AQC = b - AQ. (13)

The general solution of equation (13) is given by:

Qc = ^+(b - AQ) + (I - A+A)w, (14)

where w is a non-zero n-vector, A+ is a generalized inverse of matrix A and I is an identity matrix of appropriate size.

From(14) we can infer that: The constraint force is given as a sum of two components. The first component is the extent to which the acceleration of the unconstrained system deviates from the acceleration of the constrained system with constant of proportionality A+. In other words,If AQ = b then,there is no deviation and the constraint equation is satisfied. Otherwise, there is a deviation from the trajectory of the constraint equation.The second component of (14) is proportional to a non-zero n-vector w with constant of proportionality (I - A+A).

The constraint force given in (14) is general in that D'Alembert-Lagrange principle is not taken into account. That means (14) is applicable irrespective of the whether the constraint is ideal or non-ideal. To further strengthen this observation let us see what form (14) would have if D'Alembert-Lagrange principle is taken into account.

D'Alembert-Lagrange principle states that, at each instant of time t, and for all virtual displacement Sr, at that time t, the work done by the force of constraint, Qc, under this virtual displacements,Sr, must be zero; that is, (5r)TQc = 0 at each instant of time t [2,3].

The constraint equation, the second part of (11), is considered to define a virtual displacement. We can write the constraint equation in (11) in the form:

Bq = b, (15)

where B = ($q + ) is m by n matrix and b is defined in (12) is an m vector. A non-zero vector 5r such that B5r = 0 at time t is said to be a virtual displacement (Sr is a non-zero vector in the null space of B) [2,3]. Suppose that at a particular time t, (Sr)TQc = 0 (that is D'Alembert-Lagrange principle is satisfied). We want to show that the term,in equation (14), (I - A+A)w = 0.

To define Sr,the virtual displacement, in terms of A, put Sr = M-1S/j, then BSr = ($q + )M-1S^ and then ASn = 0. (A is defined above in (12)). From ASn = 0 we obtain S/j, = (I—A+A)u for a non- zero n-vector u. Thus in (12) D'Alembert-Lagrange principle requires that {S¡i : AS¡i = 0}

Now:

(Sr)TQc = M-1(I - A+A)uA+{b - AQ) + M-1(I - A+A)u(I - A+A)w = = M-1 uT(I - - AQ) + M-1uT(I - A+A)(I - A+A)w =

= 0 + M-1uT(I - A+A)w

and then we obtain:

(I - A+A)w = 0. (16)

Hence, we can make the following conclusions:

a) The constraint force, taking into account the D' Alembert-Lagrange principle is given by:

Qi = A+(b - AQ). (17)

This force,Q%, is the control force that provides feedback control based on the error signal b - AQ which measures the extent to which the unconstrained acceleration does

not satisfy the trajectory requirement of the constraint equation (15) with the gain matrix A+ [4,5].

b) Thus, (17) is a force resulting from idea nature of the constraints and

quí a (j - A+A)w (18)

is a force from the non-ideal nature of the constraints.

c) It is also possible to say that, the work done by the constraint force by a nonzero virtual displacement vector Sr, since the ideal constraint do no work at any time t, is given by:

Wni A (Sr)T(I - A+A)w. (19)

d) An explicit equation of acceleration of the constrained mechanical system from the first equation of (11) and equation (14) is given by:

q = M-1 [A+ (b - AQ) + (I - A+A)w] + M-1Q (20)

which reduces,based on (16), to:

q = M-1[^+(b - AQ)] + M-1Q. (21)

Regarding the characterization of vector w which is used starting from equation (14) one can set w = M-1C(t) in order that equations (20) and (22) are identical [3].

q = M-1 [A+(b - AQ)] + (I - A+A)M-1C(t) + M-1Q. (22)

In other words the non-ideal constraint force is given by:

(I - A+A)M-1C(t), (23)

where [3] the n-vector C(t) needs to be specified at each instant of time t, and it depends on the nature of the non-ideal constraints in the specified mechanical system under consideration. More information can be obtained in [3]. If the constraint forces are ideal then C(t) = 0.

4. Stability

We Use Routh-Hurwitz criterion for stability in determining the constants K and B [4,5]. The Routh-Hurwitz stability method provides an answer to the question of stability by considering the characteristic equation of the system. The characteristic equation in the Laplace variable is written as

q(s) = ansn + an-1Sn-1 + ... + avs + 0,0 = 0. (24)

The Routh-Hurwitz criterion states that the number of roots of q(s) with positive real parts is equal to the number of changes in sign of the first column of the Routh array. This criterion requires that there be no changes in sign in the first column for a stable system. This requirement is both necessary and sufficient [4,5]. This criterion will be applied in the next example.

Example. A uniform hoop of mass m and radius r rolls without slipping on a fixed cylinder of radius R as shown in figure 1. The only external force is that of gravity. If the smaller cylinder starts rolling from rest on top of the bigger cylinder, find the acceleration and each of the constraint forces before the hoop falls off the cylinder.

Solution. The two constraint equations, the distance of the center of mass of the hoop from the center of the cylinder and the no slipping of the hoop as long as it is

Figure 1. A hoop rolls on a cylinder.

touching the cylinder are respectively given by:

p = r + R, r(< - 9) = Rd,

where <, the angle r makes with the vertical and d, the angle p makes with the vertical are the generalized coordinates. The kinetic energy is the sum of the kinetic energy of the center of mass of the hoop and the kinetic energy of the hoop about the cylinder given by:

T =\m((pd)2 + (r<)2). The potential energy is the height above the center of the cylinder and is given by:

V = mgp cos(0).

The Lagrangian L = T — V.

The first part of equation (10) becomes:

'—mgp sin(6>)

m p2 0 r

0 m 2 <r

^-m9posin(^+QC. (25)

Based on equation (3) we have the excess variables r = ( y1, y2) for the two constraints and Since, r = ( y1, y2) and y1 = 0, y2 = r< — pf) then the second part of equation (10) becomes:

r = —fir — K r, (26)

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

where K and B are appropriate constants to be chosen for asymptotic stability of the equilibrium point of system. First let us find Qc = Q% + Qm, where, based on the substitutions used in (12) we obtain:

M=(mf M =[*.-1 = (— I),

\ 0 mr J \mp mr J

where <P1(q, t) = p — (r + R) and &2(q, t) = r(< — d) — Rd and <P = ((P1,(P2).

It need to be noted that both the constraints in this example are holonomic constraints. Q = mposin(dA , b = — Br — Kr =( ~KV\ .2

V 0 J V—Ky2 — B y\

- - (4 1) Crr1) -G

—■mpr2 N

10

A+ = ___ AT =

(A. )2 + )2 U mnL

\mp> 1 \mr > \0 r2+p'

/0

I rz+pz \

I 0 mrp2 I .

\0 r2+p2 /

Hence,

Qi = A+(b — AQ)=\ ^

(-+2- (—K y 2 — By2 — gsin(6))\ (—Ky2 —By2 — gsin(d)))

If we assume the constraint between the hoop and the cylinder at some time to be non-ideal then the constraint force resulting from such a constraint is given by equation (23) as:

QUi = (J — A + A)M-1C (t) = ( :(r2+p2) c (t),

:mp(r2 +p2 ) m(r2+p2 )

(

where [3] the 2-vector C(t) needs to be specified at each instant of time t,and it depends on the nature of the non-ideal constraints in the specified mechanical system under consideration.

The equation of motion of the hoop becomes:

(V) = M-1 I (—KV2 — By2 — 9 sin^A +

Vp) (—Ky2 —By2 — gsin(d)))

+ M-1 i—mWsin(*A + M^fW) C(t).

\ / \mp(r2 +P2) m(r2 +p2) I

Next point of discussion is experimental determination of the constants K and B so that the system becomes Asymptotically stable. Since the determination of C(t) is beyond the scope of this paper let us assume the case of ideal constraints C( ) = 0. Hence the equation of the system reduces to:

(= M-1 (-m+2 (-Ky2-By2-9 s^)A +M-1 i-mgp sin(0)\ (-Ky2 -B y2 - gsin(e))J V 0 J'

Again for Numerical investigation of K and B, let m = 2kg, r = 0.2 meter, R = 1m, p = R + r,g = 9.8 ^. Then we obtain:

M = fa3n472 , -PK = 0.06487, = 0.3891, mgp = 23.52

y 0 12.5y r2 + p2 r2 + p2

and with this numerical values the equation of the system becomes:

f A = /-0.0225(-Ky2 - By2 - 23.2995 sin(0))\ = V 4.86389(-Ky2 -By2 - 47.665 sin(6»)) J .

Next we write the system equation as a system First order Differential Equations. In so doing let x1 = d,x2 = 6,x2 = 0,x3 = (,x4 = (,x4 = Now the system becomes:

( x1 = x2,

x2 = -0.0225[K(-0.2x3 + 1.2x1) + B(-0.2x4 + 1.2x2)] - 23.2995 sin(x1),

x3 = x4,

x4 = 4.8638[K(-0.2x3 + 1.2x0 + B(-0.2x4 + 1.2x2)] - 47.665 sin(x1).

1

p

The state variables are then x1,x2,x3 and x4. Define the output variables x1 = 9 and x3 = < define u, input variable as step in put.

Define the state derivatives as: ' x1 = f1(x, u) = x2,

x2 = h(x, u) = —0.0225[K(—0.2x3 + 1.2x1) + B(—0.2x4 + 1.2x2)] — 23.2995 sin(x1), x3 = f3(x,u) = x4,

^4 = f4(x, u) = 4.8638[K(—0.2x3 + 1.2x1) + B(—0.2x4 + 1.2x2)] — 47.665 sin(x1).

Choosing the output variables x1 = 9 and x3 = 0 define:

iyi = ffi(x,u) = xi, \V2 = ff2(x,u) = x3.

Suppose the initial condition is such that x0 = (x0, x2, x°, x°) = (0, 0, 0, 0) and the initial input u0 = 0.

We want to write the system in a linearized form:

jx = Ax + EU, \y = Cx + DU.

Which are the state and out put equations respectively and:

/

A = fx (x°,u°)

E = °f (x0,u0) ou

0

1

0

0

-0.027K - 23.2995 -0.027B 0.0045K 0.0045B

0

0

0

1

\ 5.8366K - 47.665 5.8366B -0.9728K -0.9728B/

0

0

0 0

-Off

" dx

,C = Œ(xO,u0)

1000 ,0010

)-D = I (x0'»°)

(0)-

With the above Linearization the state equation becomes:

/△xi\ △x2 △x3 {△xj

/△9\

△ 9

W/

0 1 0 0 0

-0.027K - 23.2995 -0.027B 0.0045K 0.0045B + 0

0 0 0 1 0

5.8366K - 47.665 5.8366B -0.9728K -0.9728B w 0

U.

The out put equation is given by:

y =

fy1\ = /1 0 0 0\ \y2j y0 0 1 0y

W

Next we shall determine the constants K and B in order to make the system asymptotically stable. We use Routh-Hurwitz Criterion for stability in determining the constants K and B [4]. This method requires the characteristic equation of the system in the Laplace variable s.

det(sI — A) =

1

0

0

0.027K + 23.2995 s + 0.02TB —0.0045K —0.0045B

0

0

1

—5.8366K + 47.665 —5.8366B 0.9728K s + 0.9728B = s4 + 0.9998B s3 + (0.0000009B2 + 0.9998K + 23.2995) s 2+

+ (0.0000018BK + 22.88024611B)s + 0.0000009K2 + 22.8802461K.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

For construct Routh table let a = 0.9998B, b = 0.0000009B2+0.9998K+23.2995, c = 0.0000018BK + 22.8802461B, d = 0.0000009K2 + 22.8802461K

Table 1

Routh-table

column of S

column#1

column#2

column#3

S2

o0

a

ab — c

a

abc — c2 — a2d

a -d

0 0

d 0

1

d

0

According to Routh-Hurwitz criterion the system is stable if the first column of Routh table does not change sign. Accordingly, we need to have

a> 0, ab — c> 0, abc — c2 — a2d > 0, d> 0. (27)

since 1 > 0.

Upon investigating the graph (figure 2) of abc — c2 — a2d > 0 using MATLAB,it has a maximum point (x, y) = (0,0). The MATLAB command used and the graph are shown below.( B=x and K=y is used for this case.)

f solve(0.9998 *x * (0.0000009 * x(22.8802461 *x + 0.0000018 *x * y)2+ + 0.9998 * y(22.8802461 *x + 0.0000018 *x * y) + 23.2995) —

— (22.8802461 *x + 0.0000018 *x * y)2 — 0.99960004 * x2 = 0, y),

piot(0.9998 *x * (0.0000009 * ^(22.8802461 *x + 0.0000018 *x * y)2+ + 0.9998 * y(22.8802461 *x + 0.0000018 *x * y) + 23.2995) — — (22.8802461 *x + 0.0000018 *x * y)2 — 0.99960004

* x2, y).

Figure 2. Graph with maximum point (0,0)

This implies that the first column of Routh table (Table 1) changes sign since at least 1 and abc — c2 — a2d > 0 have opposite sign. Hence it can be concluded from the Routh table indicated above that the system is unstable.But for B = K = 0 we obtain the fourth (row of s) to be a zero row which indicates that the eigenvalues (or poles) of the system are on the imaginary axis , axis y.It can be seen for the case of B = K = 0 the system is marginally stable.The graph of the system for the case B = K = 100 and non-zero initial condition X0 = [0.0001; 0; 0.0001; 0] is indicated below in figure 3.

0.015

0 2 4 6 8 10 12 14 16 18 20

t "sec)

Figure 3. Initial Condition Response

5. Conclusion

In this paper a method of constructing equations of mechanical system that includes both the ideal and non-ideal nature of constraints is developed. With the method developed, problems that may arise from redundant constraints, like rank deficient Jacobian matrix of the constraints and other related problems can be man-aged.The method can also be used to develop state-space equation of a system and then after, can be used for further study on controllability, observability and other

related issues in complex mechanical systems. The state space of a system being constructed, a wide range use of different software like MATLAB can be employed for investigation of dynamic system.This paper can also be used as a bench mark for further research in the area.

References

1. Mukharlyamov R. G. Stabilization of the Motions of Mechanical Systems in Prescribed Phase-Space Manifolds // Applied Mathematics and Mechanics. — 2006. — Vol. 70. — Pp. 210-222.

2. Udwadia F. E. Recent Advances in Multi-body Dynamics and Nonlinear Control // J. of the Braz. Soc. of Mech. Sci. & Eng. — 2006. — Vol. XXVIII, No 3 / 311. — Pp. 311-314.

3. Udwadia F. E., Kalaba R. E. On the Foundation of Analytical Dynamics // International Journal of Nonlinear Mechanics. — 2002. — Vol. 37. — Pp. 1079-1090.

4. Dorf R. C., Bishop R. H. Modern Control Systems. — 12th edition. edition. — Prentice Hall, 2011.

5. Norman S. N. Control Systems Engineering. — 6th edition edition. — John Wiley & Sons, Inc, 2011.

6. Amirouche F. Fundamentals of Multibody Dynamics: Theory and Applications. — Boston: Birkhauser, 2006.

7. Gonzalez F., Kovecses J. Use of Penalty Formulations in Dynamic Simulation and Analysis of Redundantly Constrained Multibody Systems. // Multibody System Dynamics. — 2012.

8. Blajer W. Advanced Design of Mechanical Systems: From Analysis to Optimization. — New York: Springer Wien, 2009.

УДК 531.3

Построение уравнений динамики связанных механических

систем

Чернет Туге Дересса

Кафедра математики Университет г. Джимма г. Джимма, Эфиопия

В статье предлагается новый метод решения задачи построения уравнений динамики механической системы, обеспечивающий стабилизацию связей при численном решении. Исходными данными для составления уравнений динамики являются функция Лагран-жа, диссипативные и непотенциальные силы и ограничения, выраженные уравнениями голономных и неголономных связей. Рассматриваются случаи идеальных и неидеальных связей. Определение правых частей систем дифференциальных уравнений используется обобщенная обратная матрица.

Для исследования поведения отклонений решения системы от уравнений связей вводятся добавочные переменные. Устойчивость по отношению к уравнениям связей определяется по уравнениям возмущений связей, составленных по расширенным функциям Лагранжа и диссипативной функции. Ограничиваясь добавлением в лагранжиан и дис-сипативную функцию квадратичных форм с постоянными коэффициентами, получены дифференциальные уравнения возмущений связей линейными с постоянными коэффициентами. Это позволяет обеспечить условия асимптотической устойчивости на основе критерия Рауса—Гурвица. Метод иллюстрируется на примере решения задачи скатывания цилиндра с поверхности закреплённого цилиндра без проскальзывания.

Ключевые слова: избыточные переменные, идеальные связи, неидеальные связи, устойчивость, критерий Рауса—Гурвица, пространство состояний, функция Лагранжа, диссипативная функция.

i Надоели баннеры? Вы всегда можете отключить рекламу.