Dynamic Model of Flexible Link Manipulators with Translational and Rotational Joints

Mathematical model of two flexible manipulators with translational and rotational joints has been presented based upon finite element method and Lagrange equations. T-R model is the new model which is developed from single flexible link manipulator with only rotational joint. R-T model shows difference points between translational joint and rotational joint.

pdf7 trang | Chia sẻ: huongthu9 | Lượt xem: 541 | Lượt tải: 0download
Bạn đang xem nội dung tài liệu Dynamic Model of Flexible Link Manipulators with Translational and Rotational Joints, để tải tài liệu về máy bạn click vào nút DOWNLOAD ở trên
Journal of Science & Technology 127 (2018) 022-028 22 Dynamic Model of Flexible Link Manipulators with Translational and Rotational Joints Bien Xuan Duong1,*, My Anh Chu1, Khoi Bui Phan2 1 Military Technical Academy, No. 236, Hoang Quoc Viet, Cau Giay, Hanoi, Viet Nam 2Hanoi University of Science and Technology, No. 1, Dai Co Viet, Hai Ba Trung, Hanoi, Viet Nam Received: August 10, 2017; Accepted: June 25, 2018 Abstract In this paper, two nonlinear dynamic models of flexible manipulator with translational and rotational joints are formulated based on Finite Element Method (FEM). Dynamic equations of manipulators are derived by using Lagrange equations. The new model TR (Translational-Rotational) is developed based on single flexible link manipulator with only rotational joint. The difference between flexible manipulators which have only rotational joints and others with translational joint is presented in RT model. Dynamic behaviors of flexible manipulators are analyzed through values of joints variable and elastic displacements at the end-effector point. The numerical simulation results are calculated by using MATLAB/SIMULINK toolboxes. The results of this study play an important role in modeling generalized planar flexible two-link robot, in designing the control system and basing on select the suitable structure robot with the same request. Keywords: Dynamic model, flexible link, translational joint, elastic displacements 1. Introduction1 Years ago, a number of researches focused on the flexible manipulator. Most of the investigations on the dynamic modeling of robot manipulators with elastic arms have been confined to manipulators with only revolute joints. Combining such systems with translational joints enables these robots to perform manipulation tasks in a much larger workspace, more flexibility and more applications. The flexible robot arm constructed with couples of rotational– translational joints (R-T/T-R joints) challenge the modeling and analysis for the robot. The two main methods for dynamic modeling of flexible link manipulators are the FEM and assumed mode method (AMM). Although the AMM has been used widely to model and analyze flexible links manipulators but most of studied have only considered the rotational joints. The FEM is a general method and it can be applied to the manipulators with complexly shaped links. This technique is used of this paper. Few authors have studied the manipulator with only translational joint. Wang and Duo Wei [1] presented a single flexible robot arm with translational joint. Dynamic model analysis is based on a Galerkin approximation with time dependent basis functions. They also proposed a feedback control law in [2]. Kwon and Book [3] present a single link robot which is described and modeled by * Corresponding author: Tel.: (+84) 166.7193.567 Email: xuanbien82@yahoo.com using assumed modes method (AMM). Other authors have focused on the flexible manipulator with a link slides through a translational joint with a simultaneous rotational motion (R-T robot). Pan et al [4] presented a model R-T with FEM method. The result is differential algebraic equations which are solved by using Newmark method. Yuh and Young [5] proposed the partial differential equations with R- T system by using AMM. Al-Bedoor and Khulief [6] presented a general dynamic model for R-T robot based on FEM and Lagrange approach. They defined a concept which is translational element. The stiffness of translational element is changed. The translational joint variable is distance from origin coordinate system to translational element. The number of element is small because it is hard challenge to build and solve differential equations. Khadem [7] studied a three-dimensional flexible n-degree of freedom manipulator having both revolute and translational joint. A novel approach is presented using the perturbation method. The dynamic equations are derived using the Jourdain’s principle and the Gibbs- Appell notation. Korayem [8] also presented a systematic algorithm capable of deriving equations of motion of N-flexible link manipulators with revolute- translational joints by using recursive Gibbs-Appell formulation and AMM. In this work, two nonlinear dynamic models of flexible manipulator with translational and rotational joints are presented based on using FEM and Lagrange equations. The flexible link is assumed Euler-Bernoulli beam. The first model is shown in Journal of Science & Technology 127 (2018) 022-028 23 fig. 1 (called T-R model). The second model is presented in fig. 2 (called R-T model). Flexible link slides through the base of translational joint which rotates at the fixed point. Both motion on horizontal plane and ignore the effect of gravity and structure damping. The boundary conditions of both are differently. The differences between flexible manipulators which have only rotational joints and others with translational joint are mentioned. Furthermore, T-R model has not been mentioned yet. 2. Dynamic modeling 2.1. General equations of motion In both model, the coordinate system XOY is the fixed frame. The translational joint variable ( )d t is driven by force ( )TF t . The rotational joint variable ( )q t is driven by torque ( )t . Both joints are assumed rigid. Flexible link is divided n elements. Elements are assumed interconnected at certain points which are known as nodes. Each element has two nodes. Each node of element j has 2 elastic displacement variables which are flexural ( 2 1ju − ) and slope displacements ( 2 ju ). Fundamentally, the dynamic equations motion relies on the Lagrange equations with Lagrange function L T P= − are given by [9] ( ) ( ) ( ) T T d L L t dt tt      − =          F QQ (1) Where, T and P are kinetic and potential energy of system. External generalized forces vector is defined as ( ) ( ) ( )1 2 0 . . 0 0 T t F t F t=   F (2) Specific generalized coordinate vector is given by ( ) ( ) ( )1 2 1 2 1 2 2. . T n nt q t q t u u u+ +=   Q (3) Elastic displacements vector of element j is ( ) 2 1 2 2 1 2 2 T j j j jj t u u u u− + + =  Q (4) In T-R case, driving forces and joints variables are ( ) ( ) ( ) ( ) ( ) ( ) ( ) ( )1 2 1 2; ; ;TF t F t F t t q t d t q t q t= = = = Kinetic and potential are T RT T −= and T RP P −= . In R-T case, respectively, 1 2( ) ( ); ( ) ( )TF t t F t F t= = , 1 2( ) ( ); ( ) ( )q t q t q t d t= = and , R T R TT T P P− −= = . When kinetic and potential energy are known, it is possible to express Lagrange equations as shown ( ) ( ) ( )tM Q Q+C Q,Q Q+KQ = F (5) Coriolis force are calculated as ( ) ( ) ( ) 1 , . . . 2 T = −     C Q Q Q M Q Q Q MQ Q (6) Structural damping is ignored in this paper. Mass matrix M and stiffness matrix K are calculated by using FEM theory in each detail case, respectively. Size of matrices ,M K and C is (2 4) (2 4)n n+  + and size of ( )tF and ( )tQ is (2 4) 1n+  . 2.2. The T-R configurations The T-R model is shown as fig. 1. The translational joint moves along its axis. The translational joint variable ( )d t is distance from origin point of fixed coordinate to position of translational joint. Coordinate system 1 1 1X OY is attached to end point of link 1. Coordinate system 2 2 2X O Y is attached to first point of link 2. Link 1 with length 1L is assumed rigid and link 2 with length 2L is assumed flexibility. Symbol tm is mass of payload on the end-effector point. Coordinate 01r of end point of link 1 on XOY is computed as ( )01 1 T L d t=   r . Coordinate 2 jr of element j on 2 2 2X O Y can be found as ( ) ( )2 j1 , ;0 T j e j j j ej l x w x t x l = − +   r . Where, length of each element is 2 e L l n = and ( ) ( ) ( ),j j j j jw x t x t=N Q is total elastic displacement of element. The vector of shape function ( )j jxN is presented in [9]. Coordinate of element j on 1 1 1X OY is 1 21 2 2.j j=r T r . Where, ( ) ( ) ( ) ( ) 1 2 cos sin sin cos q t q t q t q t  −  =     T is transformation matrix from 2 2 2X O Y to 1 1 1X OY . Fig. 1. T-R model Journal of Science & Technology 127 (2018) 022-028 24 Coordinate 02 jr of element j on XOY is 02 01 21j j= +r r r . Coordinate 0Er of end point of flexible link 2 on XOY can be computed as ( ) ( ) ( ) ( ) ( ) 1 2 2 1 0 2 2 1 cos sin sin cos nT R E n L L q t u q t d t L q t u q t +− + + −  =   + +   r (7) If assumed that robot with all of links are rigid, coordinate 0 _ T R E rigid − r on XOY is given as ( ) ( ) ( ) 0 _ 1 2 2 cos sin E rigid TT R L L q t d t L q t− = + +  r (8) The kinematic energy of rigid link 1 can be computed as 1 1 01 01 1 . . 2 T R TT m− = r r . Where, symbol 1m is the mass of first link. Kinetic energy of element j is determined as ( ) ( ) ( ) 02 02 2 2 0 2 1 2 1 2 e T l j jT R j j T T R T R T R T R j jg j jg T m dx t t T t t − − − − −      =          =  r r Q M Q (9) Where, 2m is mass per meter of link 2. Generalized elastic displacement vector of element j is given as ( ) ( ) ( ) 2 1 2 2 1 2 2 T T R jg j j j jt d t q t u u u u − − + +  =  Q (10) Each element of inertial mass matrix T R j − M can be computed as ( ) 02 022 0 , ; , 1,2,..,6 e T l j jT R j j js je s e m dx Q s e Q −      =             =  r r M (11) Where, jsQ and jeQ are the , th ths e element of ( )T Rjg t − Q vector. It can be shown that T R j − M is of the form rr rfT R j fr base −   =     M M M M M (12) Where, matrix baseM is the base mass matrix which is given as 2 2 2 2 2 2 2 3 2 3 2 2 2 2 as 2 2 2 2 2 2 2 3 2 3 2 2 2 2 13 11 9 13 35 210 70 420 11 1 13 1 210 105 420 140 9 13 13 11 70 420 35 210 13 1 11 1 420 140 210 105 e e e e e e e e b e e e e e e e e e m l m l m l m l m l m l m l m l m l m l m l m l m l m l m l m l   −     −   =    −      − − −   M ( 3) Matrix 11 12 21 22 rr m m m m   =     M has elements which are computed as ( ) ( ) ( ) ( ) ( ) ( ) 11 2 12 21 2 2 2 12 2 2 1 2 1 2 2 2 2 2 2 2 2 2 2 2 1 2 2 1 2 2 22 2 2 2 1 2 . ; ; sin sin 1 12cos 6sin 12 6sin 6cos 210 ( 1) (2 3 2 ) 22 ( )1 210 13 ( e e j e j e e j j e e e j j j j e j j j j e e j j j m m l m m q l u q l u m m l q jl q u q u q l l j j l u u u u l u u u u m m l l u u u + − + + + − + + + = =  −   = − − +    + +  − + − + + − = + − 21 2 2 2 2 2 1 2 1 2 1 2 1 ) 70 78( ) 54 j e j j j j u l u u u u − + − + − +         +    + + +  (14) Matrix 13 14 15 16 23 24 25 26 T rf fr m m m m m m m m   = =     M M has elements which are computed as 2 13 15 2 14 2 2 16 14 23 2 3 2 24 2 25 2 3 26 2 1 1 cos ; cos ; 2 12 1 ; (10 7); 20 1 1 (5 3); (10 3); 60 20 1 (5 2); 60 e e e e e e m m m l q m m l q m m m m l j m m l j m m l j m m l j = = = = − = − = − = − = − − (15) Total elastic kinetic energy of link 2 is yielded as ( ) ( ) ( )2 1 1 2 n T T R T R T R T R T R e j e j T T t t− − − − − = = = Q M Q (16) The mass matrix T R e − M is constituted from matrices of elements follow FEM theory, respectively. The generalized coordinate vector of system is defined as ( ) ( ) ( ) 1 2 1 2 2. . TT R n nt d t q t u u u − + +=   Q (17) Kinetic energy of payload is ( )0 0 1 . . 2 T T R T R T R P t E ET m − − −= r r and kinetic energy of system is determined as ( ) ( ) ( ) 1 1 2 T R T R T R T R e P T T R T R T R T R T T T T T t t − − − − − − − − = + + = Q M Q (18) Matrix T R− M is total mass matrix. The gravity effects can be ignored as the robot movement is confined to the horizontal plane. Defining E and I are Young’s modulus and area moment of inertia link 2. Elastic Journal of Science & Technology 127 (2018) 022-028 25 potential energy of element j with stiffness matrix baseK which is presented as [9] is given as ( ) 2 2 20 ,1 2 1 ( ) ( ) 2 el j jT R j j j T R T T R j j j j w x t P EI dx x P t t − − −    =    =  Q K Q (19) Stiffness matrix of element j is defined as 0 0 0 0 0 0 0 0 T R j base −    =      K K (20) Where, 3 2 3 2 2 2 as 3 2 3 2 2 2 12 6 12 6 6 4 6 2 12 6 12 6 6 2 6 4 e e e e e ee e b e e e e e e ee e EI EI EI EI l l l l EI EI EI EI l ll l EI EI EI EI l l l l EI EI EI EI l ll l   −      −   =   − − −      −     K (21) Total elastic potential energy of system is yielded as ( ) ( ) ( ) 1 1 2 n T T R T R T R T R j j P P t t− − − − = = = Q K Q (22) Total stiffness matrix T R− K is constituted from matrices of elements follow FEM theory similar T R− M matrix, respectively. 2.3. The R-T configurations The R-T model is shown as fig. 2. Flexible link 2 is divided n elements. The position of elements k continuously changes through translational joints. The angle 0 is the angle between 1 1O X and 2 2O X . The translational joint variable ( )d t is the distance from element k at the origin coordinate system to the end point of link 2. The value of k depends on time. The position of other elements is changed, too. Total length of flexible link 2 is 2L . Length of each element is 2 e L l n = . Element k is inside the hub of the translational joint and we have contact formulas ( )2ek.l = L - d t . Effect of the length of hub is ignored. Fig. 2. R-T model It is noteworthy to mention that value of k is the number of position element k . So, it must be take raw value of k in computing process. Coordinate jr on 2 2 2X O Y of element j is ( ) ( ) ( )2 j1 , T j e j jj l L d t x w x t = − − + + r and on XOY is 0 2 0 01 1 1. .j j= +r r T T r . Transformation matrix 1 0T between XOY and 1 1 1X OY is ( ) ( ) ( ) ( ) 0 1 cos sin sin cos q t q t q t q t  −  =     T . Transformation matrix 2 1T between 1 1 1X OY and 2 2 2X O Y is 0 02 1 0 0 cos sin sin cos     −  =     T . Coordinate of end point of link 1 on XOY is  01 1 1.cos ( ) .sin( ) T L q t L t=r . Coordinate of end-effector is given as ( ) ( ) ( ) ( ) ( ) ( ) 1 2 1 0 1 2 1 .cos .sin .sin .cos nR T E n d t L q t u q t d t L q t u q t +− +  + −    =  + +    r (23) If assumed that link 2 is rigid, coordinate 0 _ R T E rigid − r on XOY is given as ( ) ( ) ( ) ( ) 1 0 _ 1 .cos .sin R T E rigid d t L q t d t L q t −  +   =   +     r (24) Kinetic and potential energy of R-T system are calculated by using the same method in T-R case ( ) ( ) ( ) ( )0 0 1 1 . . 2 2 R T R T R T e P T T R T R T R T R T R T R T e t E E T T T T t t m − − − − − − − − − = + = +Q M Q r r (25) Journal of Science & Technology 127 (2018) 022-028 26 ( ) ( ) ( ) 1 1 2 n T R T R T R T R T R T j j P P t t− − − − − = = = Q K Q (26) Where, R T eT − is the elastic kinetic and R T PT − is kinetic energy of payload. Mass matrix R Te − M and stiffness matrix R T− K can be calculated by using FEM theory following mass and stiffness matrices of all elements. Mass matrix of element j with mass per meter 2m is given as T R j − M at recipe (12). It noted that baseM is the same but others elements are difference. They are computed as ( ) ( )( ) ( )( ) ( )( ) ( ) 11 12 2 2 2 2 2 1 2 1 13 2 1 2 2 14 2 1 2 15 2 1 2 2 16 2 1 2 ( , , , , ( ), ( )); 1 6 6 12 1 10 10 10 10 7 20 1 5 5 5 5 3 60 1 10 10 10 10 3 20 1 5 5 5 5 2 60 j e e j e j j j e e e e e e e e e e e m f m le j L d t Q t m m l l u l u u u m m l jl d t L L l m m l jl d t L L l m m l jl d t L L l m m l jl d t L L l + − + = = − − + + = + + − − = + + − − = + + − − = − + + − −( ) 22 23 24 25 26. ; 0; e em m l m m m m= = = = = (27) Matrices R T base − M and R T j − K have format as T R base − M , T R j − K . 3. Boundary conditions In T-R case, rotational joint of link 2 is constrained so that elastic displacements of first node of element 1 on link 2 can be zero. Thus variables 1 2,u u are zero. The rows and columns 3 th, 4th of matrices , ,M K C and ( ) ( ),t tF Q vectors are eliminated as presented in FEM theory. In R-T case, the displacements of element k are zero because assumed that the translational joint hub is treated as rigid. The rows and columns ( ) ( )2 1 ; 2 th th k k− of matrices , ,M K C and ( ) ( ),t tF Q vectors are eliminated and values of these are changed, too. It is noteworthy to mention that value of k depends on time. This boundary condition is clearly different point between flexible link manipulator with only rotational joints and flexible link manipulator with combine translational joint and rotational joint. So now, size of matrices ,M K,C is ( ) ( )2 2 2 2n n+  + and ( )2 2 1n+  is size of ( )tF and ( )tQ vector. The k variable is continuously updated for each time step in solving process. Vector generalized coordinate ( )tQ is rebuilt after each loop too because of changing value k variable. 4. Simulation results Simulation specifications of two flexible models are given by Table. 1. Table 1. Parameters of dynamic models Property T-R model R-T model Length of link 1 (m) L1=0.1 L1=0.2 Mass of link 1 (kg) m1=1.4 m1=0.9 Flexible link parameters Length of flexible link (m) L2=0.3 L2=0.8 Width (m) b=0.03 b=0.01 Thickness (m) h=0.003 h=0.002 Number of element n=5 Cross section area (m2) (A=b.h) A=9.10-5 A=2.10-5 Mass density (kg/m3) =7850 Mass per meter (kg/m) (m2=.A) 0.7 0.157 Young’s modulus (N/m2) E=2.1010 Inertial moment of cross section (m4) I=b.h3/12=1.67.10-12 Mass of payload (g) mt=100 mt=20 Initial value at t=0 (m) 0 d0=0.4 β0 0 Simulation time (s) T=10 Dynamic equations (5) for both models are solved by using MATLAB/SIMULINK toolboxes with boundary conditions. The simulation results of T-R model are shown in fig. 3, fig. 4 and fig. 5. Driving force and torque of joints are built using Bang-Bang rule which are shown fig. 3. Driving time is 0.5(s). Dynamic behaviors of system are described through values of joint variables and elastic displacements in fig. 4 and fig. 5. Maximum values of translational and rotational joint are 0.075(m) and 0.24(rad). These values are shown in fig. 4. Elastic displacements at the end-effector point are presented in fig. 5. Maximum values of these displacements are 0.14(m) and 0.25(rad) at 0.6(s). These displacements are fast reduced after that with 0.02(m) and 0.035 (rad). The simulation results of R-T model are shown from fig. 6 to fig. 8. The Bang-Bang rule in fig. 6 is used for driving torque and force of joints. Fig. 7 shows values of joint variables. It note that value of rotational joint continuously increases while maximum value of translational joint increases from initial value 0.4(m) to 0.51(m) at 0.5(s). Values different of rotational joint between both models can Journal of Science & Technology 127 (2018) 022-028 27 be explained by effect of higher nonlinearity in R-T model, difference of boundary condition and direction of motion of flexible link when value of translational joint increase over time. Elastic displacements at the end-effector point are shown in fig. 8. Values of these displacements are smaller than T-R case. Fig. 3. Driving force and torque at joints of T-R model Fig. 4. Values of joint variables in T-R model Fig. 5. Value of elastic displacements at the end- effector point in T-R model Fig. 6. Driving torque and force at joints in R-T model Fig. 7. Values of joint variables in R-T model Fig. 8. Value of elastic displacement at the end- effector point in R-T model 5. Conclusion Mathematical model of two flexible manipulators with translational and rotational joints has been presented based upon finite element method and Lagrange equations. T-R model is the new model which is developed from single flexible link manipulator with only rotational joint. R-T model shows difference points between translational joint and rotational joint. These difference points are Journal of Science & Technology 127 (2018) 022-028 28 boundary conditions. The final models derived for the flexible robot are nonlinear and complex. Simulation results show that the response of flexible robots is unstable especial without effect of structure damping and needs to control. Moreover, the effects of structure damping and varying payload on dynamic characteristic of models have been studied and discussed. The results in this paper are helpful and important in development of modeling generalized planar flexible two-link robot which combines translational and rotational joints and designing control system. References [1] P. K. C Wang and Jin Duo Wei, Vibration in a moving flexible robot arm, Journal of Sound and vibration. 116 (1987) 149-160. [2] P. K. C Wang and Jin Duo Wei, Feedback control of vibrations in a moving flexible robot arm with rotary and prismatic joints, Proceedings of the IEEE International Conference on Robotics and Automation, Raleigh, North Carolina, March (1987) 1683-1689. [3] D. S. Kwon and W. J. Book, A time-domain inverse dynamic tracking control of a single link flexible manipulator, Journal of Dynamic Systems, Measurement and Control. 116 (1994) 193–200. [4] Pan. Y. C, Scott and R. A. Ulsoy, Dynamic modeling and simulation of flexible robots with translational joints, J. Mech. Design. 112 (1990) 307–314. [5] Yuh. J and Young. T, Dynamic modeling of an axially moving beam in rotation: simulation and experiment, Trans. ASME J. Dyn. Syst. Meas. Control. 113 (1991) 34–40. [6] Al-Bedoor. B. O and Khulief. Y. A, General planar dynamics of a sliding flexible link, Sound and Vibration. 206 (1997) 641–661. [7] S. E. Khadem and A. A. Pirmohammadi, Analytical development of dynamic equations of motion for a three-dimensional flexible manipulator with revolute and prismatic joints, IEEE Trans. Syst. Man Cybern. B Cybern. 33 (2003) 237–249. [8] M. H. Korayem, A. M. Shafei and S. F. Dehkordi, Systematic modeling of a chain of N-flexible link manipulators connected by revolute–prismatic joints using recursive Gibbs-Appell formulation, Springer- Verlag, Berlin Heidelberg, (2014). [9] M. O. Tokhi and A. K. M. Azad. Flexible robot manipulators-Modeling, simulation and control, The Institution of Engineering and Technology. London, UK (2008).

Các file đính kèm theo tài liệu này:

  • pdfdynamic_model_of_flexible_link_manipulators_with_translation.pdf