DYNAMIC ANALYSIS AND POSITION CONTROL OF THE PLANAR TWO-LINK FLEXIBLE ROBOTS.... The quality enhancementmodeling and controlling are mainly requested by researchers and designers.Because
Trang 1MINISTRY OF EDUCATION MINISTRY OF NATIONAL
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
Trang 2MILITARY 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:
1 Associate Prof, Dr Chu Anh My
2 Associate Prof, Dr Phan Bui Khoi
HA NOI, 2019
Trang 3I 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 MilitaryTechnical Academy and School of Mechanical Engineering in HanoiUniversity of Science and Technology for the help they gave me in the manydifferent 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 notmentioned and helped me on this thesis
Trang 4this work are honest and has not been published by anyone in any otherworks The information cited in this thesis is clearly stated origins.
August, 2019
Duong Xuan Bien
Trang 5LIST OF SYMBOLS AND ABBREVIATIONS
Length of link i , length of each element of link i
Angle between link i −1 and link i
Number of links of robot, number of elements of link and joint variable of link i
Arbitrary point on the element j of link i
Shape functions of element j
Elastic displacement at arbitrary point on element j
Flexural displacement, slope displacement of node j and
node j + 1 of element j of link i , respectively
Flexural and slope displacement at end point of link i
Flexural and slope displacement at node k and node
Trang 6and flexible models in the coordinate system O0X 0Y0
*
(t ), e(t ),V
e
KP,KI ,KD
Trang 7the 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 potentialenergy of element j of link i , potential energy of link i
and the systemMass matrix of element j , link i and system.
Mass matrices of the motor and the tip loadStiffness matrix of element j , link i and system.
Coriolis matrixGeneralized force/torque vector of the system Driving force, torque at the joint i
Joint variable error vector, error vector in objective function and Lyapunov function
Cross matrix of control parameters in PID controller
Trang 8PREFACE 1
CHAPTER 1 LITERATURE REVIEW OF FLEXIBLE ROBOT DYNAMIC
AND CONTROL 7
1.1 Applications of flexible robots 7
1.2 Classifying joint types of flexible robots 8
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 1 21
CHAPTER 2 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 2 58
CHAPTER 3 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 3 99
CHAPTER 4 EXPERIMENT 101
4.1 Objective and experimental model 101
4.2 Parameters, equipment and method of measuring 103
4.3 System connection diagram 105
Trang 94.4 Experimental orders 107
4.5 Method of handling the measurement data 108
4.6 Experimental results 110
Conclusion of chapter 4 115
CONCLUSION AND SUGGESION 116
LIST OF THE RESEARCH PAPERS OF THE AUTHOR 118
REFERENCES 121
APPENDICES 139
Trang 1026
Table 3 1 The dynamic parameters of flexible robot type I (continuous) 65
Table 3 2 The mass ratios between the flexible links and tip load 67
Table 3 3 The maximum elastic displacements at the ending points of the links 67
Table 3 4 The parameters of the flexible robot type IV 70
Table 3 5 The length of the links in two cases 71
Table 3 6 The maximum values in two cases 74
Table 3 7 The parameters of flexible robot type III 75
Table 3 8 The parameters of the flexible robot type IV 92
Table 3 9 The parameters of the GA and the position PID controller 93
Table 3 10 The comparative results the control quality between two cases 94 Table 3 11 The parameters of the GA and the position PID controller 96 Table 3 12 The comparative results the control quality between two cases 97
Trang 11LIST OF FIGURES
Figure 0 1 The structure of the thesis 5
Figure 0 2 The order executing the thesis 5
Figure 1 1 Flexible robots 7
Figure 1 2 The flexible robot in space 8
Figure 1 3 Flexible robot in medicine 8
Figure 1 4 Rotational joint 9
Figure 1 5 Translational joint type P a 9
Figure 1 6 Translational joint type P b 9
Figure 1 7 The single-link flexible robot with rotational joint 11
Figure 1 8 The single-link flexible robot with translational joint 11
Figure 1 9 The two-link flexible robots with only rotational joints 12
Figure 1 10 The two-link flexible robots consist translational joints 12
Figure 1 11 The planar serial multi-link flexible robots 12
Figure 1 12 The parallel-link flexible robots 13
Figure 1 13 The mobile fiexlible robots 13
Figure 1 14 Flexible planar closed mechanism [8] 15
Figure 1 15 Spring-mass system [45] 16
Figure 1 16 The single-link flexible robot with joint P a [133] 17
Figure 1 17 The two-link flexible robot Quanser 17
Figure 1 18 The two-link flexible robot with rotational joints 17
Figure 1 19 The flexible robot with rotational and translational joints 18
Figure 2 1 A generalized schematic of an arbitrary pair of flexible links 23
Figure 2 2 Structure I 29
Figure 2 3 Structure II 30
Figure 2 4 Structure III 31
Figure 2 5 Structure IV 32
Figure 2 6 Structure V 33
Figure 2 7 Structure VI 34
Figure 2 8 Structure VII 35
Trang 12Figure 2 12 Parts of matrix M2j 143
Figure 3 1 The position of the element k and the robot type VII 60
Figure 3 2 The solving algorithm without the joint P b 63
Figure 3 3 The solving algorithm with the joint P b 63
Figure 3 4 The schematic of the solving forward dynamic on SIMULINK 64
Figure 3 5 The torque at joint 1 65
Figure 3 6 The torque at joint 2 65
Figure 3 7 The value of joint 1 variable 66
Figure 3 8 The value of joint 2 variable 66
Figure 3 9 The value of flexural displacement at the end of link 1 66
Figure 3 10 The value of slope displacement at the end of link 1 66
Figure 3 11 The value of flexural displacement at the end of link 2 66
Figure 3 12 The value of slope displacement at the end of link 2 66
Figure 3 13 The position of the end-effector in OX 67
Figure 3 14 The position of the end-effector in OY 67
Figure 3 15 The flexible robot type IV 69
Figure 3 16 Schematic of solving forward dynamic in SIMULINK 69
Figure 3 17 The driving force rule 70
Figure 3 18 The driving torque rule 70
Figure 3 19 The value of translational joint 71
Figure 3 20 The value of rotational joint 71
Figure 3 21 The value of flexural displacement 71
Figure 3 22 The value of slope displacement 71
Figure 3 23 Position deviation in OX 72
Figure 3 24 Position deviation in OY 72
Figure 3 25 The value of translational joint 73
Figure 3 26 The value of rotational joint 73
Figure 3 27 The value of flexural displacement 73
Figure 3 28 The value of slope displacement 73
Figure 3 29 The position deviation in OX 73
Trang 13Figure 3 30 The position deviation in OY 73
Figure 3 31 The flexible robot type III 75
Figure 3 32 Schematic to solve the forward dynamic of the system in the SIMULINK 76
Figure 3 33 The rules of driving torque and force 77
Figure 3 34.The rotational joint variable displacement 77
Figure 3 35 The translational joint variable displacement 77
Figure 3 36 The value of the flexural displacement 78
Figure 3 37 The value of the slope displacement 78
Figure 3 38 The position of end-effector in OX 78
Figure 3 39 The position of end-effector in OY 78
Figure 3 40 The solving inverse dynamic schematic in SIMULINK 81
Figure 3 41 The translational joint variable 82
Figure 3 42 The rotational joint variable 82
Figure 3 43 The value of driving force 83
Figure 3 44 The value of driving torque 83
Figure 3 45 The deviation of force between rigid and flexible models 83
Figure 3 46 The deviation of torque between rigid and flexible models 83
Figure 3 47 The flexural displacement value 83
Figure 3 48 The slope displacement value 83
Figure 3 49 The rotational joint variable value 84
Figure 3 50 The translational joint variable value 84
Figure 3 51 The driving torque value 84
Figure 3 52 The driving force value 84
Figure 3 53 The torque deviation value 85
Figure 3 54 The force deviation value 85
Figure 3 55 The flexural displacement value 85
Figure 3 56 The slope displacement value 85
Figure 3 57 Schematic of the GA 88
Figure 3 58 The control schematic PID with the GA 91
Figure 3 59 The translational joint variable 94
Figure 3 60 The rotational joint variable 94
Figure 3 61 The flexural displacement 95
Figure 3 62 The slope displacement 95
Figure 3 63 The driving force 95
Trang 14Figure 3 67 The rotational joint variable 97
Figure 3 68 The translational joint variable 97
Figure 3 69 The flexural displacement 98
Figure 3 70 The slope displacement 98
Figure 3 71 The position end-effector point in OX 98
Figure 3 72 The position end-effector point in OY 98
Figure 3 73 The driving torque 99
Figure 3 74 The driving force 99
Figure 4 1 Experimental model 101
Figure 4 2 Lead screw system 102
Figure 4 3 Step motor at the rotational joint 102
Figure 4 4 Lead screw 102
Figure 4 5 DC motor GB37-3530 102
Figure 4 6 Step motor NEMA 17 102
Figure 4 7 Encoder LPD3806 103
Figure 4 8 Flex sensor 103
Figure 4 9 Flex sensor FSL0095-103-ST 105
Figure 4 10 System connection diagram 105
Figure 4 11 Principle diagram inside Arduino 2560 106
Figure 4 12 LABVIEW diagram 107
Figure 4 13 Flex sensor circuit 110
Figure 4 14 Driving force 111
Figure 4 15 Driving torque 111
Figure 4 16 The value of translational joint variable 111
Figure 4 17 The value of rotational joint variable 112
Figure 4 18 The value of flexural displacement 112
Figure 4 19 The value of translational joint variable 113
Figure 4 20 The value of rotational joint variable 114
Figure 4 21 The value of flexural displacement 114
P1 1 Driving torque [64] 149
Trang 15P1 2 Rotational joint variable (1 element) 153
P1 3 Flexural displacement (1 element) 153
P1 4 Rotational joint variable (7 elements) 153
P1 5 Flexural displacement (7 elements) 153
P1 6 Rotational joint variable (1, 3, 5, 7 elements) 154
P1 7 Flexural displacement (1, 3, 5, 7 elements) 154
P1 8 Rotational joint variable (1 element) 155
P1 9 Flexural displacement (1 element) 155
P1 10 Rotational joint variable (7 element) 155
P1 11 Flexural displacement (7 element) 155
P1 12 Rotational joint variable (1, 3, 5, 7 element) 155
P1 13 Flexural displacement (1, 3, 5, 7element) 155
P1 14 PID control law in SIMULINK 158
Trang 16In the past several years, lots of robots have been designed and producedall over the world because of their important applications Nowadays, usingrobots is more and more popular in various fields
In the literature, most of the designed robots are considered with anassumption that all the links of the robots are rigid bodies This is to simplifythe modelling, analysis and control for the robot systems Such roboticsystems with rigid links are the so-called rigid robots
In fact, the elastic deformation always exists on the links of robots duringthe robot operation This elastic factor has some certain effects on motionaccuracy of robots and these effects depend on the structure and characterizedmotion of robots The robots, of which the effect of elastic deformation onlinks is taken into account, are called the flexible robots
In recent decades, there have been several researches addressing thedynamics and control of the flexible robots The quality enhancementmodeling and controlling are mainly requested by researchers and designers.Because of the large applications, future potentials and challenges in modeling and controlling of the flexible robots, this dissertation has tried to mention and solve some specific problems in kinematic, dynamic modeling and position control 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 designing
and producing the flexible robots used in some reality applications
Motivation
Modern designing always aims at reducing mass, simplifying structure andreducing energy consumption of system, especially in robotics These targetscould lead to lowing cost of the material and increasing the operating capacity
Trang 17The priority direction in robots design is optimal structures with longer length
of the links, smaller and thinner links, more economical still ensuring ability
to work However, all of these structures such as flexible robots are reducingrigidity and motion accuracy because of the effect of elastic deformations.Therefore, taking the effects of elastic factor into consideration is absolutelynecessary in kinematic, dynamic modeling, analyzing and controlling flexiblerobots
Because of complexity of modeling and controlling flexible robots, thesingle-link and two-link flexible robots with only rotational joints are mainlymentioned and studied by most researchers A few others considered thesingle-link flexible robot with translational joint It is easy to realize thatcombining the different types of joints of flexible robots can extend theirapplications, flexibility and types of structure However, the modelsconsisting of rotational and translational joints will make the kinematic,dynamic modeling and controlling become more complex than models whichhave only rotational joints
There are two main modeling flexible robot methods which are assumedmodes method (AMM) and finite element method (FEM) Most studies usedAMM in modeling the single-link and two-link flexible robots with onlyrotational joints because of simplicity and high accuracy The FEM is recentlymentioned because of the strong development of computer science Thismethod has shown the high efficiency and generality in modeling flexiblerobots which have more than two links, varying cross section of links, varyingboundary conditions and controlling in real time especially combiningdifferent types of joints
The control of flexible robots is the most important problem in warrantingthe robots moves following position or trajectory requests The errors of motion
Trang 18are appeared by errors of joints and elastic deformations of the flexible links.Therefore, developing the control system for flexible robots is necessary,especially for models with combining different types of joints.
The above raised critical issues and problems lead to the motivations ofdeveloping a new kinematic and dynamic formulation for the multi-linkflexible robots It is necessary to establish generalized kinematic modelingmethod for planar flexible robots which have links connected in series andconsist rotational and translational joints by using FEM The dynamicequations can be built on that basis Dynamic behaviors of these robots areconsidered based on dynamic analyzing under varying payload, length offlexible link and boundary conditions Furthermore, position control system isdesigned warranting requirement
Objective of the dissertation
The first objective is to formulate the kinematic and dynamic model for aplanar flexible robot arm which consists of the rotational and translationaljoints, by using the FEM/Langrangian approach
The second objective is to investigate the position control for the flexiblerobot arm with respect to the deformation of the robot links
Main contents of the dissertation
The main contents of the dissertation are the followings
- The general homogeneous transformation matrix is built to model thekinematic and dynamic of planar flexible robots FEM and Lagrange’s
equations are used to build the dynamic equations Extended assemblyalgorithm is proposed to create the global mass matrix and global stiffnessmatrix
Trang 19- The forward and inverse dynamic will serve to analyze the dynamicbehavior of flexible robots which are mentioned above under varying payload,length of flexible links and boundary conditions
- The extended PID controller is designed to control the position of planarflexible robots The control law is determined and stably proved based onLyapunov’s theory The parameters of controller are found by using genetic algorithm
- A flexible robot is designed and produced The results of forward and inverse dynamic experiments are used to evaluate results of calculations.The contents can be shown as Fig 0.1
Methodology
The researching theory, numerical calculation and experimental methodare used to execute the contents of dissertation The order of executing thedissertation is shown as Fig 0.2
Contributions of the dissertation
Fistly, this dissertation presents the generalized kinematic, dynamicmodeling and building the motion equations of planar flexible robots withcombining rotational and translational joints
Secondly, forward and inverse dynamic analyzing for these flexible robotsunder varying payload, length of flexible links and boundary conditions.Building the position control PID system which has parameters found byusing optimal algorithm (Genetic algorithm - GA)
Thirdly, designing and producing a planar flexible robot with the first joint
is traslational joint and the other is rotational joint The results of experimentsare used to evaluate results of calculations
Trang 20Significant impacts of the dissertation
Kinematic, dynamic and control problems of planar flexible robots withcombining different types of joints and varying joints order are solved based
on multi-bodies dynamic, mechanically deformed body, finite element theory,control and numerical computation method
The results of this research allow determining the values of elasticdisplacements at the arbitrary point on flexible links and evaluating the effect
of these values on position accuracy of flexible robots Furthermore, thisdissertation can be referenced in designing and producing the flexible robotswhich can be used in some practical applications
Figure 0 1 The structure of the Figure 0 2 The order executing the
Outline of the dissertation
The dissertation organization includes abstract, four chapters, conclusions,recommendations, references and appendices
Chapter 1 Literature review of flexible robot dynamics and control
The background information of flexible robots such as their applications,characteristics, classification, and modeling methods are presented in this
Trang 21chapter The status of research in our country and in the world is taken intoaccount to determine the problems focused and solved in this dissertation
Chapter 2 Dynamic modeling of the planar flexible robots
This chapter focuses on kinematic, dynamic modeling of planar flexiblerobot with combining different types of joints The general homegeneoustransformation matrix is established FEM and Lagrange’s equations are used
to build the dynamic equations Extended assembly algorithm is proposed tocreate the global mass matrix and global stiffness matrix This algorithm isproved accurately by comparing with previous research
Chapter 3 Dynamic analysis and position control of the planar flexible robots
Two main problems are solved in this chapter On the one hand, theforward and inverse dynamic are considered to analyze the dynamic behavior
of flexible robots which are mentioned above under the variation of payload,length of flexible links and boundary conditions On the other hand, theextended PID controller is designed to control the position of planar flexiblerobots The control law is determined and stably proved based on Lyapunov’stheory The parameters of controller are found by using genetic algorithm
Chapter 4 Experiments
This last chapter presents designing and producing a planar two-linkflexible robot in which the first joint is translational joint and the secondjoint is rotational joint The results of forward and inverse dynamicexperiments are used to evaluate results of calculations
Trang 22CHAPTER 1 LITERATURE REVIEW OF FLEXIBLE ROBOT
DYNAMICS AND CONTROL
The background information of flexible robots such as their applications,characteristics and classifying, modeling methods is presented in this chapter.The background of research in our country and all over the world is used todetermine the problems which are focused and solved in this dissertation
1.1 Applications of flexible robots
Researching on flexible robots (Fig 1.1) has been started since 1980 [76],[80], [113], [127], [128], [130], [131] Applications of flexible robots can beseen in [34], [86], [91], [137], [138] The major applications of these robotsare in space, medicine and nuclear technology
Figure 1 1 Flexible robots
The Figure 1.2 describes a flexible robot used in space technology Energyconsumption is decreased radically when flexible robots are catapulted intothe space because of a small number of these robots The workspace offlexible robots is extended based on increasing the length of flexible links.The control system is less complex because there are only a few links Forexample, the Remote Robot System (RMS) [34] is used to serve manyimportant tasks in space by NASA agency This flexible robot is executed inspace with low frequency about 0.04 (Hz) to 0.35 (Hz), the angle velocity isabout 0.5 (degree/second) The mass of RMS is 450 (kg) The mass of tip load
is 27200 (kg)
Trang 23The flexible robots are also used in microsurgery in medicine dealing withsmall and narrow position of human body These surgeries are extremely harddifficult for doctors in a long time such as neurosurgery, neck and heartsurgery (Fig 1.3)
Figure 1 2 The flexible robot in Figure 1 3 Flexible robot in space
medicine
The flexible robots are suitable for some important and dangerous tasks innuclear field [137] These robots are used to bring and assemble radiativerods, reduce radiative with small driving energy, small interactional force withsurroundings, flexibility and high accuracy The other applications of flexiblerobots are in army, machining and construction, etc
1.2 Classifying joint types of flexible robots
The classification of flexible robots becomes easier based on determiningthe main types of joints used to design the robots
i are connected by joint i which is rotational joint (Fig 1.4) or translational
joint type P a (Fig 1.5) or translational joint type P b (Fig 1.6) Generally, thekinematics of a flexible link i depend on the motion of joint which connectsthe link i with the previous link i−1 and the elastic deformation on the link
i − 1
Trang 24Figure 1 4 Rotational joint
Figure 1 5 Translational joint type P a
Figure 1 6 Translational joint type P b
Trang 25For the case in which the two links are connected by a rotational or a
translational joint P (Fig 1.4 and Fig 1.6), the motion of link i depends on
b
the motion of the joint i and the elastic deformation at the distal end of the link
i − 1 Nevertheless, in the case of translational joint P (Fig 1.5), the motion
a
The single-link, two-link and multi-link flexible robots with only rotationaljoints are investigated in many studies for example [10], [12], [15], [24], [28],[34], [37], [66], [72], [73], [88], [100], [103], [136], … There are some studies
mentioning single-link flexible robots with translational joint P or P [13],
[23], [29], [73], [116], [133] However, combining types of joints in flexiblerobots is not yet fully and clearly considered in modeling and controlling
Trang 261.3 Classifying flexible robots
The flexible robots are classified according to the number of joints andlinks, types of joints and their structures
1.3.1 The flexible robots with regard to number of links and joints
1 The single-link flexible robots
The single-link flexible robots are clearly investigated [13], [14], [26],[36], [40], [48], [55], [64], [82], [101], [113], … The Fig 1.7 shows thesingle-link flexible robot with rotational joint and the Fig 1.8 describes the
other with translational joint P b
Figure 1 7 The single-link flexible robot with rotational joint
Figure 1 8 The single-link flexible robot with translational
joint 2 The two-link flexible robots
The two-link flexible robots are studied in [15], [18], [23], [25], [29], [48],
[65], [68], [75], [90], [95], [98], [116], 126], [135], [138], etc
Trang 27Figure 1 9 The two-link flexible Figure 1 10 The two-link flexible
robots with only rotational joints robots consist translational joints
The two-link flexible robots with only rotational joints are mainly studied(Fig 1.9) and a few others are mentioned consisting of the rotational andtranslational joints (Fig 1.10)
3 The planar serial multi-link flexible robots
The multi-link flexible robots (Fig 1.11) are studied in [10], [12], [15],[24], [28], [37], [66], [70], [73], [88], [100], [136], …
Figure 1 11 The planar serial multi-link flexible robots
1.3.2 Classifying the flexible robots according to structures
1 The series-link flexible robots
The flexible robots with series links are shown as Fig 1.11
Trang 282 The parallel-link flexible robots
The flexible robots with parallel links are described as Fig 1.12 [84]
Figure 1 12 The parallel-link flexible robots
The parallel robots are widely used in many applications such as entertainment,home services, flying machines, submarines, assembling robots, etc Comparedwith serial robots, parallel robots are provided with a series of advantages interms of heavy payload, high positional accuracy and so on
3 The mobile flexible robots [85] (Fig 1.13)
Figure 1 13 The mobile flexible robots
Flexible robots with moving base such as macro-micro robots, space robots andunderwater robotic vehicles can be used for extending the workspace in repairand maintenance, inspection, welding, cleaning, and machining operations
1.4 Modeling methods
In general, the flexible robots are the continuous systems characterized byunlimited degrees of freedoms It is difficult to accurately describe the system
Trang 291.5 Differential motion equations
The differential motion equations can be described as
- The Newton-Euler equations [13], [15], [29], [103], [115], [135],
- The Lagrange-Euler equations [10], [12], [14], [18], [23], [24], [25],
[28], [33], [37], [48], [64], [66], [68], [72], [88], [90], [98], [136], …
- The Gibbs-Appel equations [73], [100], [105], [116], …
Trang 30- The Kane equations [68].
The AMM can be combined with Lagrange-Euler equations [10], [28],[37], [66], [88], [98], [101], [136], with Newton-Euler equations [13], [29],[40], [47], [135] and with Gibbs-Appel equations [73], [100] However, thesecombinations are executed for single-link or two-link flexible robots withonly rotational joints
1.6 Recent works on flexible robots
In our country, flexible structures were studied a few decades ago [1], [2],[3], [4], [8] Khang and Khiem [2], [3], [4] had numerically evaluated thevibration of elastic connecting rods in a six-link mechanism The conditions ofdynamic stability were checked by using numerical method Khang and Nam
[8] studied on the vibration of planar mechanism with an elastic link (Fig.1.14) based on multi-body dynamics theory The AMM and FEM are used tobuild the differential motion equations of four-link and six-link planar closedmechanisms The linearized method is proposed to analyze these mechanisms.The PD control is designed to reduce the vibration of the flexible link Hoang[9] presented the inverse dynamic of a two-link flexible robot consisting thetranslational and rotational joints by using the FEM and Lagrange equations.Each flexible link has only an element The effects of the variety of laws ofvariable joints on driving laws are solved
Figure 1 14 Flexible planar closed mechanism [8]
Trang 31The dynamic modeling and controlling of the flexible robots attract manyresearchers over the world The background of flexible robots is described insome particular studies such as in [39], [76], [80], [113], [127], [128], [130]
1 The single-link flexible robots
The single-link flexible robots are clearly presented in [13], [14], [26],[36], [40], [48], [55], [64], [82], [101], [113], …Kalker [14] investigatedbuilding the nonlinear dynamic equations and designing the control systemfor a single-link robot Kwon and Book [36] addressed the inverse dynamic ofsystem in the time domain The dynamic behaviors of a single-link robot withtip load are analyzed by using FEM and Lagrange equations in [44], [48],[64] The dynamic modeling is studied by using AMM in [40], [55], [101].Trautt [56] also developed the inverse dynamic of flexible single-link robotconsidering the Coulomb friction force and backflash factor The loopalgorithm Newmark is applied to solve inverse dynamic in the frequencydomain Gee [42] used the genetic algorithm to optimize the parameters of theposition control system for the single-link robot based on Lyapunov’s stabletheory Zhu [45] used the backstepping method to control the position of end-effector point with tip load The authors applied previous work to design thefeedback nonlinear control presented in [50] The flexible link is lumped to aspring-mass system (Fig 1.15)
Figure 1 15 Spring-mass system [45]
Trang 32Kuo and Lin [69] focused on designing the control system by using fuzzycontroller The Neural network algorithm is applied to control the system in[79] The elastic displacements in three dimensions are mentioned in [129] Ju
and Li [133] studied the single-link flexible robot with translational joint P
a (Fig 1.16) and base m b The system is driven by force F (t ).
T
In summary, the single-link flexible robots with rotational joint are mainlymentioned using AMM and FEM The linearized methods are applied inalmost studies to reduce the complexity of models
Figure 1 16 The single-link flexible robot with joint P a [133]
2 The two-link and multi-link flexible robots
The two-link planar flexible robots are investigated in [15], [18], [23], [25],[29], [48], [65], [68], [75], [90], [95], [98], [116], 126], [135], [138], etc Thekinematic and dynamic of the two-link and multi-link flexible robots areanalyzed based on the methods which are also used for the single-link models.The two-link flexible robots with only rotational joints are the major objectives(Fig 1.17 and Fig 1.18) The number of researches such as [65], [98], [119],[121], [141] are presented using AMM, the others [12], [43], [93], [97], [104] arestudied by FEM Usoro [12] presented the FEM and Lagrangian approach for themathematical modeling of the two-link flexible robot with rotational
Trang 33joints This paper is one of the first studies regarding flexible robots Thecomparison between the rigid and flexible models is discussed in [58]
Figure 1 17 The two-link flexible Figure 1 18 The two-link flexible
robot Quanser robot with rotational joints
The inverse dynamic of the two-link flexible robots is addressed in [22],[25], [35], [41] Bayo [22] solved the inverse dynamic in the frequency domainwith model being linearized The flexible robots consisting of rotational andtranslational joints (Fig 1.19) are mentioned in [23], [29], [48], [116]
Figure 1 19 The flexible robot with rotational and translational joints
Al-Bedoor and Khulief [48] proposed the transition element to model thesestructures This element includes two parts The first part is rigid and insidethe translational joint, the other is flexible and outside the joint The length ofthis element is considerable to warrant clear difference between two parts (thelength of flexible link is 3.6m, the length of each element is 0.9m) Therecursive equations Gibbs-Appel and AMM are applied constructing themotion equations of the flexible robots in [116]
Trang 34There are many investigations on the controlling problems for two-linkflexible robots such as [43], [50], [58], [69], [79], [121], [126], [129], [141],etc Gee and Lee [43] showed a class of robust stable controllers to control thetip position of a multi-link flexible robots The controllers are derived byusing a basic relationship of system energy and are independent of the systemdynamics The PID and PD controllers are developed in [58] The optimalmixed sensitivity algorithm H2/H∞ is considered and executed in MATLAB[121] Kherraz [126] designed the control system combining the sliding modeand fuzzy logic methods Lochan [141] used the AMM and neural networkcontroller to model and control the flexible robots.
The multi-link planar flexible robots are developed in [10], [12], [15], [24],[28], [37], [66], [70], [73], [88], [100], [136], [143], [144], [145], [146], [147],[148], etc However, all of studies focused on the flexible robots with onlyrotational joints The simulated and calculated results of these researches arepresented for the two-link flexible robots Some of the studies mentioned theplanar flexible parallel robots [84], mobile robots [85], flexible joints [31], [46],[61], [81], [102] and the effects of stiffness of flexible links [71], [102], [140] Afew researches provided the results of experiments [11], [16], [53], [67]
In summary, the two-link and multi-link flexible robots with only rotationaljoints are mainly focused with respect to modeling and controlling A few
studies consider the flexible robots consisting of the translational joint P b butnot yet mention the order of joints
1.7 The position accuracy of motion of flexible robots
Finding solutions to warrant the accuracy of motion of robots in generaland flexible robots in particular is extremely important because the errorsalways exist in technique These solutions are usually proposed based on thedynamics modeling and control designing The motion errors appear because
Trang 35of many reasons such as the payload, the inertia, the manufacturing errors, thefriction joints and the elastic deformations, etc The effects of elasticdeformations on motion accuracy of flexible robots are sizable The accuracylevel of the movement equations and the correction of control law decide theefficiency of ensuring position accuracy of flexible robots Therefore, thedynamic modeling based on FEM or AMM and using intelligent controlsystem are popular in almost studies as their targets
1.8 The comments and the problems
A few main comments can be discussed below after considering a number
of studies on flexible robots in the past
Firstly, the number of motion equations and the variables are increasedwhen mentioning the effects of elastic deformations The derivative equationssolving method and control designing are more complex than rigid robots.Secondly, the single-link, two-link and multi-link flexible robots with onlyrotational joints are studied a lot on modeling and controlling The linkflexible robots with translational joint are also considered in dynamicmodeling There is not any research investigating generally and clearly theflexible robots combining the types of joints (rotational joint, translational
joint P a and translational joint P b ) and their order
Thirdly, the flexible links in almost all studies are usually assumed only anelement in FEM to reduce the number of variables and the complexity ofassembly the global matrices and solving the dynamic equations However,the generalization and the advantages of FEM are not yet expressed especiallyconsidering the flexible robots with many links, varying cross section area ordetermining the values of elastic displacements at the arbitrary point on anyflexible link
Trang 36Although there are many problems which must be studied on modelingand controlling for the flexible robots in general and these robots combiningthe types of joints in particular, this dissertation only focuses on someproblems as follow
- The kinematic and dynamic modeling of multi-link planar flexible robotswhich consist of different types of the joints and mention the order of thesejoints The dynamic behaviors of these robots are analyzed under the varying
of payload, the ratios of the length of links and boundary conditions
- The extended position control system is designed based on classic PID controller with its parameters optimized by using the genetic algorithm
- A specific flexible robot is designed and manufactured to execute someexperiments The results of these experiments are used to evaluate results ofcalculations
Conclusion of chapter 1
This chapter determined the objectives and contents of the dissertationbased on reviewing modeling and controlling of the flexible robots in ourcountry and over the world
Trang 37is considered FEM and Lagrange’s equations are used to build the mechanicalmodel and dynamic equations Extended assembly algorithm is proposed tocreate the global mass matrix and global stiffness matrix This algorithm isproved accurately by calculation following previous research Kinematic anddynamic modeling are analyzed with some assumptions such as
- The links are elastic beam, homogenous material and constant cross section area
- Elastic deformation of links is small The shear deformation of the beam is neglected
- Each node of element only has the flexural and slope displacement
- The tip load is concentrated mass
- The effect of length of translational joint is not considered yet
- The joints are rigid
2.1 Kinematic of the planar flexible robots
2.1.1 The general homogeneous transformation matrix
Let us consider the flexible planar robot consisting of n(n Z ) links and n
joints The arbitrary linki −1is connected with a linki by a jointi(i = 1 n)
which can be the following three joint types: rotational joint (R),
translational joints P a and P b (Figure 2.1) The link i with a length L i is
divided into n i elements of the equal length l ie Each element j of the link i
has two nodes which are j and j + 1 Node j has a flexural displacement
Trang 38u and a slope displacement u Similarly, node
Hi (i −1) f as the general homogeneous transformation matrix which transforms
from the coordinate system O XY to the coordinate system O X Y This
matrix is determined by executing in order of the below steps
Step 1 Translate the coordinate system O X Y along
i
in the direction
i −1 i −1 i −1
O i −1X i −1 to the position of joint i The homogeneous transformation matrix
characterizing this translation is denoted as T( i ) This matrix is determinedas
Trang 39this rotation is defined as
Trang 40It is note that from step 1 to step 4 as
If the joint i is the rotational joint, the parameters
turn the length L − , the flexural displacement
i −1
at the end of link i−1 and the joint variable i
If the joint i
are in turn the
is the translational joint P , the parameters , u , u ,
link i−1 and link i
If the joint i is the translational jointP , the parameters , u , u ,
i If the joint i is the rotation joint or translational joint P , the