Научная статья на тему 'Stabilization of redundantly constrained dynamic system'

Stabilization of redundantly constrained dynamic system Текст научной статьи по специальности «Математика»

CC BY
165
58
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
STABILITY / ОБОБЩЁННЫЙ МЕТОД БАУМГАРТА / GENERALIZED BAUMGARTE'S METHOD / МОДИФИЦИРОВАННЫЕ УРАВНЕНИЯ ЛАГРАНЖА / MODIFIED LAGRANGE'S EQUATION / СИНГУЛЯРНАЯ МАССОВАЯ МАТРИЦА / SINGULAR MASS MATRICES / REDUNDANT CONSTRAINTS / ПРЯМОЙ МЕТОД ЛЯПУНОВА / LYAPUNOV'S DIRECT METHOD / СТАБИЛИЗАЦИЯ / ИЗБЫТОЧНЫЕ ОГРАНИЧЕНИЯ

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

This article addresses the issue of constraint stabilization in a dynamic system. The well known Lagrange’s equation of motion of second order is used for modelling the dynamics of a mechanical systems considered in this paper. It is known that Baumgarte’s method of constraint stabilization does not avoid the problem of singularity of mass matrices that may result from redundancy of constraints and as a result it fails to run simulations near and at singularity points. A generalized Baumgarte’s method of constraint stabilization is developed and the stability of the developed method is ascertained by Lyapunov’s direct method. The developed method avoids using the same correction parameters for all constraints under discussion. The usual Baumgarte’s method, which uses the same correction parameters, becomes a particular case of the one developed in this article. Moreover, a modified Lagrange’s equation is constructed in a way that explains all the details of its derivation. The modified Lagrange’s equation improves Lagrange’s equation of motion in such a way that, it addresses the issue of redundant constraints and singular mass matrices. As it is the case in Baumgarte’s method, the usual Lagrange’s equation is a particular case of the improved method developed in this paper. Besides, a numerical example is provided in order to demonstrate the effectiveness of the methods developed. Finally, the carried out simulations show asymptotic stability of the trajectories and run without problem at singularity points.

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

Текст научной работы на тему «Stabilization of redundantly constrained dynamic system»

Теоретическая механика

UDC 531.3

Stabilization of Redundantly Constrained Dynamic System R. G. Mukharlyamov, Chernet Tuge Deressa

Department of Theoretical Physics and Mechanics

Peoples' Friendship University of Russia 6, Miklukho-Maklaya str., Moscow, Russia, 117198

This article addresses the issue of constraint stabilization in a dynamic system. The well known Lagrange's equation of motion of second order is used for modelling the dynamics of a mechanical systems considered in this paper. It is known that Baumgarte's method of constraint stabilization does not avoid the problem of singularity of mass matrices that may result from redundancy of constraints and as a result it fails to run simulations near and at singularity points. A generalized Baumgarte's method of constraint stabilization is developed and the stability of the developed method is ascertained by Lyapunov's direct method. The developed method avoids using the same correction parameters for all constraints under discussion. The usual Baumgarte's method, which uses the same correction parameters, becomes a particular case of the one developed in this article. Moreover, a modified La-grange's equation is constructed in a way that explains all the details of its derivation. The modified Lagrange's equation improves Lagrange's equation of motion in such a way that, it addresses the issue of redundant constraints and singular mass matrices. As it is the case in Baumgarte's method, the usual Lagrange's equation is a particular case of the improved method developed in this paper. Besides, a numerical example is provided in order to demonstrate the effectiveness of the methods developed. Finally, the carried out simulations show asymptotic stability of the trajectories and run without problem at singularity points.

Key words and phrases: stability, generalized Baumgarte's method, modified Lagrange's equation, singular mass matrices, redundant constraints, Lyapunov's direct method.

1. Introduction

One of the commonly used method of modeling Dynamics of Constrained mechanical systems is Lagrange's equation of motion [1-3]. This method of constructing motion equations of a mechanical system results in a set of Index 3 Differential Algebraic Equations (DAE). These set of DAE of motion does not use explicitly the position and velocity equations associated to the constraints, as a result of which the problem of stability in the position and velocity level came into being. To overcome these deviations of the trajectory of the system from the constraints, we need to use constraint stabilization methods. The strategies generally used to overcome this problem are the Baumgarte's stabilization method [4] and penalty method [5,6].

Moreover, in addition to the stability problems that may happen in mechanical systems, the presence of redundant constraints is also unavoidable in practice. In the presence of more equations than strictly needed the Jacobian matrix becomes rank deficient. This is reflected by the fact that some of the equations are dependent on the remaining ones. The Jacobian matrix can also be rank deficient when the mechanical system reaches a configuration in which there is a sudden change in the number of degree of freedom. For instance, a slider crank mechanism [5] reaches a singular configuration when both two links are at vertical position. In this position both links overlap and the mechanism has not one but two degree of freedom that corresponds to two possible motions that the mechanism can undergo. This makes the Jacobian matrix singular.

It is also known that Baumgarte's method of constraint stabilization does not avoid the problem of redundancy explained above, as it may fail to run around singularity

Received 26th June, 2014.

The work is done under support of RFBR grant, №13-08-00535.

points and in the presence of redundant constraints [5,6]. Moreover, it can be observed that since the same correction parameters say, a and ft, in the sense that, the same a and the same ft for all the constraints are used in Baumgarte's stabilization method, some violations will be eliminated while others may not be. The so called penalty method discussed in [5,6] explicitly addresses the problem of redundancy in contrary to Baumgarte's method. But in this method, like in Baumgarte's method, the same correction parameters are used, as a result of which some violations will be eliminated while others may not be. The challenge of choosing the correct parameters for stabilization is a common problem to both Baumgarte's and penalty methods.

Based on the analysis given above, this paper generalizes both the Baumgarte's and penalty methods. A modified form of Lagrange's equation of motion is developed in a way that keeps the advantage of addressing the issue of redundant constraints and singular mass matrices. The generalization of the above methods is done in the sense that, the problem of using the same correction parameters for all the constraints is avoided. As a result, we can choose different constants as needed while making experimentation by simulation to stabilize the system.

The organization of the paper is as follows: In section 2, Lagrange's equation of motion is revisited in a way that it addresses problems related to singular mass matrices and singular Jacobian matrix. This section is mainly based on [7]. Section 3 has two parts: In section 3.1, Generalization of Baumgarte's method of constraint stabilization and stability of the generalized method based on Lypunov's direct method is developed. In section 3.2 Modified Lagrange's equation is developed in such a way that the constructed formula improves Lagrange's equation of motion and generalizes penalty method. In section 4 a numerical example is given to show the effectiveness of the methods developed in simulating dynamic systems.

2. Dynamic Equations of Motion

Dynamics of mechanical systems can be described by second order Lagrange's equations of motion. Applying the Lagrange multiplier method, the dynamic equation of n-generalized coordinate mechanical system subjected to to (to < n) holonomic constraints [1-3] can be written in descriptor form as:

M(q)q+eqA = Q(q, q,t), (1)

e(q,i)=Q. (2)

Eq. (2) denotes the holonomic constraint equations, M e js the mass matrix,

A e ffl™ is the Lagrangian multipliers, 0q e ^mxn is the Jacobian matrix of the constraints. Q e Rn is the generalized force, q e is the generalized coordinates of the system.

Therefore the governing equations of a constrained mechanical system can be described by a set of n differential equations (1) and m algebraic equations (2). To eliminate the Lagrange multipliers, one can differentiate Eq. (2) with respect to time, thus yielding,

e(q, q ,i) = 6qq - 'n = 0. (3)

Equation (3) represents the velocity constraint equations, where ^ = — ©¿. Differentiating Eq. (3) with respect to time again, one can obtain,

e(q, q,i) = 6qq — e (4)

Equation (4) is the acceleration constraint equation, where

£ = — (eqq)qq — 2eqtq — ett. (5)

Here the holonomic constraints may be dependent or independent. Accordingly the inverse of an m x m matrix A = ©qM-1©q may or may not exist. Hence in general we have from Eq. (1) and Eq. (4),

A = A+(SqM-1Q - £) + (/ - A+A)u, (6)

where A+ is the Generalized Inverse of matrix A , u is an arbitrary n-vector and I is an identity matrix of appropriate size. Hence the condensed form of equations (1) and (2) can be written as:

M q= Q*, (7)

where Q* = Q - ©q[A+(©qM-1Q - £) + (I - A+A)]u.

It can be observed that the quantity in Eq. (7) given by:

Qc = ©l[A+(©qM-1Q - £) + (/ - A+A)]u (8)

is the constraint force of the system. The constraint force is given as a sum of two components [7]. 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 ©q A+ and the second component is proportional to n-vector u with constant of proportionality ©q [(I - A+A)\.

Moreover, referring to the dynamic equation of the constraints given by Eq. (4), a non-zero virtual displacement vector 5r such that ©q5r = 0 (Sr is in the null space of ©q) at time t is said to be a virtual displacement [7]. Suppose at a particular instance of time t, the virtual work done by the constraint force, (5r)TQc = 0. At this instance of time we have:

0 = (5r)TQc = (5r)Te^A+(OqM-1Q - ^ + (5r)T©q(I - A+A)u. (9)

For a virtual displacement put 5r = M-1 ©q5¡i. Then ©q^r = ©qM-1©q= A5^ = 0. This indicates that, if 5r is in the Null space of ©q, then 5¡i is in the Null space of A = ©qM-1©q. The general solution of A5^ = 0 is = (I - A+A)5w for an n vector w. This in turn indicates that:

6r = M-1©q(I - A+A)5w. (10)

Substituting Eq. (10) into Eq. (9) we have: 0 = (5r)T Qc =

= (5w)TM-1Ql(I - A+A)eq[A+(9qM-1Q - + (5r)T(I - A+A)u =

= (5w)TA(I - A+A)u.

From which it follows that:

(I - A+A)u = 0. (11)

We can conclude from the equations (9), (10) and (11) and the discussions then made that the equation given by Eq. (8) is the sum of two constraint forces resulting from the ideal and non-ideal nature of the constraints. As it is shown above using principle of virtual displacement the constraint force due to the ideal nature of the constraints is given by

Qlc = 6qA+(6M-1Q - i) (12)

and the constraint force resulting from non-ideal nature of the constraints is given by:

Qnic = el(I — A+A)u. (13)

Remark 1. Equation (11) shows that when the constraint is ideal, then (I — A+A)u = 0. As a result we can have the following proposition.

Proposition 1. A holonomic constraint (2) applied to a Lagrange's Mechanical system given by equation (1) is said to be Ideal constraint if and only if (I—A+A)u = 0 where A = BqM-1eq and u is arbitrary vector. This theorem is an extension of the definition of Ideal constraint given by R. G. Mykharlyamov in [2, P. 81].

Remark 2. If the holonomic constraints are assumed to be independent, then the inverse of the m x m matrix, A-1 = (eqM-1e^)-1 exists and then, since in this case A-1 = A+, the governing equation of the system indicated in Eq. (7) reduces to:

M q = Z *, (14)

where z* = q — e£(eqM-1eqq)-1(eqM-1Q — £).

It also needs to be noted that in the case when A-1 = A+ we have only Ideal constrains, since (I — A+A) = 0.

3. Stabilization of the Constraint Equations

When we intend to solve the dependent acceleration from Eq. (14) using standard ODE solvers, Eq. (2) and (3) may not be satisfied. This is because Eq. (4) which are obtained by differentiating Eq. (2) twice with respect to time is used. This in turn implies that the system of equation given by Eq. (4) is unstable. This requires the incorporation of stabilization to the system as discussed below.

3.1. Generalization of Baumgarte's Constraint Violation Stabilization

Method

When the violations in Eq. (2) and Eq. (3) are beyond a specified error tolerance, Baumgarte's stabilization method [4] replaces e in Eq. (4) by:

e + 2ae + ft 2 e, (15)

where a and ft are appropriately chosen correction parameters to make the origin asymptotically stable. It can be observed that different types of violations in Eq. (2) and Eq. (3) are not considered by Eq. (15) since the same correction parameters a and ft are used. Hence some violations will be eliminated while others may not be. Therefore, let us consider a general case of (15) by replacing it with:

e + KD e + KP e, (16)

where K^ and Kp are constant positive definite symmetric matrices. Equation (16) may be expressed in terms of [eT, eT] as:

-H = ( e 1 = (Q 1 )(e

dt \e) \-kde-kpe) \-Kp -kd) V©

where I is the identity matrix of size to.

Let us investigate the stability of the origin in (17): The immediate Lyapunaov function candidate is:

1 f©\T fKp + eKD el\ /©N

m <M(9) +fD 1) (9)

1 T 1

= 2 + (9 + e0) + ^[ + eKD - e2I]9, (18)

where the constant e satisfies:

Kd - eI> 0, KP + e^D - e2I > 0. Evaluating the total time derivative of V(©, ©) we obtain:

F(9, (9) = -

"9" eKp 0 "9"

9 0 Kd -el 9

(19)

Equation (19) is globally negative definite and as a result we conclude that (©, ©) = (0, 0) is globally asymptotically stable.

Remark 3. For practical purposes we can choose KD = diag (2k1, 2k2,..., 2km) and KP = diag(k2, k%,..., k^).

Now ^ of Eq. (5) have a new form given as:

s = -(©q«q)qq - 2©qtq - ©tt - kd© - Kp©. (20)

We can now write Eq. (14), after including Generalized Baumgarte's constraint stabilization method we developed, as follows

Mq = Q - ©q(©qM-1©q)-1(©qM-1Q - s), (21)

where s is given in (20).

Equation (14) can then be integrated numerically as before with the modified s. One of the advantages of using Generalized Baumgarte's constraint stabilization method, as can be seen above is, it reduces the Index 3 DAE given by Eqs. (1) and (2) to DAE of index 0, which is purely a Differential Equation. Hence we can use any of the standard numerical methods to solve the resulting differential equation such as Runge-Kutta method. The other advantage is, it uses different correction parameters for different constraints if need be, that may help to reduce all the constraint violations in contrary to Eq. (15).

However there are some drawbacks in this method:

a) the selection of correction parameters in kd and Kp has no certain rules to follow;

b) the other problem with Generalized Baumgarte's stabilization developed in this paper is that, it does not solve all possible instabilities, such as near kinematic singular configurations.

These difficulties work in favor of other constraint stabilization method developed below.

3.2. Modified Lagrange's Equation Technique of Constraint Stabilization

As it is stated in [8] in order to stabilize the constraints in (2) and (3) it is necessary to take account of the deviation from equations and introduce a corresponding correction to the dynamic equation of the system. Let the deviation of the constraints

be denoted by vectors y and y whose coordinates are called excess variables such that:

e(q,i) = y, (22)

eqq + e t = y,

(23)

where y = (y1, y2,..., ym) and y = (y1 ,y2, ...,ym).

Now considering the excess variables, the mechanical system is determined by the generalized coordinates, u = {q,y} and the generalized velocities u = {q, y}. Let T0 the kinetic energy, V0 the potential energy, D0 the dissipative function of the system before it is subjected to the rn-constraints such that,

T0 = T0(q, q), V0 = Vu(q), D0 = D0(q, q)

Let T the kinetic energy, V the potential Energy, D the dissipative function of the constrained system subjected to the rn-constraints such that,

T = T(q, q, y, y), V = y(q, y), D = D(q, q, y, y).

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

We now expand the constrained mechanical system by Taylor's expansion method, around y = 0, y = 0. Assume T, V and D are at least twice differentiable with respect to all the variables and the system is at an equilibrium position for y = 0, y = 0.

1 m

Putting T0 = T0(q, q) = - Y1 (mijwe obtain:

2 i,j=1

rn rn

t =1E )№ +1 w)+T3

i,j=1

l,]

d2T(q, q, 0,0) , . , . . , . ,

where a,ij =-^ .-which is symmetric in the indices i and j. Similarly,

dyldy-

•j

ill

V = y0(q) + 2 £ (Vij)yY + ^3,

i,j=i

d2v(q, q, 0,0) ,. , . . , . A ,

where Vij =-^ . ^ .-which is symmetric in the indices i and j. And

dy%dyi

D = D0 (q q) + 2 )yi1ji + D

d2D(q, q, 0,0) , . , . .

where ca =-^ ^ ,-which is symmetric in the indices i and j. Hence, ignoring

%0 dyldyi

higher order terms we have: (

1 n 1 m

T = 0 E (™>n)<ii<ij + Ö E (anWtf,

9 ^ y^j/ 2 i,j = 1

9 ^

2 i,j = 1

1 m

^ = ^0(q) + 2 E (%•W,

2 i,j = 1

D = D0(q (() + 2 E(cij)ylyj, 2 ij

which is the result obtained in [8].

3

Let M = ^ (mij), A = ^ (a^), Kp = ^ (Vij), KD = ^ (c^-). Note also

i,3 = 1

i,3 = 1

i,3 = 1

i,3 = 1

Vij and Cij in general depend on the generalized coordinates q

that the coefficients a

and q. In this paper they are assumed to be constants. It is also assumed that matrices M, A, Kp and kd , that contain the value of the coefficients 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. Assume also that the matrices are each positive definite. Now Eq. (24) can be written in the form:

't = 1 q tm q+l(yfAy,

V = V 0(q) + 1(y)TKp y, 2 1

D = D0(q, q) + i(y)TKDy.

(25)

The perturbation expression can be seen to be given by:

A A d ay

(2yTAy) - a (2yTAy)

+ — (2yTKpy ) +—M;

d_ dy

) + a|(1 y tkD y).

(26)

Each of the expressions in Eq. (26) can be simplified as follows:

A A (1

dt dy/ \2

y (2yTAj^j = ((yT)y) Ay + ((^T)yA^)

ay ( 1yTKpy) = ((yT)y) Ay,

ay ( 2 yT y) = ((yT )y) kd y.

Combining all the above terms yields a relatively simple form of the perturbation expression given by:

(yT )y( Ay + K^ y + KP y). (27)

Expression (27) is said to be the arising force that resist the constraint violation where A is the value of the constraining masses, kd is the damping coefficient and Kp is stiffness coefficient [9].

The dynamic system is achieved by combining the equation for the unconstrained system (taking D0(q, q) = 0) perturbation expression and is given in the form:

d fdT0\ dT0 dV0 dt \ dq ) dq dq (y )y

+ = Qex - (yT )yA(y + kd y + Kp y), (28)

d fdT°\ dT0

where Qex is an external force applied to the system. Now from — —------+

di \ d<q J dq

dV0 • d(T0 - V°)

—— we obtain Mq = Q, where Q = Lq+Qex —Mand =---. Therefore

dq q dq

Eq. (28) can be written as:

Mq+ ((yT)y) A(y + kdy + Kpy) = Q. (29)

Substituting y, y and y from Eq. (22) and Eq. (23) one obtains from Eq. (29)

Mq + eq a [eqq + e qq + e t + kd e + kp e] = Q.

This can also be written as:

(m + eq ^q) q = q - eq a (kd e + Kp e - ^ , (30)

where £ defined in Eq. (5).

Equation (30) is said to be a Modified Lagrange's Equation. By comparing Eq. (1) and (30) we can see that the approximate value for the Lagrangian multiplier is given by:

A = A (e + Kbe + Kpe . (31)

Note that [6], the term eqA(KDe+KPe-£) in Eq. (30) represents the projection in the direction of the coordinates q of all the internal forces that are generated by the dynamic system when the constraints e, <9 and e are violated.

Equation (30) forms a modified Lagrange's equations given in Eq. (1). The advantages of formulation (30) are due to the inherent features of the leading matrix M + eq^eq. For any possibly varying number of constraints on the system, including the case of redundant constraints, the dimension of (M + eq^eq) is n x n. In other words, this sum is always positive definite matrix.

Remark 4.

1. In the modified Lagrange's equation given by equation (30) the problem of choosing the entries of A, Kd and Kp still persists.

2. The modified Lagrange's equation developed in this paper is similar to penalty method of constraint stabilization developed in [5,6]. The basic difference is, in this paper we use symmetric positive definite matrices A, K^ and Kp. This is helps us to use different correction parameters in contrary to the same correction parameters say, used in penalty method. The same difference exists between Generalized Baumgarte's method developed in this paper and Baumgarte's method in [4].

Example 1. Consider a two-link manipulator, L1 = I, L2 = 1/2, m2 = m, m1 = 2m2 = 2m as shown in Figure 1. Let us assume that point P follows the horizontal line y = 1/2 with a constant velocity along the £-axis. We can expect that for q1 = k/2 and q2 = n the system Jacobian matrix becomes singular. We apply the two methods constructed above to simulate the system. In this example it is verified that, simulating by the Modified Lagrange's method developed in this paper solved the problem of singularity at the indicated points, whereas, the Generalized Baumgarte's method is unable to run the simulation in this example at the singularity points.

The generalized coordinates are taken to be q = {q1, q2} as indicated above.

Notations: The following notations are used in this example.

C1 = cos(^1), C 2 = cos(q2), S1 = sin(^1), S 2 = sin(q2),

C12 = cos(^i + q2), S 12 = sin(gi + 'h 0\ fp 0^

= (S 0) ■ = (s

0 ry r sy

The constraint equations are y = 1/2 for point P, and the velocity constraint to keep point P at a constant velocity on the ^-axis starting from the position x = x0 at t = 0.

Figure 1. Two-link manipulator

Thus the constraints are: 0 = (©i, ©2)T given by:

01 (qi, q2, t) = IS1 + ¿/25*12 - 1/2 = 0,

©2 (qi, 02, t) = IC1 + 1/2C12 + vt-xo = 0. The constraint equation at the acceleration level becomes:

(© :)_(

IC1 + 1/2C12 1/2C12 \ / qi\ iqi2lS1 + l/2S!2(qi + q2)2 -lS1 - 1/2S12 -I/2S12^ V (¡2) - Vql2lC1 + 1/2C 12( q, + fa)2

Ö )2 A fc)V

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

(32)

Expression (16) is given

© + KDd + KP © =

ZC1 + 1/2 C12 l/2C12\/q\\ /fa2lS1 + l/2S12(fa + fa)2\ -IS1 - 1/2S12 -I/2S12^ V (¡2) - Vfa2lC1 + 1/2C 12( fa + fa)2) +

+ fal C1 + 1/2C 12( fa + fa)

+ D 1 -IfaS 1 - l/2S12(qi + fa) + v)

+ KP

lS1 + 1/2S12 - 1/2

v IC1 + 1/2 C12 + v t-xo defined in Eq. (20) for this example becomes:

(falS1 + 1/2S 12(fa + fa) 1/2S 12(qi + fa)\ ffa \falC1 + 1/2C 12(fa + fa) 1/2C 12( qi + (¡2)) V fa

) _ (2)

h( fal C1 + 1/2 C 12( qi + fa)) r(-lqiS 1 - J/2S12(gi + (¡2) + v)

p(IS1 + 1/2S12 - 1/2) N s( IC1 + 1/2 C12 + v t-xo)y

M _ /1/2mZ2 + h + I2 1/Aml2C2 + M _ V 1 /Ami2C2 + I2 1 /16mZ2 + I2 ) IC1 + 1/2 C12

©, _

C1 + /2 C12 /2 C12 - S1 - /2 S12 - /2 S12

Q

(1/Am12fa(qi + q2 sin(- 2mgl sin(qi)N \ -1/Am 12 sin(q2) - 1/AmgZsin(qi + q2) ,

I. Simulation by Generalized Baumgarte's Method.

In the case of Generalized Baumgarte's method, we use Eq. (21) and simulate the state-space form of system of first order differential equation given in the form:

d q

dt A

[M-1[Q - (eq(eqM-1eq)-1(eqM-1q - s))].j

(33)

Let us use the following values for numerical investigation m1 = 2 kg, m = m2 = 1 kg, I1 = 1/12m1l2 = 0.167 kgm2 I2 = 1/12rn2I2 = 0.208 kgm2. The initial angular position for link 1 and 2 are respectively 1.396263 rad. and 3.563268 rad. From these we can find that x0 = 0.295953m. The initial angular velocities are chosen to be 0.358620 and -0.867745 rad/s to set the initial velocity of the velocity constraint close to zero. Note that singularity point occurs in the Jacobian matrix eq at q1 = ^/2 and q2 = n.

We consider the following cases.

Case 1: Simulation graph (Fig. 2) with stabilization constants h = 20; r = 10; p = 100; s = 25. At the time when the simulation of the system reaches the singular point of q1 = ^/2 and q2 = In Fig. 2 there is a failure of the simulation t = 4.067105e + 0. That verifies, the generalized Baumgart's method can't run simulations near the singular points. This problem is circumvented by Modified Lagrange's Equation method as shown in the subsequent parts of this example.

Figure 2. Simulation graph with stabilization constants

h = 20; r =10; p = 100; s = 25

II. Simulation by Modified Lagrange's Equation method of Eq. (30).

In this case we simulate the state-space form of system first order differential equation given in by: for simplicity we use A = al where I is an identity matrix of appropriate size.

d q

dt

(m + eq«eq)-i[q - ela(kde + kpe - £)]._

(34)

Note that: the difficult of choosing appropriate penalty numbers is observed in the following graphs and the simulation for different numbers is shown. The overall result is that the system is asymptotically stable and the problem of running the simulation near and at the singular points is totally removed in this method.

Case I. Modified Lagrange's Equation graph (Fig. 3) for h = 20; r = 10; p = 100; s = 25; a = 10.

Case 2: Modified Lagrange's Equation graph (Fig. 4) for h = 20, r = 10, p = 100, s = 250, a = 3

Case 3: Modified Lagrange's Equation graph (Fig. 5) for h = 20; r = 10; p = 10; s = 2500; a = 50

Figure 3. Modified Lagrange's Equation graph

for h = 20; r =10; p = 100; s = 25; a =10

■21_I_!_I_I_I_I_I_!_I_

0 2 4 ê 3 10 12 14 16 18 20

lime t

Figure 4. Modified Lagrange's Equation graph

for h = 20, r =10, p = 100, s = 250, a =3

;

.2i-1-1-1-1-1-1-1-1-1-

0 2 4 6 8 10 12 14 16 18 20

time t

Figure 5. Modified Lagrange's Equation graph

for h = 20; r =10; p = 10; s = 2500; a = 50

It was observed during simulation experimentation that, choosing alpha too high makes the system unstable. More appropriate scalars can be chosen by running the simulation for different values of the constants.

4. Conclusion

The generalized penalty method developed in this paper circumvents the issue of redundant constraints and singular mass matrices where as, the generalized Baum-garte's method fails to run near singular points as shown in the example. But it can be concluded that the two methods developed have equivalent effect on a dynamic systems with non-singular mass matrices. The method developed in this paper improves the usual Baumgarte's method and the penalty method in that it made the possibility of using different correction parameters.

References

1. R. G. Mukharlyamov, Equations of Motion of Mechanical Systems, Peoples' Friendship University of Russia, Moscow, 2001, (In Russian).

2. R. G. Mukharlyamov, Numerical Modeling in Problems of Mechanics, Bulletin of PFUR. Series Mathematics, Information Science, Physics (1), (In Russian).

3. R. G. Mukharlyamov, On the Equations of Kinematics and Dynamics of Constrained Mechanical Systems, Multibody System Dynamics (6) (2001) 17-28, (in English).

4. J. Baumgarte, Stabilization of Constraints and Integrals of Motion in Dynamical Systems, Computer Methods in Applied Mechanics and Engineering (1) (1972) 1-16, (in English).

5. E. Bayo, R. Lendesma, Augmented Lagrangian and Mass-Orthogonalprojection Methods for Constrained Multibody Dynamics, Applied Mathematics and Mechanics (9) (1996) 113-130.

6. G. de Jalon, E. Bayo, Kinematic and Dynamic Simulation of Multi- body Systems: The Real-Time Challenge, Springer, Berlin, 1994.

7. T. D. Chernet, Constructing Dynamic Equations of Constrained Mechanical Systems, Bulletin of PFUR. Series Mathematics, Information Science, Physics (3) (2013) 92-104.

8. R. G. Mukharlyamov, Stabilization of the Motions of Mechanical Systems in Prescribed Phase-Space Manifolds, Applied Mathematics and Mechanics 70 (2006) 210-222.

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

УДК 531.3

Стабилизация избыточно ограниченной динамической

системы

Р. Г. Мухарлямов, Ч. Т. Дересса

Кафедра теоретической физики и механики Российский университет дружбы народов ул. Миклухо-Маклая, д. 6, Москва, Россия, 117198

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

кинетической энергии. Как и в случае метода Баумгарта, обычное уравнение Лагранжа является частным случаем более совершенного метода, описанного в данной статье. Численный пример иллюстрирует эффективность разработанных методов. Предлагаемый метод моделирования обеспечивает асимптотическую устойчивость решения уравнений динамики по отношению к уравнениям связей также в сингулярном случае.

Ключевые слова: стабилизация, обобщённый метод Баумгарта, модифицированные уравнения Лагранжа, сингулярная массовая матрица, избыточные ограничения, прямой метод Ляпунова.

Литература

1. Мухарлямов Р. Г. Уравнения движения механических систем. — Москва: РУДН, 2001.

2. Мухарлямов Р. Г. Численное моделирование в задачах механики // Вестник РУДН. Сер. «Прикладная математика и информатика». — 1995. — № 1.

3. Mukharlyamov R. G. On the Equations of Kinematics and Dynamics of Constrained Mechanical Systems // Multibody System Dynamics. — 2001. — No 6. — Pp. 1728.

4. Baumgarte J. Stabilization of constraints and integrals of motion in dynamical systems // Computer Methods in Applied Mechanics and Engineering. — 1972. — No 1. — Pp. 1-16.

5. Bayo E., Lendesma R. Augmented Lagrangian and Mass-Orthogonalprojection Methods for Constrained Multibody Dynamics // Applied Mathematics and Mechanics. — 1996. — No 9. — Pp. 113-130.

6. de Jalon G., Bayo E. Kinematic and Dynamic Simulation of Multi-body Systems: the Real-Time Challenge. — Berlin: Springer, 1994.

7. Chernet T. D. Constructing Dynamic Equations of Constrained Mechanical Systems // Bulletin of PFUR. Series Mathematics, Information Science, Physics. — 2013. — No 3. — Pp. 92-104.

8. 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.

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

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