Khảo sát động lực học và điểu khiển vị trí của tay máy hai khâu đàn hồi phẳng theo phương pháp phần tử hữu hạn

MINISTRY OF EDUCATION AND TRAINING MINISTRY OF NATIONAL DEFENCE MILITARY TECHNICAL ACADEMY DUONG XUAN BIEN DYNAMIC MODELLING AND CONTROL OF TWO-LINK FLEXIBLE ROBOTS BY USING FINITE ELEMENT METHOD DOCTOR OF PHILOSOPHY HA NOI, 2019 MINISTRY OF EDUCATION AND TRAINING MINISTRY OF NATIONAL DEFENCE MILITARY TECHNICAL ACADEMY DUONG XUAN BIEN DYNAMIC MODELLING AND CONTROL OF TWO-LINK FLEXIBLE ROBOTS BY USING FINITE ELEMENT METHOD Major: Technical mechanic Code: 9.52.01.03 DOCTOR OF PHILOSOPHY SCIENCE SUPERVISORS: Associate Prof, Dr Chu Anh My Associate Prof, Dr Phan Bui Khoi HA NOI, 2019 ACKNOWLEDGMENTS I would like to express my deepest gratitude to Professor Chu Anh My and Professor Phan Bui Khoi for their support, dedicated guide and research orientation on this work I wish to thank all my colleagues from Advanced Technology Center, Faculty of Mechanical Engineering, Faculty of Aerospace in Military Technical Academy and School of Mechanical Engineering in Hanoi University of Science and Technology for the help they gave me in the many different occasions The greatly appreciation is to my family for their love and support Last but not least, I would like to thank all the others that are not mentioned and helped me on this thesis CONFIRMATION BY AUTHOR I pled that this thesis is my own research work The results presented in this work are honest and has not been published by anyone in any other works The information cited in this thesis is clearly stated origins August, 2019 Duong Xuan Bien LIST OF SYMBOLS AND ABBREVIATIONS Li , lie Length of link i , length of each element of link i i Angle between link i − and link i Number of links of robot, number of elements of link i n, ni ,i (t ) and joint variable of link i x Arbitrary point on the element j of link i m (x ), m =  Shape functions of element j Elastic displacement at arbitrary point on element j of wij (t, x ) link i ui (2 j −1), ui(2 j ), ui (2 j +1), ui (2 j +2) Flexural displacement, slope displacement of node j ui (2n +1), ui (2n + 2) Flexural and slope displacement at end point of link i i i and node j + of element j of link i , respectively u(i −1)(2k −1), u(i −1)(2k ), Flexural and slope displacement at node k and node u(i −1)(2k +1), u(i −1)(2k +2) k + of element k of link i − u(i −1)f , u(i −1)s Flexural and slope displacement at the end point of link i −1 General homogeneous transformation matrix which Hif(i −1) transforms from the coordinate system Oi XY to the i i coordinate system Oi −1Xi −1Yi −1 rij , r0ij r02r , r02 f Position vector of arbitrary point on the element j of link i in the coordinate systems Oi XY and O0X 0Y0 i i Position vector of the end point of link in cases of rigid and flexible models in the coordinate system O0X 0Y0 di (t ), i (t ) qijcv (t ), qicv (t ) qij (t ), qi (t ), q(t ) mi , mdci , mt Tij ,Ti ,T Tie ,Tid ,Tp Translational and rotational joint variable of link i Elastic displacement vector of the element j of link i and elastic displacement vector of link i Generalized elastic displacement vectors of the element j , of the link i and of the system Mass per length unit of link i , mass of motor i , mass of the tip load Kinetic energy of element j of link i , kinetic energy of link i and kinetic energy of system Elastic deforming kinetic energy of link i , kinetic energy of motor driving link i and the tip load Elastic deforming potential and gravitational potential Pije , Pijg , Pi , P energy of element j of link i , potential energy of link i and the system Mj , Mi , M Mass matrix of element j , link i and system Mdc , Mtt Mass matrices of the motor and the tip load Kj , Ki , K Stiffness matrix of element j , link i and system C(q, q) Coriolis matrix Qex (t ) Generalized force/torque vector of the system Fi (t), i (t ) Driving force, torque at the joint i e*(t ), e(t ),V KP , KI , KD Joint variable error vector, error vector in objective function and Lyapunov function Cross matrix of control parameters in PID controller TABLE OF CONTENTS Pages PREFACE CHAPTER LITERATURE REVIEW OF FLEXIBLE ROBOT DYNAMIC AND CONTROL 1.1 Applications of flexible robots 1.2 Classifying joint types of flexible robots 1.3 Classifying flexible robots 11 1.4 Modeling methods 13 1.5 Differential motion equations 14 1.6 Recent works on flexible robots 15 1.7 Position accuracy of motion of flexible robots 19 1.8 Comments and problems 20 Conclusion of chapter 21 CHAPTER DYNAMIC MODELING OF THE PLANAR FLEXIBLE ROBOTS 22 2.1 Kinematic of the planar flexible robots 22 2.2 Dynamics of the planar flexible robots 38 Conclusion of chapter 58 CHAPTER DYNAMIC ANALYSIS AND POSITION CONTROL OF THE PLANAR TWO-LINK FLEXIBLE ROBOTS 59 3.1 Boundary conditions 59 3.2 Forward dynamic 61 3.3 Inverse dynamic 79 3.4 Position control system of the planar serial multi-link flexible robots 86 Conclusion of chapter 99 CHAPTER EXPERIMENT 101 4.1 Objective and experimental model 101 4.2 Parameters, equipment and method of measuring 103 4.3 System connection diagram 105 4.4 Experimental orders 107 4.5 Method of handling the measurement data 108 4.6 Experimental results 110 Conclusion of chapter 115 CONCLUSION AND SUGGESION 116 LIST OF THE RESEARCH PAPERS OF THE AUTHOR 118 REFERENCES 121 APPENDICES 139 LIST OF TABLES Table The parameters  i , u(i 1)s , u(i 1) f , i , a i depending on types of joints 26 Table The dynamic parameters of flexible robot type I (continuous) 65 Table The mass ratios between the flexible links and tip load 67 Table 3 The maximum elastic displacements at the ending points of the links 67 Table The parameters of the flexible robot type IV 70 Table The length of the links in two cases 71 Table The maximum values in two cases 74 Table The parameters of flexible robot type III 75 Table The parameters of the flexible robot type IV 92 Table The parameters of the GA and the position PID controller 93 Table 10 The comparative results the control quality between two cases 94 Table 11 The parameters of the GA and the position PID controller 96 Table 12 The comparative results the control quality between two cases 97 LIST OF FIGURES Figure The structure of the thesis Figure The order executing the thesis Figure 1 Flexible robots Figure The flexible robot in space Figure Flexible robot in medicine Figure Rotational joint Figure Translational joint type Pa Figure Translational joint type Pb Figure The single-link flexible robot with rotational joint 11 Figure The single-link flexible robot with translational joint 11 Figure The two-link flexible robots with only rotational joints 12 Figure 10 The two-link flexible robots consist translational joints 12 Figure 11 The planar serial multi-link flexible robots 12 Figure 12 The parallel-link flexible robots 13 Figure 13 The mobile fiexlible robots 13 Figure 14 Flexible planar closed mechanism [8] 15 Figure 15 Spring-mass system [45] 16 Figure 16 The single-link flexible robot with joint Pa [133] 17 Figure 17 The two-link flexible robot Quanser 17 Figure 18 The two-link flexible robot with rotational joints 17 Figure 19 The flexible robot with rotational and translational joints 18 Figure A generalized schematic of an arbitrary pair of flexible links 23 Figure 2 Structure I 29 Figure Structure II 30 Figure Structure III 31 Figure Structure IV 32 Figure Structure V 33 Figure Structure VI 34 Figure Structure VII 35 ... of planar flexible robots based multi-bodies dynamic, mechanically deformed body, finite element theory, control and numerical computation method The results of this research are referenced in... position of planar flexible robots The control law is determined and stably proved based on Lyapunov’s theory The parameters of controller are found by using genetic algorithm - A flexible robot is designed... evaluate results of calculations The contents can be shown as Fig 0.1 Methodology The researching theory, numerical calculation and experimental method are used to execute the contents of dissertation