Professional Documents
Culture Documents
Thesis
Thesis
net/publication/362583160
CITATIONS READS
0 213
1 author:
Selman Djeffal
École Nationale Polytechnique Constantine
23 PUBLICATIONS 52 CITATIONS
SEE PROFILE
All content following this page was uploaded by Selman Djeffal on 09 August 2022.
Thesis
Presented to obtain a 3rd cycle DOCTORATE degree
In : Mechanical engineering
SPECIALITY : Construction
By : DJEFFAL Selman
Subject
iii
Acknowledgement
First of all, I would like to thank the Allah almighty, all powerful, to have given
me the strength to survive, as well as the audacity and the patience to overcome all
difficulties.
The work presented in this thesis was carried out at the Larbi Ben M’hidi University,
Department of Mechanical Engineering, Faculty of Science and Applied Sciences, Ain
beida, Oum el Bouaghi, under the supervision of Mr. CHAWKI MAHFOUDI,
Professor at the University Larbi Ben M’hidi of Oum el Bouaghi, which has throughout
this thesis and who made me share his brilliant intuitions. May he also be be thanked
for his availability and for the numerous encouragements that he me.
I also thank my co-director of thesis, Mr. AMMAR AMOURI, Professor at the
University of Brothers Mentouri, Constantine 1. For its availability, its follow-up of
my work and its supervision.
I express my gratitude to Mr. ABDELBAKI DJOUMBI, Professor at the
university Larbi Ben M’ hidi of Oum el Bouaghi, agreed to chair the jury of this thesis.
My thanks also go to Mr. OUALID BERKANI , Lecturer at the University
Larbi Ben M’hidi of Oum el Bouaghi, BELKACEM BARKAT, Professor at the
University of Batna 2 and RIDHA KELAIAIA, Professor at the University 20
August 1955 of Skikda, who kindly agreed to be examiners.
I express all my gratitude to Mr. ROCHDI MERZOUKI Professor at the
university of Lille 1, france, for having well to answer my questions throughout this
thesis.
It is impossible for me to forget Mr. ABDERAHMAN AISSOUI and LARBI
BENDADA teachers at the university Larbi Ben M’hidi of Oum el Bouaghi for their
invaluable help. They have always made all their possible to help me.
In order not to forget anyone, my warm thanks are addressed to all those who
helped me to realize this modest work.
iv
Abstract
This thesis elaborately studies continuum robots in particular those actuated by cables
and the continuum robot which is called Compact Bionic Handling Assistant (CBHA).
First, we have developed a new method allowing the simplification of the forward
kinematic model (FKM) of a flexible continuum robot with variable curvature (CV).
This simplification consists in establishing a relationship between the bending angles
of all units of the same section as a function of the bending angle of the first unit
belonging to the same section. The goal is to reduce the number of the robot’s degrees
of freedom .
Regarding the inverse kinematic model (IKM) of the multi-section continuum robot
is complex and this is confirmed by the lack of an analytical solution in the currently
existing research work. To figure out this problem, we have turned to meta-heuristic
methods for the resolution of IKM. In particular our contribution is based on the use
and comparison of the three optimization methods PSO, GA and ABC. These three
methods use an objective function that minimizes a desired distance between the robot
and the target using different constraints.
To give a practical aspect to our work, a design of a flexible two-section continuum
robot has been proposed with all the dimensioning calculation, namely the robot body
as well as the control mechanisms.
This thesis is conluded with the proposal of a preliminary dynamic model for the
continuum robot with variable curvature which can be used for future improvements.
The establishment of this dynamic model is based on Taylor approximations. In order
to derive the Lagrangian of the dynamic model, we used Taylor’s approximations and
then the obtained differential equation was solved by the Runge-Kutta method of
fourth order.
Overall, all the simulations were carried out through MATLAB.
الملخص
تركز هذه األطروحة على الروبوتات المرنة ،وال سيما الروبوتات المرنة المتحكم فيها باألسالك
وكذلك الروبوت المسمى (.Continuum Bionic Handling Assitant )CBHA
أوالا ،قمنا بتطوير طريقة جديدة تسمح بتبسيط النموذج الحركي المباشر ( )FKMللروبوت المرن
ذي االنحناء المتغير ( .)CVيكمن هذا التبسيط في إنشاء عالقة بين زوايا االنحناء لجميع وحدات
الروبوت و الوحدة األساسية ) (unityلكل قسم ) )sectionمن الروبوت .الهدف من هذا التبسيط
هو تقليل عدد درجات حرية الروبوت.
فيما يتعلق بالنموذج الحركي العكسي ( )IKMللروبوت متعدد األقسام ).(multi-sections
استخدامنا وقارنا ثالث طرق ذكية مستوحاة من الطبيعة ،الكائنات التي تعيش في مجموعات ()PSO
،الخوارزمية الجينية ( )GAو مستعمرة النحل االصطناعية ( .)ABCتستخدم هذه الطرق الثالث
في تقليل المسافة المرغوبة بين الموضع النهائي للروبوت ) (Robot’s end tipوالمسار المطلوب
باستخدام قيود مختلفة.
إلعطاء جانب عملي لهذا البحث ،تم اقتراح تصميم روبوت مرن من قسمين مع كل الحسابات
الضرورية ألجزاء الروبوت من خالل (.(SolidWorks
تم انهاء هذه األطروحة باقتراح نموذج ديناميكي أولي للروبوت المتصل ذي االنحناء المتغير والذي
يمكن استخدامه للتحسينات المستقبلية .يعتمد إنشاء هذا النموذج الديناميكي على تايلور ).(Taylor
من أجل اشتقاق الغرانج ) ) Lagragienمن النموذج الديناميكي ،استخدمنا تايلور ومن ثم تم حل
المعادلة التفاضلية التي تم الحصول عليها بطريقة رونج-كوتا ) (Runge-Kuttaمن الدرجة الرابعة.
تمت محاكاة النماذج الموضوعة بواسطة ماتالب ) (Matlabللتحقق من كفاءة النماذج المقترحة في
هذه األطروحة.
Nomenclature
i Cable index
j Unit index
k Section index
Xk Cartesian coordinate along X with respect to the local coordinate system ℜk−1
Yk Cartesian coordinate along Y with respect to the local coordinate system ℜk−1
Zk Cartesian coordinate along Z with respect to the local coordinate system ℜk−1
Ai,j,k The point connecting the end of the cables and the mobile platform of the unit (j, k)
Bi,j,k The point connecting the the cables and the fixed platform of the cylindrical unit (j, k)
⌢
B i,j,k The point connecting the cables’end and the fixed platform of the conical unit (j, k)
t Time
k
Tk−1 Homogeneous transformation matrix (4 × 4), defining the coordinate system Rk in Rk−1
rj,k radii of discs
X Objective function
γi,k Arrangement angle of the segments in a rotating distance of 120 degrees
g Gravity
ℓ̂i,j,k Cable length i of conical unit (j, k)
ℓi,j,k Cable length i of cylindrical unit (j, k)
lj,k Length of the central axis of a unit (j, k)
di,j,k Bending radii for cables
k
Rk−1 Matrix (3 × 3) defining the orientation of the frame reference Rk in Rk−1
vh,j Linear velocity
v(t) Particle velocity p à t
Pgb (t) The best position obtained by the swarm
Pp (t) The best position that is visited by the particle
P (t) Particle position p at t
θj,k Bending angle for each unit
κk Curvature of the flexible section
c1 , c2 Acceleration coefficients, constant
Xi Source of food
xi Source de nourriture actuelle
si Current food source [-1,1]
λi A random number representing the position vector
vii
w Inertia coefficient
λ1 , λ2 Random numbers with a uniform distribution in [0,1]
pop Size of bees
Fi The tension applied to the cables of the robot
Qk Generalized forces
Uj,k The position vector of each point located on the central axis of unity
h Curvilinear abscissa
mj Disc mass
mb Backbone mass
db Diameter of the backbone
E Young’s modulus
Ib Moment of inertia of backbone
T Total kinetic energy of the robot
Tb Backbone kinetic energy
Td Kinetic energy of discs
U Total potential energy of the robot
Up Potential energy of discs
viii
Abreviations list
ix
Table of contents
Dedication iii
Acknowledgement iv
Nomenclature vii
Abreviations list ix
Introduction 4
xi
Table of contents
References 117
Appendix A 124
xii
List of figures
2.1 (Left) The total robot structure with global coordinates for each section,
(Right) Placement of reference frames on the central axis for each unit . 21
2.2 (Left) Description of a unit with conical and cylindrical shape (j, k),
(Right) The variation of the cables length for the two conical and
cylindrical shapes . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 22
2.3 Placement of reference frames on the structure of a flexible manipulator 23
2.4 Global view of the modeling . . . . . . . . . . . . . . . . . . . . . . . . 25
2.5 Definition of the different radii of curvature of the unit (j, k) . . . . . . 27
xiii
List of figures
2.6 Unit with rmax = 25mm and rmin = 23.5mm; (Left) Bending angle
θ = 0rad ; (Center) Bending angle θ = 0.4rad; (right) Bending angle
θ = 0.5rad . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 32
2.7 Illustration of the distribution of the cable lengths of the first unit (1, k)
over the remaining units of the first section (k = 1) . . . . . . . . . . . 32
2.8 Bending angles as a function of a given variation in cable length for each
unit (j, k). . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 33
2.9 The ratios of the angles and disks for a given variation of the length of
the cables of the section (k = 1) . . . . . . . . . . . . . . . . . . . . . . 33
2.10 2D view of the continuum robot workspace at VC . . . . . . . . . . . . 35
2.11 3D view of the workspace of a CC and VC section . . . . . . . . . . . . 36
2.12 View in the YZ plane of the workspace of a section at CC and VC . . . 36
2.13 View 2D for the workspace for a flexible continuum robot with constant
curvature: rmax = 25mm, rmin = 25mm . . . . . . . . . . . . . . . . . . 37
2.14 2D View of the workspace for a flexible continuum robot with variable
curvature: rmax = 25mm, rmin = 10mm . . . . . . . . . . . . . . . . . . 37
2.15 Comparison between the workspace for a flexible continuum robot at
CC and VC . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 38
2.16 Simulation 1 of a continuum robot with VC (three sections) . . . . . . 38
2.17 Simulation 2 of a continuum robot with VC (three sections) . . . . . . 39
xiv
List of figures
3.13 Calculated cable length for the first section (second configuration) . . . 52
3.14 Calculated cable length for the second section (second configuration) . 53
3.15 Profile of the cable length L1 for the units of the first section (linear
trajectory) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 54
3.16 Profile of the cable length L2 for the units of the first section (linear
trajectory) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 54
3.17 Profile of the cable length L3 for the units of the first section (linear
trajectory) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 55
3.18 Profile of the cable length L4 for the units of the second section (linear
trajectory) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 55
3.19 Profile of the cable length L5 for the units of the second section (linear
trajectory) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 56
3.20 Profile of the cable length L6 for the units of the second section (linear
trajectory) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 56
3.21 Some configurations of the central axis of the robot when following the
desired circular path . . . . . . . . . . . . . . . . . . . . . . . . . . . . 57
3.22 Comparison between the generated trajectory and the desired one and
their Euclidean errors . . . . . . . . . . . . . . . . . . . . . . . . . . . . 58
3.23 Profile of cable lengths for the first section while following the circular
path (first configuration) . . . . . . . . . . . . . . . . . . . . . . . . . . 59
3.24 Profile of cable lengths for the second section while following the circular
path (first configuration) . . . . . . . . . . . . . . . . . . . . . . . . . . 59
3.25 Bending angles for the circular path . . . . . . . . . . . . . . . . . . . . 60
3.26 Orientation angles for the circular path . . . . . . . . . . . . . . . . . . 60
3.27 Profile of cable lengths for the first section while following the circular
path (second configuration) . . . . . . . . . . . . . . . . . . . . . . . . 61
3.28 Profile of cable lengths for the second section while following the circular
path (second configuration) . . . . . . . . . . . . . . . . . . . . . . . . 61
3.29 Profile of the cables length for the units of the first section (circular path) 62
3.30 Profile of the cables length for the units of the second section (circular
path) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 62
3.31 Robot following the desired spiral trajectory . . . . . . . . . . . . . . . 63
3.32 Comparison between the generated spiral path and the desired one with
their Euclidean errors . . . . . . . . . . . . . . . . . . . . . . . . . . . . 64
3.33 Cable length profile for the first section (spiral path) . . . . . . . . . . 64
3.34 Cable length profile for the second section (spiral path) . . . . . . . . . 65
xv
List of figures
xvi
List of figures
xvii
List of tables
5.1 The characteristics of a single section of the flexible continuum robot . 110
5.2 The parameters of the considered section . . . . . . . . . . . . . . . . . 110
xviii
Introduction
1
Various modeling approaches have been applied to continuum robots, unlike tradi-
tional rigid robots, flexible bionic robots are more difficult to model and build due to
their lack of rigidity and the large number of degrees of freedom required for geometric
models in their continuous form. Modeling approaches in which articulations are
attached to each joint are inappropriate for this type of robot. Their modeling requires
the establishment of a continuous model of the central axis of the structure. Research
on the modeling of this type of robot focuses on the calculation of the geometric
model while respecting the specificities and mechanical properties of continuum robots.
However, there is not yet a general geometrical model that can explicitly describe the
behavior of this type of robot.
• Thesis objectives: The main objective of this work is the modeling of the
geometric behavior of continuum robots. In order to achieve this objective,
mathematical models have been developed based on geometrical, kinematic and
dynamic approaches.
2
fields. In the 2nd part of the state of the art we present some recent studies on
kinematics and dynamics modeling. In Chapter 2, the geometrical description of
a robot with a complex structure similar to the CBHA robot was started. Then,
the forward kinematic modeling of a unit, a flexible section and then the whole
robot are established. Chapter 3 is dedicated to the inverse kinematic modeling
(IKM). The inverse kinematic model of a unit with constant curvature (CC) is
analytically presented, however the inverse geometric model of a section or of
the whole robot cannot be solved analytically which has oriented us towards the
use of some optimization algorithms for the solution of its complex equations.
A study of the design and dimensioning of a prototype of a flexible continuum
robot with two sections are carried out in the fourth chapter. The drawing of this
study is done in SolidWorks. Finally, the last chapter deals with a preliminary
dynamic study of a single section continuum robot.
• List of publications :
Djeffal, S., Amouri, A., Mahfoudi, C., "Kinematics modeling and simulation
analysis of variable curvature kinematics continuum robots," UPB Sci. Bull. Ser.
D Mech. Eng. vol. 81, pp. 28-41, 2021.
Djeffal, S., Mahfoudi, C., Ghoul, A., "Solving the Non-Linear Dynamic Equa-
tions of Motion of a Variable Curvature Continuum Robot Using Runge-Kutta
Method and MATLAB Software," Journal of Applied Nonlinear Dynamics, 2022.
(accepted)
Ghoul, A., Kara, K., Djeffal, S., Benrabah, M., Hadjili, M.L., "Artificial Neu-
ral Network for Solving the Inverse Kinematic Model of a Spatial and Planar
Variable Curvature Continuum Robot," Archive of Mechanical engineering, 2022.
(accepted)
Merrad, A., Amouri, A., Cherfia, A., Djeffal, S., "A Reliable Algorithm for Ob-
taining All-Inclusive Inverse Kinematics’ Solutions and Redundancy Resolution of
Continuum Robots", Arabian journal for science and technology, 2022. (accepted)
Djeffal, S., Mahfoudi, C., Amouri, A., "Comparison of three meta-heuristic
algorithms for solving inverse kinematics problems of variable curvature continuum
robots," 10th European Conference on Mobile Robots (ECMR). IEEE, pp. 1-6,
2021.
3
Amouri, A., Mahfoudi, C., Djeffal, S., "Kinematic and dynamic modeling and
simulation analysis of a cable-driven continuum robot," In computational methods
and experimental testing in mechanical engineering. springer, pp. 26-37, 2019.
Djeffal, S., Mahfoudi, C., Amouri, A., "A path optimization technique with
obstacle avoidance for multi-section continuum robot using teaching learning
based optmiaztion," 3rd international conference on mechanical sciences ICMS’
2021, Oum el Bouaghi, Algeria. (accepted)
Djeffal, S., Mahfoudi, C., Amouri, A., "The improvement of the orthoglide’s
proposed design through the dynamics’ implementation," 5th international con-
ference on advances in mechanical engineering december 17-19, 2019, istanbul,
Turkey.
Djeffal, S., Mahfoudi, C., Amouri, A., "Contribution to the conceptual study with
a view to including the ortho-glide robot’s equation," 3rd international conference
on electromechanical engineering ICEE 2018, August 20, 1995-Skikda, Algeria.
4
Chapter 1
1.1 Introduction
In this chapter, we first present a definition of a continuum manipulator, then the
state of the art dealing with modeling approaches for this type of robots. This allowed
us to position our work with respect to the current literature on continuum robots. A
part of the state of the art which concerns the different types of continuum robots is
based on the work developed by Manas Milind Tonapi [5].
1.2 Definition
Continuum robots are an extension of the recently developed rigid robots. By adding
more joints to rigid robots, this changed their name to hyper-redundant robots [6]. If
we repeat the same process by adding more and more joints to the robot until the
lengths of its segments approach zero, this gives rise to the so-called continuum robot.
5
State of the art
The deep understanding of the physical movements of octopuses and their functional
principles have given roboticists an interesting insight and a solid starting point in the
design of continuum manipulators.
6
State of the art
Fig. 1.3: Tentacle robot with flexible and incompressible rod [12]
7
State of the art
A cable-driven snake robot designed by John Hopkins University (JHU) for laryngeal
surgery (see Figure 1.5) has a thin 4-mm profile [13]. The robot consists of a base disk,
an end disk, several spacer disks, and four superelastic tubes called skeleton tubes
made from an alloy (aluminum). However, it has significant complexity in degrees of
freedom (DOF) and problems with overheating that comes from the friction of the
aluminum alloy against the surface of the robot tubes.
The hyper-redundant continuum robot [14] is a 48 DDL robot, see 1.6 driven by
24 motors. It is analogous to an elephant trunk and similar to another robot with 8
DDL. A spring is used as a backbone to actuate the flexion. This gives the robot the
ability to make a variety of shapes. However, this type of robot lacks local extension
and contraction. In addition, the higher DDL requires a higher number of motors in
order to control each joint, which is not desirable for use in space applications.
8
State of the art
The continuum robots developed with a concentric tubular structure are made of
pre-bent tubes that slide into each other (see figure 1.8). They are commonly used in
minimally invasive surgery. Some have limited curvature due to the pre-bent nature of
the concentric tube design, but can inherently achieve local extension and contraction.
9
State of the art
Guglielmino E. and his group [20] have proposed structures similar to the octopus
arm; of which the first robot named Octopus-Arm (figure 1.10) is designed in 2010 .
The robot is composed of two flexible sections and has 15 active degrees of freedom.
Their actuation is realized by longitudinal and transverse pneumatic artificial muscles.
Unlike the previous robots, this robot is able to control its diametrical contraction
using the transverse muscles.
10
State of the art
In 2012, the team of the Guglielmino [21], have introduced another type of robot
similar to the octopus arm. The ”octopus-like robotic arm” is controlled by cables
and the diametrical contraction is controlled by an articulated mechanical structure
(SMA).
The active camera scope (figure 1.11), is the longest type of continuum-style snake
robot (8 meters) [22] to date. But its movement is only possible if its drive mechanism
faces a contact surface against which it is pushed. This is not practical from the point
of view of inspection in space, where minimal contact is desired. In addition, it lacks
local backbone extension and contraction.
Active cannula robots (figure 1.12 (left) [23]), (figure 1.12 (right) [24]) represent
another kind of flexible continuum robots, especially intended for surgical applications
11
State of the art
that require high dexterity in a confined environment [25, 26]. Researchers such as Nabil
Simaan, Pierre E. Dupont, and Robert J. Webster III have been frequent contributors
to this field.
Fig. 1.12: (Left) Insertable robotic effector platforms for single-access surgery (2010)
[23], (Right) Miniature snake-like robots (2006) [24].
Hybrid robots involving snake and continuum elements [27, 28] were developed
to eliminate the disadvantages of each type individually. Figure 1.13(Left) shows
the HARP design with nitinol inserted between the inner and outer probe through a
channel to provide more dexterity. Figure 1.13(Right) shows a hybrid robot that has
spherical joints with an elastic spine and cables to control flexion. However, both of
these structures rely heavily on the snake counterpart (i.e., the segmented skeleton) in
terms of mechanical design. This increases their structural complexity and decreases
their ability to maintain a slender profile.
The flexible bionic robots that resemble the elephant trunk (figure 1.14) were
developed by the company Festo. The flexible sections of the Bionic Handling Assistant
(BHA) robot are made of polyamide which makes it flexible. Each flexible section
consists of three tubes controlled by three electro-pneumatic actuators. The position and
orientation of each section is controlled by varying the inlet air pressure. RobotinoXT
is a cooperative mobile manipulator robot based on an omnidirectional robot called
Robotino and a small version of the BHA robot called Compact Bionic Handling
12
State of the art
Assistant (CBHA). The CBHA bionic trunk is composed of: 2 flexible sections, 1
rotating part, and 1 compliant clamp. The rotating part is composed of a flexible
vertebrate tube describing an arc of circle. These types of robots are characterized by
their hyper-redundancy with a high number of degrees of freedom.
Fig. 1.14: (Left) Bionic Handling Arm (BHA) [29], (Right) RobotinoXT: the bionic
Compact Bionic Handling Assistant (CBHA) " mounted on the omnidirectional robot
"Robotino" [30]
13
State of the art
14
State of the art
the modeling task. These approaches are based on input-output data derived from
experimentation or simulation and can provide accurate and fast approximations.
In the work of [35], the researchers established a learning-based approach for the
development of the direct geometric model. In fact, they proposed an experimental and
structural comparative study of commonly used learning models, namely multilayer
perceptron (MLP), radial basis functions (RBF), support vector regression (SVR),
and co-active adaptive neuro-fuzzy interference system (CANFIS). According to their
results, support vector regression provides the best accuracy and fast convergence for
(RBF), and a good trade-off between learning time and accuracy for (MLP) while
CANFIS shows similar accuracy to SVR but with a much shorter learning time.
In reference [36], the authors developed an approach that is based on multilayer
perceptron (MLP) and radial basis function (RBF) neural networks, which aims to
provide an approximate forward kinematic model (FKM) of the elephant trunk that
is named CBHA. To obtain good results, the database must be well prepared and
accurately constructed. For the inverse geometric model, the researchers used a distal
supervised learning (DSl) technique [36] which is mainly derived from the study [37],
in which the IKM is solved. Explicitly, the LDS can be summarized in two steps; the
first one is to create a database from the direct geometric model that is used to train
the robot. In the second, for a given position, the bending angles as well as the cable
lengths can be obtained. In the work of [38], the authors developed a meta-heuristic
approach to solve the inverse geometric model based on the assumptions of constant
curvature, namely particle swarm optimization (PSO). Their main idea aims to solve
the inverse geometric model by a governing objective function that illustrates the
distance between the continuum robot end effector and the prescribed trajectory. They
proved that the PSO provides remarkable accuracy as well as fast convergence. In
the same context, in this thesis, three meta-heuristic approaches are established and
developed to solve the inverse geometric model of the variable curvature continuum
robot, namely PSO, artificial bee colony (ABC) and genetic algorithm (GA).
In our research, the developed algorithms can provide the necessary bending and
orientation angles as well as the appropriate cable lengths to follow a specific trajectory.
The geometric inverse model of the BHA manipulator [39] using a qualitative approach
based on online goal babbling, the idea of this modeling is to learn the inverse model
of the BHA manipulator (3 sections), a long version of the CBHA (2 sections), which
suggests the common parameter lengths to reach the target in the workspace.
15
State of the art
16
State of the art
the Cosserat rod theory [61–66, 44]. These models describe the equations of motion
of a rod, and are derived from first principles under moderate assumptions such as
idealizing the rod as a slender object. In [67], the authors have solved the inverse
dynamic model using parametric curves (Pythagorean Hodograph) combined with the
euler bernouli model, which allows to establish a relation between the actuator inputs
and the ’Pythagorean Hodograph’ curves; thus the actuator inputs can be calculated.
In [68], a dynamic model for a multi-section continuum robot with variable curvature
is developed through the Cosserat rod theory by taking into account the elongation
of the central axis of the robot. The proposed model is found to have significantly
improved accuracy compared to the constant curvature model. In the same context, for
the dynamic model developed in this thesis, we used the Euler-Lagrange method for a
continuum robot with variable curvature. In which we assumed that the backbone of
the continuum robot is a series of circular arcs interconnected with each other.
17
State of the art
18
State of the art
1.4 Conclusion
This chapter presents a general definition of the continuum robot and its evolution
over the last years. We have also presented the different types of continuum robots
and their applications in various domains. The modeling of continuum robots has
been discussed in detail, as well as the positioning of our work with respect to existing
studies.
19
Chapter 2
2.1 Introduction
The main objective of this chapter is to establish the forward kinematic model of a
flexible continuum robot with variable curvature. In the same context, emphasis is
placed on the development of new mathematical formulas that facilitate the computation
of the forward kinematic model of a flexible continuum robot with variable curvature.
The forward kinematic model of a flexible manipulator addresses the problem of
identifying the end effector position for a defined manipulator configuration. For a
rigid manipulator, this configuration is simply the set of variables associated with the
robot’s joints; unlike rigid robots, the variables that express the configuration of a
flexible manipulator change with respect to the robot’s morphology and its type of
actuation, and thus cannot be obtained in a direct way. For this reason, research on
the modeling of flexible continuum robots is interested in ways to develop exhaustive
forward kinematic models while respecting the maximum of specificities and mechanical
properties of the studied robot. The approach adapted to this task, is to assimilate the
central axis of the robot to a theoretical curve using a reference frame evolving along
the central axis of the structure, with the aim of having a continuous model of the
central axis of the robot. In this chapter, the formula developed for continuum robots
with variable curvature can be easily applied on flexible robots that have a structure
whose deformation is similar to serially-connected arcs. In the following, the geometry
of a cable-driven continuum robot with constant and variable curvature is discussed.
20
Forward kinematic modeling
Fig. 2.1: (Left) The total robot structure with global coordinates for each section,
(Right) Placement of reference frames on the central axis for each unit
21
Forward kinematic modeling
Fig. 2.2: (Left) Description of a unit with conical and cylindrical shape (j, k), (Right)
The variation of the cables length for the two conical and cylindrical shapes
In the general case, the base of the unit is fixed and the upper part is mobile. They
are connected by three segments i (i=1,2,3).
Each segment connects the two platforms at the points Ai,j,k and Bi,j,k for the case
⌢
of a cylindrical shape unit respectively, while Ai,j,k , B i,j,k connects the fixed platform
and the mobile one which has a conical shape (conical disc), (figure 2.2).
The length of cable that connects the disks of a cylindrical unit is denoted by
ℓi,j,k and that which connects the disks of a conical unit is denoted by ℓ̂i,j,k . Each
cylindrical unit is parameterized by its orientation angle φk , its bending angle θj,k , and
its curvature κj,k .
22
Forward kinematic modeling
In order to be able to compute the forward kinematic model of each unit constituting
the robot, an intermediate reference frame Rj,k is assigned to the center of the platform
of each unit (j, k).
The description of a flexible section from its base to its end is as follows: the indices
of the units j increase from 1 to m, and for each intermediate platform (j, k), the
distance between the central axis and the anchor points is noted rj,k (figure 2.2 (left))
The unit (j, k), is modeled as an inextensible arc of a circle. This unit has one end
23
Forward kinematic modeling
fixed at the origin of the reference frame Oj−1,k , the other end Oj,k is located at a
point in the reachable workspace as shown in figure 2.2.
• Each unit of conical shape is modeled as an inextensible circular arc having its
individual parameter;
• Robot deformations at sections and units are done without torsion (torsion
neglected);
24
Forward kinematic modeling
Assuming that each unit deforms in the form of a circular arc. The homogeneous
transformation can be written by the following equation [25] :
j−1,k j−1,k
j−1,k Rj,k Oj,k
Tj,k = (2.1)
01×3 1
j−1,k j−1,k
With Rj,k and Oj,k are respectively the (3 × 3) matrix and the (3 × 1) vector
defining the orientation and the position of the origin of the reference frame Rj,k in the
j−1,k
reference frame Rj−1,k . Under the above assumptions, the orientation matrix Rj,k is
given by the following equation [47]:
j−1,k
Rj,k = rot Zj−1,k , φk rot Yj−1,k , θj,k rot(Zj−1,k , −φk )
c2 φk cθj,k + s2 φk
cφk cθj,k sφk − cφk sφk cφk sθj,k
s2 φk cθj,k + c2 φk
= cφk cθj,k sφk − cφk sφk
sφk sθj,k
(2.2)
−cφk sθj,k −sφk sθj,k cθj,k
25
Forward kinematic modeling
lj,k
θ 1 − cos θj,k cos (φk )
j,k
j−1,k l
Oj,k = θj,k 1 − cos θj,k sin (φk ) (2.3)
j,k
l
j,k sin (φk )
θj,k
In order to make the length of the cables appear in the orientation matrix, a specific
transformation is established. It expresses the length of the cables ℓi,j,k , of each unit
(j, k) as a function of the arc parameters which are the orientation angle φj,k , the
bending angle θj,k [rad] and its curvature κj,k [1/mm]. First, the orientation angle
φj,k must be calculated.
As the diameter of each disk is included, we provide a general equation that allows
to determine each of them:
j
rj,k = rmax,k − rmax,k − rmin,k (2.4)
k
Where rmax,k and rmin,k are, respectively, the minimum and maximum radius of the
section k. When the orientation anglehis equalito 0, the central axis of the unit takes
T
the form of a circular arc with center dj,k , 0, 0 .
Similarly, the points Ai,j,k and Bi,j,k where the cables are attached will lie in an arc
h iT
of a circle with center di,j,k , 0, 0 . Based on these results, we can obtain the following
equation:
θj,k
lj,k [mm] = (2.5)
κj,k
This can be described by the equation eqrefeq:eq2.6 based on figure 2.5, where dj,k
is the radius of curvature of the unit (j, k) and di,j,k the radius of curvature for each
cable.
26
Forward kinematic modeling
Fig. 2.5: Definition of the different radii of curvature of the unit (j, k)
Additionally, there is a relationship between the angle φj,k and γi,k . The angle γi,k
takes three values: −φj,k , 2π 2π
3 − φj,k , − 3 − φj,k , pour i = 1,2,3 respectively. Through
figure 2.5, the radius of curvature can be expressed as follows:
d1,j,k = dj,k − rj,k cos γ1,k
d
2,j,k
= dj,k − rj,k cos γ2,k (2.6)
3,j,k = dj,k − rj,k cos γ3,k
d
If we substitute the three values of γi,k into the equation (2.6), we can obtain the
following equation:
ℓ1,j,k = lj,k − rj,k θj,k cos γ1,k
ℓ
2,j,k
= lj,k − rj,k θj,k cos γ2,k (2.7)
3,j,k = lj,k − rj,k θj,k cos γ3,k
ℓ
According to the equation (2.7), one way to get φj,k out of this equation is to subtract
member by member the first equation from the second and the first equation from the
third, we will have
ℓ1,j,k − ℓ2,j,k = rj,k θj,k cos γ2,k − cos γ1,k
(2.8)
ℓ1,j,k − ℓ3,j,k = rj,k θj,k cos γ3,k − cos γ1,k
27
Forward kinematic modeling
By dividing the equations (2.8) member by member, we obtain the following equation:
2π
ℓ1,j,k − ℓ2,j,k rj,k θj,k cos 3 − φj,k − cos −φj,k
= (2.9)
ℓ1,j,k − ℓ3,j,k rj,k θj,k cos − 2π
3 − φj,k − cos −φj,k
Then, we replace γ1,k , γ2,k , γ3,k by their values, which allows to find the following
equality:
ℓ1,j,k − ℓ2,j,k cos 2π 2π
3 cos φj,k + sin 3 sin φj,k − cos −φj,k
= (2.10)
ℓ1,j,k − ℓ3,j,k cos − 2π cos φj,k + sin − 2π sin φj,k − cos −φj,k
3 3
In the following, a detailed procedure for obtaining the arc parameters is established
by replacing the angle γi,k with its values −φj,k , 2π 2π
3 − φj,k , − 3 − φj,k , for i = 1,2,3
respectively.
• 1st simplification : √
1
3
1 √3
2 ℓ1,j,k cos φj,k − 2 ℓ1,j,k sin φ j,k −√
ℓ 1,j,k cos φ j,k + 2 ℓ1,j,k cos φ j,k + 2 ℓ2,j,k sin φj,k +
ℓ√2,j,k cos φj,k = − 12 ℓ1,j,k cos φj,k + 23 ℓ1,j,k sin φj,k − ℓ1,j,k cos φj,k + 12 ℓ3,j,k cos φj,k −
3
2 ℓ3,j,k sin φj,k + ℓ3,j,k cos φj,k
• 2sd simplification :
√ 1 √3
+ 2 ℓ2,j,k sin φj,k +ℓ2,j,k cos φj,k = 12 ℓ3,j,k cos φj,k −
−
√
3ℓ1,j,k sin φj,k + 2 ℓ2,j,k cos φj,k
3
2 ℓ3,j,k sin φj,k + ℓ3,j,k cos φj,k
• 3th simplification :
√ √ √
− 3ℓ1,j,k sin φj,k + 32 ℓ2,j,k cos φj,k + 23 ℓ2,j,k sin φj,k = 32 ℓ3,j,k cos φj,k − 23 ℓ3,j,k sin φj,k
• 4√th simplification :
3 3
2 −2ℓ1,j,k + ℓ2,j,k + ℓ3,j,k sin φj,k = 2 ℓ3,j,k − ℓ2,j,k cos φj,k
• 5th simplification
√ :
sin(φj,k ) 3(ℓ −ℓ2,j,k )
cos(φj,k )
= −2ℓ 3,j,k
( 1,j,k +ℓ2,j,k +ℓ3,j,k )
28
Forward kinematic modeling
Having determined the orientation angle, we now calculate the radius of curvature
using the previously mentioned equation (2.7), summing the three members:
3lj,k = ℓ1,j,k + ℓ2,j,k + ℓ3,j,k + rj,k θj,k cos γ1,k + cos γ2,k + cos γ3,k (2.13)
3
X
cos γi,k = 0 (2.14)
i=1
The last parameter of the arc is the bending angle θj,k , which can be calculated by
substituting the equations (2.15) and (2.16) into (2.5), we then obtain: :
q
2 ℓ21,j,k + ℓ22,j,k + ℓ23,j,k − ℓ1,j,k ℓ2,j,k − ℓ1,j,k ℓ3,j,k − ℓ2,j,k ℓ3,j,k
θj,k = (2.17)
3rj,k
Knowing that each unit has a conical shape, the equations (2.18) must be expressed in
⌢
terms of the cable lengths ℓ i,j,k instead of ℓi,j,k . Therefore, according to the assumption
mentioned before; each conical shape unit is modeled as an inextensible arc with its
individual arc parameters and deforms at small angles, the relationship between these
two cable lengths is given by the law of cosines [50]:
29
Forward kinematic modeling
⌢2 2
2
ℓ i,j,k = ℓi,j,k + rj−1,k − rj,k − 2ℓi,j,k rj−1,k − rj,k cos βi,j,k (2.19)
With :
!
κj,k lj,k 2
cos βi,j,k = sin cos π (k − 1) − φj,k
2 3
After solving the equation (2.19), the length of the cables ℓi,j,k can be expressed as
follows: s
⌢2 2 2
ℓi,j,k = ℓ i,j,k − rj−1,k − rj,k + rj−1,k − rj,k cos2 βi,j,k
(2.20)
+ rj−1,k − rj,k cos βi,j,k
According to equation eqrefeq:eq2.200, the length of the cable ℓi,j,k is a function
⌢
of the length of the cable ℓ i,j,k , the variation in disc diameters for each conical unit
(rj−1,k − rj,k ) and the angle βi,j,k .
To find an approximate analytical solution between the lengths of the conical unit
⌢
cable ℓ i,j,k and the configuration state κj,k , the influence of βi,j,k on the lengths of the
cylindrical unit cable according to equation (2.20) must be negligible. Since the unit
taper cannot be changed, angles βi,j,k close to π2 are required. This can be achieved by
choosing a high number of units, because the bending angle θj,k of the unit decreases
with increasing number of units per section. In this case, the equation (2.20) simplifies
to : s
⌢2 2
ℓi,j,k = ℓ i,j,k − rj−1,k − rj,k (2.21)
q
With : Mj,k = 2 ℓ21,j,k + ℓ22,j,k + ℓ23,j,k − ℓ1,j,k ℓ2,j,k − ℓ1,j,k ℓ3,j,k − ℓ2,j,k ℓ3,j,k
30
Forward kinematic modeling
j−1,k
Where Tj,k is the (4×4) matrix defining the orientation and position of the origin of
the reference frame Rj,k in the reference frame Rj−1,k .
The parameters used for the considered section of the robot continuum are indicated
in the Table 2.1.
Table 2.2: The disc radii for each section of the robot
31
Forward kinematic modeling
at each bending angle, the three cable lengths take a certain value (As an example,
three configurations of the bending angles of the first unit figure 2.6 are shown). Using
equation (2.21), we determined the length of the cables of a unit with variable curvature
(VC) as a function of those of a unit with constant curvature (CC) by taking into
account the taper of each unit (different diameters).
Fig. 2.6: Unit with rmax = 25mm and rmin = 23.5mm; (Left) Bending angle θ = 0rad ;
(Center) Bending angle θ = 0.4rad; (right) Bending angle θ = 0.5rad
The cable lengths obtained for the first tapered unit will be evenly distributed over
the remaining units of the first section (4 units). In other words, for a given bending
angle, the cable lengths calculated for the first unit will be equally distributed over the
units of the section. After that, for each unit the bending angle is calculated by the
equation (2.17).
Fig. 2.7: Illustration of the distribution of the cable lengths of the first unit (1, k) over
the remaining units of the first section (k = 1)
32
Forward kinematic modeling
Fig. 2.8: Bending angles as a function of a given variation in cable length for each unit
(j, k).
From Figure 2.8, for a given variation in cable length for the first section, the
bending angle for each unit varies linearly. It is therefore clear that the bending angles
for each unit can be related to each other by a factor, which can be one of the geometric
or physical parameters of the robot.
Fig. 2.9: The ratios of the angles and disks for a given variation of the length of the
cables of the section (k = 1)
33
Forward kinematic modeling
According to figure 2.9, it is clear that the ratios of the angles as well as the ratios
of the disks have approximately the same value, this leads to an important observation
that lies in the establishment of a relationship between the angle of each unit and the
neighboring one according to the diameters of the disks.
In other words, a constant relationship that connects the arc bending angle and
the geometric parameters of the units of the section considered. Thus, we can obtain
the following relationship:
r1,k
θj,k = θ1,k (2.24)
rj,k
As the number of units increases, the accuracy of the solutions of the equation (2.24)
also increases, i.e., when the angle βi is closer to π2 (see Figure 2.2). Therefore, using
equation (2.24), the forward kinematic model of a single section can only be expressed
by two variables θ1,k and φk . This approximation leads to a remarkable simplification
and reduction of the number of variables involved in the FKM.
An illustration of the equation (2.24) is represented by figure 2.8 and 2.9. The
constant ratios for the arc parameters and the geometric parameters are shown in
figure 2.9.
Where the matrices T0orig and Tkk−1 represent the static transformation matrix and the
independent transformation matrix of each flexible section respectively.
34
Forward kinematic modeling
35
Forward kinematic modeling
36
Forward kinematic modeling
In Figure 2.11 and 2.12, it can be clearly seen that the variable curvature is able to
produce bending angles with increasing curvature, namely, the end point of the section
can reach much more curved positions vs. the constant curvature, which is similar to
the results obtained in [50].
In the second
h
example,
i
we vary the first bending angle for each section in the same
π π
range θj,k ∈ − 8 , 8 .
Fig. 2.13: View 2D for the workspace for a flexible continuum robot with constant
curvature: rmax = 25mm, rmin = 25mm
Fig. 2.14: 2D View of the workspace for a flexible continuum robot with variable
curvature: rmax = 25mm, rmin = 10mm
37
Forward kinematic modeling
Figure 2.13 and 2.14 show the workspace of a CC and VC flexible continuum robot
respectively. Comparatively, the end member of a VC flexible continuum robot can
reach much more curved positions vis-a-vis a CC continuum robot as shown in Figure
2.15.
Fig. 2.15: Comparison between the workspace for a flexible continuum robot at CC
and VC
38
Forward kinematic modeling
Table 2.3: Variation of cable lengths for the first simulation of the three-section
continuum robot
Table 2.4: Variation of cable lengths for the second simulation of the three-section
continuum robot
39
Forward kinematic modeling
2.6 Conclusion
In this chapter, we have presented the forward kinematic modeling of a flexible
continuum robot with variable curvature. This model allows to know the working
space of the robot. The forward kinematic model of the flexible continuum robot with
variable curvature is simplified by implementing the mathematical equation relating
the bending angles of each robot unit belonging to the same section. The calculation
of the forward kinematic model for this robot starts with the unit model which is
obtained by using the homogeneous transformation matrix and is summarized in two
steps: the specific transformation which expresses the relationship between the arc
parameters and the lengths of the cables, and then the independent transformation
which expresses the desired situation (position) as a function of the arc parameters.
The forward kinematic model of the flexible section and the whole robot are obtained
by successive multiplication of the global geometric transformation matrices of the
units. We concluded this chapter with a comparison between the workspace of a flexible
continuum robot with constant and variable curvature.
40
Chapter 3
3.1 Introduction
In this chapter, a meta-heuristic approach to solving the inverse kinematic model of
the variable curvature (VC) flexible continuum robot is presented. We start the first
part of this chapter by verifying the effectiveness of the proposed approach using the
direct geometric model explicitly, by comparing the bending and orientation angles
obtained by the direct geometric model of a section and those obtained by the proposed
algorithm. Then, we apply the proposed particle swarm optimization (PSO) algorithm
to solve the inverse kinematic model of a multi-section flexible continuum robot with
specific constraints. In the rest of this chapter, two other meta-heuristic approaches,
namely the artificial bee colony (ABC) and the genetic algorithm (GA), are proposed
to solve the inverse kinematic model of continuum robots. A comparison between the
three methods in terms of accuracy and convergence has been made.
41
Inverse kinematic modeling
• curvature κ
• Orientation angle φ
• Bending angle θ
For the calculation of the arc parameters, according to figure 3.1, it is obviously
clear that the orientation angle φ can be expressed as follows [76] :
y
−1
φ = tan (3.1)
x
The center of the arc lies in the plane xy; after rotation, this center must lie along
the axis x. Therefore, the radius r of the center of this arc c lies in (r, 0) with respect
to the plane xz.
42
Inverse kinematic modeling
The curvature κ can be determined by finding the distance between the origin and
′
the center of the arc formed by the continuous section. By rotating P around the
′ ′ ′ √ ′ ′
axis z , this creates P such that x = x2 + y 2 , y = 0 and z = z. From figure 3.2,
′ ′ ′
explicitly from the triangle P c x , we can write the following equation:
′ 2 ′
x −r + z 2 = r2 (3.2)
′ ′ ′
x 2 + r2 − 2x r + z 2 − r2 = 0
′ ′ ′
2x r = x 2 + z 2
′
−1 2x
κ=r = ′2 ′
z +x 2
′ ′
Substituting x and z , we get:
q
2 x2 + y 2
κ= 2 (3.3)
x + y2 + z2
The angle θ, as shown in figure 3.2, can be calculated from the curvature and the
′ ′ ′
Cartesian coordinates of P . Examining the triangle P c x we can write:
′ ′
x −r κ−1 − x
cos (π − θ) = = (3.4)
r κ−1
43
Inverse kinematic modeling
For z ≤ 0 we get :
′
κ−1 − x q
θ = 2π − cos−1 = 2π − cos−1
1 − κ x2 + y 2 (3.5)
κ−1
44
Inverse kinematic modeling
that aim to reach optimal solutions through iterations that are updated. At each
iteration step, four pieces of information are available for each particle: the first piece
of information is the local position vector of the best solution obtained and is denoted
by Pb (t). The second one is the position visited by the particles that have been selected
by the best experiments of all the particles, it represents the best global position and
is denoted by Pgb (t). Other information is the current position of a particle in the
given search space and which is called by a vector P (t) and its velocity given by v (t).
Therefore, the velocities and the positions of the particles continue to change at each
step until they agree according to the equation (3.7):
v (t + 1) = wv (t) + c1 λ1 (Pb (t) − P (t)) + c2 λ2 Pgb (t) − P (t)
(3.7)
P (t + 1) = P (t) + v (t + 1)
Where ω is the weight of inertia; λ1 , λ2 are two positive constants; and which are
given in a random way with uniform distribution between 0 and 1. The importance of
the parameters involved in the equation (3.7) is to provide the algorithm’s behavior
with the necessary convergence. For example, the inertia gives the rate of convergence
of the algorithm, in some difficult problems the rate must be applied in small increments
in order to keep the algorithm stable, and the coefficients c1 et c2 guide the tendency
of the swarm to converge to a local or global level for a better solution.
Where XD and XG are, respectively, the desired and generated Cartesian coordinates
of the robot continuum end-member which are given by the fourth column of the
homogeneous matrix defined in equation (2.25). robot continuum which are given by
the fourth column of the homogeneous matrix defined in equation (2.25). On the other
hand, due to the hyper-redundancy of the continuum robot, the equation (3.8) has an
45
Inverse kinematic modeling
46
Inverse kinematic modeling
for each sample, for the bending angle θ1 see figure 3.4 and for the orientation angle φ
see figure 3.7. We can see that there is a significant convergence between them, where
the maximum error is less than 0.005 rad.
Fig. 3.3: Representation of the initial and final configuration of the first section of the
flexible continuum robot while following the desired trajectory in its own 3D workspace
47
Inverse kinematic modeling
Fig. 3.5: The execution time to accomplish the arc-shaped path tracking
Fig. 3.6: The accuracy of the PSO method for arc-shaped trajectory tracking
Figure 3.6 shows the cost function (precision) during the tracking of the trajectory
which has the shape of an arc of a circle (the desired trajectory is shown in figure 3.3) .
48
Inverse kinematic modeling
From figure 3.4 and 3.7, it is obviously clear that the bending and orientation angles
obtained from the proposed algorithm are very close to the bending and orientation
angles calculated from the direct geometrical model. According to the results obtained
in this example, the developed algorithm is validated as a powerful tool to solve the
inverse kinematic model of a flexible continuum robot with variable curvature robot.
49
Inverse kinematic modeling
Fig. 3.8: Possible solutions for each point constituting the linear trajectory
Fig. 3.9: Some configurations of the robot following the linear trajectory with
constraints: θ2 > 0 and 0 < φ1 , φ2 < 10−5
50
Inverse kinematic modeling
Fig. 3.10: Some configurations of the robot following the linear trajectory with
constraints: θ2 < 0 and 0 < φ1 , φ2 < 10−5
Fig. 3.11: Calculated cable length for the first section (first configuration)
51
Inverse kinematic modeling
Fig. 3.12: Calculated cable length for the second section (first configuration)
Figures 3.11 and 3.12 show the variation in cable lengths for each section, so it
is interesting to know which of the existing configurations allows the robot to follow
the desired trajectory with the smallest possible cable length. This gives rise to a
better use of the energy generated by the robot motor. For this purpose, we used these
constraints θ2 < 0 and θ2 < 0 et 0 < φ1 , φ2 < 10−5 ( figure 3.10).
Fig. 3.13: Calculated cable length for the first section (second configuration)
52
Inverse kinematic modeling
Fig. 3.14: Calculated cable length for the second section (second configuration)
After calculating the cable lengths used for the two configurations, we find that the
configuration θ2 < 0 and 0 < φ1 , φ2 < 10−5 gives better performance in terms of energy
as shown in Table 3.1. The calculation of the cable length is strongly related to the
Table 3.1: Cable lengths for both configurations
approximation proposed by the equation (2.24), which is clearly visible in the profile
of the cable length of each unit, as shown in Figures 3.15 -3.20. As the bending of a
section increases, the length of the cables in each unit decreases in an orderly fashion
from bottom to top.
In order to grasp this phenomenon, we can refer to the second section, where the
bending of the robot is huge, especially the last position. From these observations, we
can say that the length of the six cables converges to the last point as shown in figures
3.18 -3.20. Also, we notice that there are several configurations that allow the robot to
follow the desired trajectory, but the one that provides the smallest length of cable can
be considered the most efficient in terms of energy.
53
Inverse kinematic modeling
Fig. 3.15: Profile of the cable length L1 for the units of the first section (linear
trajectory)
Fig. 3.16: Profile of the cable length L2 for the units of the first section (linear
trajectory)
54
Inverse kinematic modeling
Fig. 3.17: Profile of the cable length L3 for the units of the first section (linear
trajectory)
Fig. 3.18: Profile of the cable length L4 for the units of the second section (linear
trajectory)
55
Inverse kinematic modeling
Fig. 3.19: Profile of the cable length L5 for the units of the second section (linear
trajectory)
Fig. 3.20: Profile of the cable length L6 for the units of the second section (linear
trajectory)
56
Inverse kinematic modeling
Fig. 3.21: Some configurations of the central axis of the robot when following the
desired circular path
.
57
Inverse kinematic modeling
Fig. 3.22: Comparison between the generated trajectory and the desired one and their
Euclidean errors
.
As shown in figure 3.22, it is very clear that the generated trajectory is very close
to the desired one which confirms the robustness of the developed algorithm as well
as the reliability of the equations proposed in chapter 2.2. Also, the lower part of the
figure 3.22 shows the Euclidean errors between the desired trajectory and the generated
one. They are almost negligible, of the order of 10−6 mm.
By On the basis of the results obtained, we can easily calculate the lengths of the
cables as well as the bending and orientation angles for each section of the robot with
precision.
58
Inverse kinematic modeling
Fig. 3.23: Profile of cable lengths for the first section while following the circular path
(first configuration)
Fig. 3.24: Profile of cable lengths for the second section while following the circular
path (first configuration)
59
Inverse kinematic modeling
60
Inverse kinematic modeling
Now we consider another configuration as followsθ1,1 > 0, θ1,2 > 0 and 0 < Y1 < 10−6 ,
and we calculate the length of the cables (see figure 3.27 and 3.28)
Fig. 3.27: Profile of cable lengths for the first section while following the circular path
(second configuration)
Fig. 3.28: Profile of cable lengths for the second section while following the circular
path (second configuration)
61
Inverse kinematic modeling
According to the configurations used to make the robot follow the circular path
with better performance, the second performance, the second configuration allows the
least use of the cable length.
As in the previous example, when following the circular path, the cable length of
each unit can be calculated, as shown in the figures below. Similar to the previous
example, when following the circular path, the length of the cables of each unit can be
calculated, as shown in the figures below.
Fig. 3.29: Profile of the cables length for the units of the first section (circular path)
Fig. 3.30: Profile of the cables length for the units of the second section (circular path)
In the same context, we consider a spiral trajectory defined by the equation (3.11)
with the following constraints: θ1,1 < 0, θ1,2 > 0 and 0 < Y1 < 10−6 .
The considered robot follows a trajectory with a small increment of angles in
order to confirm that the developed algorithm is able to solve the IKM whatever the
62
Inverse kinematic modeling
From figure 3.31, the algorithm must find remarkably small angles that can fit the
desired trajectory. In figure 3.32, we compare the generated trajectory with the desired
one.
It is confirmed that the equation developed in Chapter 2 and the algorithm estab-
lished in Chapter 3 are effective in solving the inverse kinematic model problem for a
continuum robot with variable curvature.
63
Inverse kinematic modeling
Fig. 3.32: Comparison between the generated spiral path and the desired one with
their Euclidean errors
Fig. 3.33: Cable length profile for the first section (spiral path)
64
Inverse kinematic modeling
Fig. 3.34: Cable length profile for the second section (spiral path)
65
Inverse kinematic modeling
As shown in figure 3.33 and 3.34, the length of the cables needed for the robot to
follow the spiral path is successfully calculated as well as the bending and orientations
angles (see figure 3.35 and 3.36)
Fig. 3.37: Profile of the cable length L1 for the units of the first section for the spiral
path
66
Inverse kinematic modeling
Fig. 3.38: Profile of the cable length L2 for the units of the first section for the spiral
path
Fig. 3.39: Profile of the cable length L3 for the units of the first section for the spiral
path
67
Inverse kinematic modeling
Fig. 3.40: Profile of the cable length L4 for the units of the second section for the
spiral path
Fig. 3.41: Profile of the cable length L5 for the units of the second section for the
spiral path
68
Inverse kinematic modeling
Fig. 3.42: Profile of the cable length L6 for the units of the second section for the
spiral path
69
Inverse kinematic modeling
Table 3.2: The parameters used for the three optimization methods
• In this phase, the bees carry information about the target source and skillfully
share it with the other bees, including the direction, quality of the food. In
the employed bees phase, each employed bee finds a new food source Xi in the
neighborhood of its current source xi and compares the new one with the current
solution. The employed bee saves the best one thanks to a greedy selection
mechanism and the food source, to describe mathematically this phase, it can be
explained as follows:
Xi = xi + si (xi − λi ) (3.12)
where xi is the new position vector of the solution, si is a random number between
-1 and 1, and λi a random number representing the random order in the position
vector.
• Spectator bees: A random number of bees await the worker bees from a randomly
discovered food source. Once they arrive, the visiting bees receive information
through a particular type of dance (waggle dance). In addition, the visiting bees
use probability to choose the best solution. To capture how the visiting bees
use probability, the roulette wheel section method, which is a fitness-based value
70
Inverse kinematic modeling
fi
Xi = pop (3.13)
P
fi
i=1
wherefi is the value of the objective function and pop is the size of the used bees.
• Scout bees: all bees are considered as scouts, and then they are converted to
employed or spectator bees during the run. If the position of the employed bees
does not change after trials, they are forced to abandon their position and convert
to scouts.
71
Inverse kinematic modeling
Fig. 3.43: Flexible continuum robot with a single section following a circular path
.
As can be seen in figure 3.44 and 3.45, for each approach, the time consumption as
well as the cost function are calculated based on the samples.
It is clear that the ABC approach has the lowest cost function, which gives better
accuracy, in other words; the robot with a single section accurately follows the circular
path. Comparatively, ABC outperforms PSO and GA in terms of accuracy.
72
Inverse kinematic modeling
Fig. 3.44: Value of the cost function for the three meta-heuristic algorithms
However, in figure 3.45, the ABC algorithm takes relatively long time to get good
results, especially when compared with GA and PSO.
On the other hand, PSO offers the best time consumption, which is preferable for
real-time applications, at least compared to GA and ABC.
73
Inverse kinematic modeling
• Le deuxième exemple:
In the second simulation example, additional bending angles will be used, namely
the bending angles of the second robot section with the following constraints:
θ1,1 < 0, θ1,2 > 0 and 0 < Y1 < 10−6 . In fact, the whole operation of following the
spiral path is relatively difficult compared to the previous example.
Fig. 3.46: Value of the cost function for the three meta-heuristic algorithms (spiral
path)
Fig. 3.47: Execution time for the three meta-heuristic algorithms (spiral path)
Explicitly, the algorithms must find the necessary bending angles for each section
of the robot, provided that the bending and orientation angles generated for the first
section are appropriate compared to those generated for the second section when
following the spiral path.
74
Inverse kinematic modeling
Fig. 3.48: The first bending angle obtained by the three meta-heuristic approaches to
follow the spiral trajectory
Fig. 3.49: The second bending angle obtained by the three meta-heuristic approaches
to follow the spiral trajectory
75
Inverse kinematic modeling
3.6 Conclusion
This chapter discusses different meta-heuristic approaches, namely PSO, GA and
ABC to solve the inverse kinematic model of flexible continuum robots with variable
curvature. The inverse kinematic model problem is established as an objective function
describing the distance between the robot end-effector and the desired trajectory. It is
found that the PSO algorithm is more suitable when it comes to a real-time application
compared to GA and ABC. However, its accuracy is less than ABC and GA. On the
other hand, ABC proves its good accuracy towards the resolution of the continuum
robot IKM. In order to validate this comparison, various examples of simulations have
been established.
76
Chapter 4
4.1 Introduction
A cable driven continuum robot is a particular type of robot that uses discrete cable
connections to control it. The mechanism that defines this robot consists of a fixed
platform which itself composed of:
77
Conceptual study of the two-section continuum flexible robot
∂ 4y ∂ 2y q ∂ 2y
EI + P + =0 (4.1)
∂x4 ∂x2 g ∂t2
With : I : Moment of inertia of the rod, f racqg : The force applied to the rod, f racqg
The mass per unit length, y and x: Displacements, f racqg: Time.
78
Conceptual study of the two-section continuum flexible robot
Due to the complexity and demanding conditions for solving this equation, we
simply consider the case of the trailing force as a simple buckling case. Since the force
on the cables is parallel to the axis of the rod, then it exerts a compression on the last
disk which results in a buckling phenomenon on the rod. La notion de flambement
s’applique généralement à des poutres élancées qui lorsqu’elles sont soumises à un effort
normal de compression (physique), ont tendance à fléchir et se déformer dans une
direction perpendiculaire à l’axe de compression (passage d’un état de compression à
un état de flexion).
M = p (y − a) (4.2)
∂ 2y
EI = Py−Pa (4.3)
∂ 2x
With: E: Young’s modulus (GPA), I: moment of inertia (mm2 ).
The general solution of the equation (4.2) is :
s s
P P
y = A cos x + B sin x +a (4.4)
EI EI
79
Conceptual study of the two-section continuum flexible robot
80
Conceptual study of the two-section continuum flexible robot
Fig. 4.5: The location of the control mechanism on the fixed base
81
Conceptual study of the two-section continuum flexible robot
π 2 EI
F= (4.7)
4L2
h i
E = 34.5 [GPA] = 34.5 KN.mm2 : Young modulus of Kevlar
L = 400 [mm] : length of the rod for the first section
4
I : moment of inertia of the rod I = πd
64 (d = 12mm)
For a numerical application:
82
Conceptual study of the two-section continuum flexible robot
Thus
2
d2 = ◦ × 20 = 41.41 [mm] (4.10)
cos 15
The bending strength of the tooth should be checked by the following equation:
v
T
u
u
mr = 2.34 × t (4.11)
k × cos β × σp
2 × Mt 2 × F × Rp
F t2 = = (4.12)
d d
With Mt is the torsional momenth in [N.mm],
i
Rp = 35[mm] is the radius of the pulley.
2
The practical elasticity stress in KN.mm can be expressed as follows :
σe
σp = (4.13)
s
With σe is the elastic limit stress, s = 2.75 is the safety coefficient.
For steel 16MnCr5:
σe = 440[N N/mm2 ]
k = π ◦ = 12.13 ≈ 13
sin 15
So we will have: v
T
u
u
mr ≥ 2.34 × t = 1.57 [mm] (4.14)
k × cos β × σp
83
Conceptual study of the two-section continuum flexible robot
Designations Relations
The real module mr mr mr = 2 [mm]
The apparent module ma2 ma2 ma2 = mr × cos β = 2.07 [mm]
The number of teeth z2 z2 z2 = 20 dent
◦
Angle de pression α α = 20
◦ ◦ ◦
Angle of the helix β = 15 Direction of the helix : right or left 15 ≤ β ≤ 30
Primitive d2 d2 = ma2 × z2 = 41.41 [mm]
From the top da2 da2 = d2 + 2mr = 45.41 [mm]
Diameters
From foot df 2 df 2 = d2 − 2.5mr = 36.41 [mm]
Height h h = 2.25 × mr = 4.5 [mm]
Hollow hf hf = 1.25 × mr = 2.5 [mm]
Projected ha ha = mr = 2 [mm]
Width b b ≥ πm r
sin β = 24.27 [mm]
Characteristic of the teeth
Reel step pr pr = π × mr = 6.28 [mm]
Apparent step pa pa = π × ma = 6.50 [mm]
Thickness e e = p2r = 3.14 [mm]
Interval i i = p2r = 3.14 [mm]
z1 z2
Center distance a a = m2r cos γ + cos β
z1 d1 1
Transmission ratio k12 k12 = z2 = d2 = 10
radial Force :
tgα
Fr2 = Ft2 × = 344.93[N ] (4.17)
cos β
84
Conceptual study of the two-section continuum flexible robot
Table 4.4: Results of the calculation of the allowable power following the rupture
◦
The wheel : z1 = 20 , mr = 2mm β = 15
N : rotational speed N = 100 [tr/ min]
Permissible efforts Ftadm Ftadm = 394.05 [daN ]
10−6 mr
Allowable power Pa dim Pmax < Pa dim = 1.96 × cos β N × Z × Ftadm = 0.83 [KW ]
85
Conceptual study of the two-section continuum flexible robot
Table 4.6: Results of the calculation of the admissible power at surface pressure
◦
The wheel : z2 = 20 , mr = 2mm β = 15
N : Rotational speed N = 100 [tr/ min]
Ftadm : Allowable forces Ftadm = 143.38 [daN ]
10−6 mr
Padm : Admissible power Pmax < Padm = 1.96 × cos β N × Z × Ftadm = 0.30 [KW ]
86
Conceptual study of the two-section continuum flexible robot
Mt : Torsional moment
Ft2 : Tangential force of the screw [N]
Designations Relations
The real module mr mr mr = 2[mm]
mr
The apparent module ma1 ma1 ma1 = cos γ = 7.22 [mm]
The number of nets z1 z1 z1 = n = 2
Pressure angle α α = 20◦
Angle of the helix β + γ = 90◦ Helix direction: left or right γ = 75◦
from bottom df 1 df 1 = df 1 − 2.5 × mr = 10.44 [mm]
Primitives d1 d1 = dma × z1 = 15.44 [mm]
Diameters From head da1 da1 = d1 + 2 × mr = 19.44 [mm]
Height h h = 2.25 × mr = 4.5 [mm]
Hollow hf = 1.25 × mr = 2.5 [mm]
Projection ha ha = mr = 2 [mm]
Length l l ≥ 6 × ma1 = 46.36 [mm]
reel step pr pr = π × mr = 6.28 [mm]
Characteristic of the teeth apparent step p a pa = π × ma = 24.25 [mm]
thickness e e = p2r = 3.14 [mm]
range i i = p2r = 3.14 [mm]
Center distance a a = 0.5 × (d1 + d1 ) = 28.42 [mm]
w2 d1 z1 1
Transmission ratio k w1 = d2 tgβ = z2 = 10
87
Conceptual study of the two-section continuum flexible robot
Mt Mt
τmax = = πd3 (4.24)
Wpnet
16
88
Conceptual study of the two-section continuum flexible robot
d : shaft diameter
1
n = r 2 ≥2 (4.26)
1 1
nσ + nτ
τ−1
nτ = kτ
(4.28)
βετ τα + ψτ τm
→ For the axes animated by a rotational movement the stresses being symmetrical
σm = 0, Therefore :
σ−1
n = nσ = kσ
(4.29)
β εσ σ α
When the stresses vary according to a pulsating cycle as in the case of fixed axes
Therefore:
2σ−1
n = nσ = (4.30)
σmax βkεσ + ψσ
σ
89
Conceptual study of the two-section continuum flexible robot
→ Symmetrical cycle:
For σm = 0
Mf
σa = σmax = (4.31)
Wf net
For τm = 0
Mt
τa = τmax = (4.32)
Wpnet
→ Pulsating cycle:
‘
Mf
σmax Wf net
σm = σa = = (4.33)
2 2
Mt
τmax W
τm = τa = = pnet (4.34)
2 2
The location of the key is taken into account here
kσ kτ
ψσ , ψτ Material sensitivity coefficient And εσ , ετ Stress concentration coefficient
!
kτ kσ
= 1 + 0.6 × −1 (4.37)
ετ εσ
→ Law of bending
σ−1 = 0.43 × R (4.38)
90
Conceptual study of the two-section continuum flexible robot
Steel ψσ ψτ
Mild steel 0.15 0.05
Medium carbon steel 0.20 0.10
→ Law of torsion
τ−1 = 0.58 × R (4.39)
h i
R : Fracture stress daN/mm2
4.5.3 Application
◦
→ Calculation of the shaft N 2
Fig. 4.9: Forces and reactions acting on the screw shaft in the vertical plane
X d2
MB = F × 75 − Fa2 × − Fr2 × 22.5 − RAv × 45 = 0 (4.40)
2
91
Conceptual study of the two-section continuum flexible robot
X d2
MA = F × 30 − Fa2 × + Fr2 × 22.5 − RBv × 45 = 0 (4.42)
2
F × 30 − Fa2 × d22 + Fr2 × 22.5
RBv = = 420.63 [N ] (4.43)
45
Verification :
Alors :
Mvmax = Mv1 = 16246.2 [N.mm] (4.48)
Fig. 4.10: Forces and reactions acting on the screw shaft in the horizontal plane
Where
Ft2 × 22.5 915.42 × 22.5
RAH = = = 457.71 [N ] (4.50)
45 45
X
MA = RBH × 45 + Ft2 × 22.5 = 0 (4.51)
92
Conceptual study of the two-section continuum flexible robot
Where
Ft2 × 22.5 915.42 × 22.5
RBH = = = 457.7 [N ] (4.52)
45 45
Verification :
Ft2 − RAH − RBH = 0
915.42 − 457.71 − 457.71 = 0 (4.53)
MH1 = 0
u√
v v
uq
u M2 + M2
3
u fres t u
3 17819.882 + 18953.92
d= × 32 = × 32 = 11.83 [mm] (4.57)
t t
π [σeq ] π × 160
→ For bending
h i
σ−1 = 0.43 × R = 0.43 × 60 = 25.8 daN.mm2 (4.58)
→ For torsion
h i
τ−1 = 0.58 × R = 0.43 × 60 = 14.96 daN.mm2 (4.59)
kσ
= 1.8 (4.60)
kσ
93
Conceptual study of the two-section continuum flexible robot
!
kτ kτ
= 1 + 1.6 × − 1 = 1 + 0.6 × (1.8 − 1) = 1.48 (4.61)
ετ ετ
Calculation of σa and τa , solicitation of a rotational movement being of symmetrical
cycle:
πd3 bd(d − p) 2
π × 11.833 4 × 2 11.83 − 22
Wf net = − = − = 129.86 (4.62)
32 2d 32 2 × 11.83
2
πd3 bd(d − p)2 π × 11.833 4 × 2 11.83 − 2
Wf net = − = − = 292.40 (4.63)
16 2d 16 2 × 11.83
Where
σ−1 25.8
nσ = kσ
= = 1.04 (4.64)
βεσ σa + ψσ σm
1.8 × 13.722 + 0.2 × 0
τ−1 14.96
nσ = kτ
= = 1.55 (4.65)
βετ τa + ψσ τm 1.48 × 6.4825 + 0.1 × 0
1 1
n = r 2 2 = r 2 = 0.86 ≺ 2 (4.66)
1 2
1 1 1
nσ + nτ 1.04 + 1.55
94
Conceptual study of the two-section continuum flexible robot
τ−1 14.96
nσ = kτ
= = 3.29 (4.72)
βετ τα
1.48 × 3.068
1 1
n = r 2 2 = r 2 = 1.88 ≺ 2 (4.73)
1 2
1 1 1
nσ + nτ 2.3 + 3.29
1 1
n = r 2 2 = r 2 = 2.31 ≻ 2 (4.80)
1 2
1 1 1
nσ + nτ 2.84 + 4.15
95
Conceptual study of the two-section continuum flexible robot
Fig. 4.11: Forces and reactions acting on the screw shaft in the vertical plane
X d1
MB = RAv × 71.08 + Fa1 × − Fr1 × 35.54 = 0 (4.81)
2
−Fa1 × d21 + Fr1 × 35.54 −915.42 × 15.44
2 + 344.93 × 35.54 = 73.04N (4.82)
RAv = =
71.08 71.08
X d1
M A = RBv × 71.08 + Fa1 × − Fr1 × 35.54 = 0 (4.83)
2
−Fa1 × d21 × Fr1 × 35.54 −915.42 × 15.55
2 + 344.93 × 35.54 = 271.88N (4.84)
RBv = =
71.08 71.08
Verification:
Fr1 − RAv − RBv = 344.93 − 73.04 − 271.88 = 0 (4.85)
Thus
Mvmax = Mv2 = 9662.61 [N.mm]
96
Conceptual study of the two-section continuum flexible robot
Fig. 4.12: The forces and reactions acting on the screw shaft in the horizontal plane
X
MB = RAH × 71.08 − Ft1 × 35.54 = 0 (4.88)
Ft1 × 35.54 245.28 × 35.54
RAH = = = 122.64N (4.89)
71.08 71.08
X
MA = RBH × 71.08 − Ft1 × 35.54 = 0 (4.90)
Ft1 × 35.54 245.28 × 35.54
RBH = = = 122.64N (4.91)
71.08 71.08
MH1 = MH2 = RAH × 35.54 = RBH × 35.54 = 9610.55 [N.mm] (4.92)
97
Conceptual study of the two-section continuum flexible robot
1 1
n = r 2 2 = r 2 2 = 2.12 ≻ 2 (4.103)
1 1 1 1
nσ + nτ 3.25 + 3.82
98
Conceptual study of the two-section continuum flexible robot
99
Conceptual study of the two-section continuum flexible robot
100
Conceptual study of the two-section continuum flexible robot
101
Conceptual study of the two-section continuum flexible robot
102
Conceptual study of the two-section continuum flexible robot
Fig. 4.17: 3D representation of the control system in 4 views (for a single cable)
103
Conceptual study of the two-section continuum flexible robot
4.8 Conclusion
In this chapter, we proposed a design for a cable-operated continuum robot. The
proposed design has two sections, each section has a separate control motor. Each
part of the control system is designed in detail on SolidWorks. The two sub-assemblies
controlling the robot are composed of different parts generally designed to ensure
proper operation of the robot.
104
Chapter 5
Dynamic modeling
5.1 Introduction
Equations of motion for continuum robots are useful for simulating their dynamic
behavior. In this chapter, we introduce dynamic partial differential equations that
describe the kinematic energy and potential energy of a flexible continuum robot.
Current research on the modeling of continuum manipulators is moving towards the
development of accurate dynamic models by taking into account more specificities
and mechanical properties. In the same context, we present the dynamic modeling of
a cable-driven continuum robot based on the Euler-Lagrange method.The dynamic
model is developed based on the equations of motion of a section with inextensible
bending and zero torsion.
The established model is based on the variable curvature using the equation
previously developed in chapter 2 (2.24) which relates each unit to the neighboring
unit belonging to the same section, we chose the variable curvature because it describes
the dynamic behavior of the continuum robot much better than the constant curvature
especially when the robot undergoes a dynamic force. The Taylor expansion is applied
to the geometrical model in order to avoid singularities and to reduce the complexity
of the mathematical expressions.
105
Dynamic modeling
the robot as a function of the forces and/or torques, the generalized coordinates and
their first derivatives.
Avec
Q1 : the first generalized force
Q2 : the second generalized force
T : the total kinetic energy of the robot
U : the total potential energy of the robot
θj,k : the bending angle for each unit (j, k)
φk : the angle of orientation
For variable curvature, each unit has its own bending angle, so we will have five
generalized coordinates. But if we use the equation (2.24), previously developed
in Chapter 2, the equation of motion will be expressed exclusively in terms of two
variablesθ1,k and φk .
106
Dynamic modeling
By means of the variable curvature assumption, the position vector Uj,k of any
point distant h from the origin of the reference frame Oj,k−1 can be expressed by the
equation (5.2).
hU
x U (h) = j,k 1 − cos θ hU cos (φk )
j,k j,k
θ hUj,k
hUj,k
y
Uj,k = Uj,k (h) = 1 − cos θ hUj,k sin (φk ) (5.2)
θ hUj,k
hU
zU (h) = j,k sin θ hU
j,k j,k
θ hUj,k
.
hUj,k θj,k r1,k
With θ hUj,k = lj,k , θj,k = rUj,k θ1,k et Uj,k the position vector of each point
located on the central axis of each unit. The linear velocity of any point away from
the origin can be calculated by differentiation with respect to time:
hUj,k hUj,k
lj,k l
ẋUj,k (h) = θ̇j,k θj,k sin lj,k θj,k − 2 H
θj,k
cos (φk ) − θj,k
j,k
H φ̇k
hU hUj,k
lj,k l
j,k
vh,j = ẏUj,k (h) = θ̇j,k θj,k sin lj,k θj,k H − 2
θj,k
sin (φk ) − θj,k
j,k
H φ̇k (5.3)
hUj,k hUj,k hUj,k
lj,k
żU (h) = θ̇ cos lj,k θj,k − sin lj,k θj,k
j,k j,k θj,k 2
θj,k
107
Dynamic modeling
hUj,k
With H = 1 − cos lj,k θj,k
Zj,k l
5
X1 2 2 2
Tb = mb ẋUj,k (h) + ẏUj,k (h) + żUj,k (h) (5.4)
j=1 2 0
Where mb is the mass of the rod. For more details on how to obtain the kinetic energy
using
For the kinematic energy of the disks, it can be obtained using the equation (5.5).
The weight of the disks being very small, for simplicity, we consider the same weight
for each disk. And since each unit has its own bending angle, we will have the potential
energy for each unit. Thus, the total kinematic energy of the disks can be obtained as
follows:
5
1X T
Td = vh,j mj vh,j (5.5)
2 j=1
For simplicity reasons, the kinetic energies of rotation are kinetic energies of rotation
are neglected. Thus, the total kinetic energy of a single section is given by :
T = Tb + Td (5.6)
With Tb : the total kinetic energy of the rod, and Td : the total kinetic energy of the
disks.
For potential energy, the flexible rod can be virtually divided into a series of flexible
rod fragmentation where each flexible rod has its own bending angle θj,k . As long as
the disks have low weight, we can only consider the potential energy of the rod, which
can be considered as follows:
5
EIb X
U = Up = θ2 (5.7)
2L j=1 j,k
Where Ib and E represent the moment of inertia and the young’s modulus of the rod,
respectively.
The parameters used for each equation are given in Table 5.2.
108
Dynamic modeling
θ̇2
θ̈ θ F
= Dt 1
Mt + Ct
θ̇ φ̇ + Kt
(5.9)
φ̈ φ F2
φ̇2
Avec:
M11 M12
Mt =
M21 M22
C11 C12 C13
Ct =
C21 C22 C23
K11 K12
Kt =
K21 K22
D11 D12
Dt =
D21 D22
109
Dynamic modeling
Table 5.1: The characteristics of a single section of the flexible continuum robot
The elements that make up the equation eqrefeq:eq4.9 can be expressed as follows:
mb L3 θ5 mb L3 θ3 126 m3 L3 θ2 mb L3 θ 2.1010 m5 L2 θ5
C11 = − + − − +
839204 18769 10000 381 100000
1.1364 m4 L2 θ4 6.5829 m2 L2 θ3 200000 m1 L2 θ
+ + −
14286000 10000 12300403
110
Dynamic modeling
17862 m4 L4 θ3 mb L3 θ5 mb L3 θ3 15983 m5 L3 θ2 mb L3 θ
C13 = − − + + −
282109 364 119 28982109 115
2
138 m3 L θ 5 2
591879 m2 L θ 3 2
2807 m1 L θ
− + −
10000 5030069 4700
mb L3 θ5 mb L3 θ3 281 m5 L3 θ2 mb L3 θ 214 m2 L2 θ5
C22 = − + + +
383 30 203196 69 10000
2
670011 m1 L θ 3 2
19337 m4 L θ 2 2
1978 m3 L θ
− − +
2210041 10000 21129
C12 = C21 = C23 = 0
32573 E Ib
K11 =
10000 L
The factors of the equation (5.9) were obtained by separating each factor from its
multiplier, e.g. M11 is multiplied by θ̈ and M22 by φ̈.
In order to solve this matrix system, namely to find the bending angles as well as
the orientation angle, we will use the Runge-Kutta method on Matlab.
Understanding this system opens the way to understanding the dynamic behavior of
the robot. That is why we define the variables used in this method as follows:
S1 (t) = θ
S2 (t) = θ̇
(5.10)
S3 (t) = φ
S4 (t) = φ̇
111
Dynamic modeling
Et :
D21 F1 + D22 F2 − C22 θ̇φ̇
φ̈ =
M22 (5.13)
D21 F1 + D22 F2 − C22 S2 S4
=
M22
Finally, the equation (5.10) can be written as follows:
Ṡ1 = S2
1
D11 F1 + D12 F2 − C11 S22 − C13 S42 − K11 S1
Ṡ2
= M11
(5.14)
Ṡ3 = S4
1
(D21 F1 + D22 F2 − C22 S2 S4 )
Ṡ4
= M22
π
If we provide the robot with an initial bending angle θ = 8 with zero tension on the
cables.
π
Fig. 5.2: The oscillation of the robot for θ = 8 and φ = 0
After releasing it, the robot oscillates from 22.5 to -22.55 degrees and after this
maximum level of oscillation that the robot can reach, we can observe that the oscillation
of the robot starts to decrease until it stabilizes at 18 seconds as shown in figure 5.2.
112
Dynamic modeling
For the second simulation example, we will apply a force equal to 3N on the first
cable, after releasing it, we can observe that the robot takes the equilibrium position
in 32.6° as shown in figure 5.3.
It should be noted that when implementing the Runge-kutta method for solving the
matrix system (5.9), we deliberately considered that the robot initially bends by an
angle of pi/5000, which avoids the non-convergence of the method used, and this can
be seen in Figure 5.3, namely that the robot is initially tilted by an angle of pi/5000
(0.036°) before applying the force.
113
Dynamic modeling
5.4 Conclusion
In this chapter, the direct dynamic model of a continuum (single section) robot with
variable curvature is developed by including the relationship that links the robot unit
with each other. Thus, the equation of motion can be expressed by two variables, the
bending angle and the orientation angle. The solution of the equation of motion is
performed using Runge-Kutta with Taylor expansion to avoid singularities.
114
Conclusion and future work
Overall in this work the following ideas have been addressed progressively:
✓ The use of optimization techniques to compute the inverse kinematic model (IGM)
of the variable curvature continuum robot namely: particle swarm optimization
(PSO), genetic algorithm (GA) and artificial bee colony (ABC). This computation
is studied as an optimization problem governed by an objective function that
defines the distance between the robot’s terminal organ and the desired trajectory
according to an imposed posture. A comparison between these three methods
is made in terms of accuracy and time consumption. It is found that the
PSO optimization technique converges quickly compared to both ABC and GA
methods. However, the ABC method provides better accuracy than PSO and
GA.
115
Conclusion and future work
The possible extensions of this current work are numerous, among the perspectives
that can be supported we cite:
✓ For the calculation of the forward kinematic model, where other specifications
can be added to the modeling phase, taking into account the possible extension
of the central axis as well as the torsion caused by some specific movement.
✓ Solve analytically the inverse kinematic model which allows fast convergence
when running a trajectory generation.
✓ For the dynamic model, the addition of frictional forces, torsional effect and
gravitational terms in the equation of motion of the robot to get closer to the
real dynamic behavior of the robot.
✓ Redo the same work but for a robot driven by a pneumatic system.
116
References
117
[13] A. Kapoor, N. Simaan, and R. H. Taylor, “Suturing in confined spaces: con-
strained motion control of a hybrid 8-DoF robot,” in ICAR’05. Proceedings., 12th
International Conference on Advanced Robotics, 2005., pp. 452–459, IEEE, 2005.
[14] J. Yang, P. Jason, and K. Abdel-Malek, “A hyper-redundant continuous robot,”
in Proceedings 2006 IEEE International Conference on Robotics and Automation,
2006. ICRA 2006., pp. 1854–1859, IEEE, 2006.
[15] H. Hu, P. Wang, B. Zhao, M. Li, and L. Sun, “Design of a novel snake-like
robotic colonoscope,” in 2009 IEEE International Conference on Robotics and
Biomimetics (ROBIO), pp. 1957–1961, IEEE, 2009.
[16] R. J. Webster III, J. M. Romano, and N. J. Cowan, “Mechanics of precurved-tube
continuum robots,” IEEE Transactions on Robotics, vol. 25, no. 1, pp. 67–78,
2008.
[17] A. Degani, H. Choset, B. Zubiate, T. Ota, and M. Zenati, “Highly articulated
robotic probe for minimally invasive surgery,” in 2008 30th Annual International
Conference of the IEEE Engineering in Medicine and Biology Society, pp. 3273–
3276, IEEE, 2008.
[18] Y. Chen, J. H. Chang, A. S. Greenlee, K. C. Cheung, A. H. Slocum, and R. Gupta,
“Multi-turn, tension-stiffening catheter navigation system,” in 2010 IEEE Interna-
tional Conference on Robotics and Automation, pp. 5570–5575, IEEE, 2010.
[19] T. Maahs, V. Saadat, C. Rothe, and T. Le, “Disposable shapelocking system,”
2006.
[20] E. Guglielmino, N. Tsagarakis, and D. G. Caldwell, “An octopus anatomy-inspired
robotic arm,” in 2010 IEEE/RSJ International Conference on Intelligent Robots
and Systems, pp. 3091–3096, IEEE, 2010.
[21] E. Guglielmino, L. Zullo, M. Cianchetti, M. Follador, D. Branson, and D. G.
Caldwell, “The application of embodiment theory to the design and control of an
octopus-like robotic arm,” in 2012 IEEE International Conference on Robotics
and Automation, pp. 5277–5282, IEEE, 2012.
[22] K. Hatazaki, M. Konyo, K. Isaki, S. Tadokoro, and F. Takemura, “Active scope
camera for urban search and rescue,” in 2007 IEEE/RSJ International Conference
on Intelligent Robots and Systems, pp. 2596–2602, IEEE, 2007.
[23] J. Ding, K. Xu, R. Goldman, P. Allen, D. Fowler, and N. Simaan, “Design,
simulation and evaluation of kinematic alternatives for insertable robotic effectors
platforms in single port access surgery,” in 2010 IEEE International Conference
on Robotics and Automation, pp. 1053–1058, IEEE, 2010.
[24] E. Ayvali and J. P. Desai, “Towards a discretely actuated steerable cannula,” in
2012 IEEE international conference on robotics and automation, pp. 1614–1619,
IEEE, 2012.
118
[25] R. J. Webster III and B. A. Jones, “Design and kinematic modeling of constant
curvature continuum robots: A review,” The International Journal of Robotics
Research, vol. 29, no. 13, pp. 1661–1683, 2010.
[26] V. C. Anderson and R. C. Horn, “Tensor arm manipulator,” 1970.
[27] Z. Li and R. Du, “Design and analysis of a bio-inspired wire-driven multi-section
flexible robot,” International Journal of Advanced Robotic Systems, vol. 10, no. 4,
p. 209, 2013.
[28] M. Mahvash and M. Zenati, “Toward a hybrid snake robot for single-port surgery,”
in 2011 Annual International Conference of the IEEE Engineering in Medicine
and Biology Society, pp. 5372–5375, IEEE, 2011.
[29] A. G. Festo and C. KG, “Bionic handling assistant,” Info-brochure. Festo, Esslingen,
Germany, 2010.
[30] C. Escande, P. M. Pathak, R. Merzouki, and V. Coelen, “Modelling of multisection
bionic manipulator: Application to robotinoxt,” in 2011 IEEE International
Conference on Robotics and Biomimetics, pp. 92–97, IEEE, 2011.
[31] J. Burgner-Kahrs, D. C. Rucker, and H. Choset, “Continuum robots for medical
applications: A survey,” IEEE Transactions on Robotics, vol. 31, no. 6, pp. 1261–
1280, 2015.
[32] G. S. Chirikjian, “Conformational modeling of continuum structures in robotics
and structural biology: A review,” Advanced Robotics, vol. 29, no. 13, pp. 817–829,
2015.
[33] J. D. Greer, T. K. Morimoto, A. M. Okamura, and E. W. Hawkes, “Series
pneumatic artificial muscles (sPAMs) and application to a soft continuum robot,”
in 2017 IEEE International Conference on Robotics and Automation (ICRA),
pp. 5503–5510, IEEE, 2017.
[34] I. S. Godage, E. Guglielmino, D. T. Branson, G. A. Medrano-Cerda, and D. G.
Caldwell, “Novel modal approach for kinematics of multisection continuum arms,”
in 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems,
pp. 1093–1098, IEEE, 2011.
[35] I. M. Loutfi, A. H. B. Boutchouang, A. Melingui, O. Lakhal, F. B. Motto, and
R. Merzouki, “Learning-Based Approaches for Forward Kinematic Modeling of
Continuum Manipulators,” IFAC-PapersOnLine, vol. 53, no. 2, pp. 9899–9904,
2020.
[36] A. Melingui, O. Lakhal, B. Daachi, J. B. Mbede, and R. Merzouki, “Adaptive neural
network control of a compact bionic handling arm,” IEEE/ASME Transactions
on Mechatronics, vol. 20, no. 6, pp. 2862–2875, 2015.
[37] M. I. Jordan and D. E. Rumelhart, “Forward models: Supervised learning with a
distal teacher,” Cognitive science, vol. 16, no. 3, pp. 307–354, 1992.
119
[38] A. Amouri, C. Mahfoudi, A. Zaatri, and H. Merabti, “A new approach to solve
inverse kinematics of a planar flexible continuum robot,” in AIP Conference
Proceedings, vol. 1618, pp. 643–646, American Institute of Physics, 2014.
[39] M. Rolf and J. J. Steil, “Efficient exploratory learning of inverse kinematics on
a bionic elephant trunk,” IEEE transactions on neural networks and learning
systems, vol. 25, no. 6, pp. 1147–1160, 2013.
[40] J. Merino, A. L. Threatt, I. D. Walker, and K. E. Green, “Forward kinematic model
for continuum robotic surfaces,” in 2012 IEEE/RSJ International Conference on
Intelligent Robots and Systems, pp. 3453–3460, IEEE, 2012.
[41] L. Fryziel, Modélisation et calibrage pour la commande d’un micro-robot continuum
dédié à la chirurgie mini-invasive. PhD thesis, Université Paris-Est, 2010.
[42] C. Escande, Towards modeling of a class of bionic manipulator robots. PhD thesis,
Lille 1, 2013.
[43] S. Neppalli and B. A. Jones, “Design, construction, and analysis of a continuum
robot,” in 2007 IEEE/RSJ International Conference on Intelligent Robots and
Systems, pp. 1503–1507, IEEE, 2007.
[44] D. C. Rucker, B. A. Jones, and R. J. Webster III, “A geometrically exact model
for externally loaded concentric-tube continuum robots,” IEEE transactions on
robotics, vol. 26, no. 5, pp. 769–780, 2010.
[45] Y. Bailly and Y. Amirat, “Modeling and control of a hybrid continuum active
catheter for aortic aneurysm treatment,” in Proceedings of the 2005 IEEE Inter-
national Conference on Robotics and Automation, pp. 924–929, IEEE, 2005.
[46] B. He, Z. Wang, Q. Li, H. Xie, and R. Shen, “An analytic method for the
kinematics and dynamics of a multiple-backbone continuum robot,” International
Journal of Advanced Robotic Systems, vol. 10, no. 1, p. 84, 2013.
[47] B. A. Jones and I. D. Walker, “Kinematics for multisection continuum robots,”
IEEE Transactions on Robotics, vol. 22, no. 1, pp. 43–55, 2006.
[48] C. Escande, T. Chettibi, R. Merzouki, V. Coelen, and P. M. Pathak, “Kinematic
calibration of a multisection bionic manipulator,” IEEE/ASME transactions on
mechatronics, vol. 20, no. 2, pp. 663–674, 2014.
[49] T. M. Bieze, F. Largilliere, A. Kruszewski, Z. Zhang, R. Merzouki, and C. Duriez,
“Finite element method-based kinematics and closed-loop control of soft, continuum
manipulators,” Soft robotics, vol. 5, no. 3, pp. 348–364, 2018.
[50] T. Mahl, A. Hildebrandt, and O. Sawodny, “A variable curvature continuum kine-
matics for kinematic control of the bionic handling assistant,” IEEE transactions
on robotics, vol. 30, no. 4, pp. 935–949, 2014.
[51] P. S. Gonthina, A. D. Kapadia, I. S. Godage, and I. D. Walker, “Modeling variable
curvature parallel continuum robots using euler curves,” in 2019 International
Conference on Robotics and Automation (ICRA), pp. 1679–1685, IEEE, 2019.
120
[52] H. Wu, J. Yu, J. Pan, and X. Pei, “A New Approach for Solving the Inverse
Kinematics of Continuum Robot Based on Piecewise Constant Curvature Model,”
2021.
[53] H. Mochiyama and T. Suzuki, “Kinematics and dynamics of a cable-like hyper-
flexible manipulator,” in 2003 IEEE International Conference on Robotics and
Automation (Cat. No. 03CH37422), vol. 3, pp. 3672–3677, IEEE, 2003.
[54] G. S. Chirikjian, “A continuum approach to hyper-redundant manipulator dynam-
ics,” in Proceedings of 1993 IEEE/RSJ International Conference on Intelligent
Robots and Systems (IROS’93), vol. 2, pp. 1059–1066, IEEE, 1993.
[55] G. S. Chirikjian, “Hyper-redundant manipulator dynamics: A continuum approxi-
mation,” Advanced Robotics, vol. 9, no. 3, pp. 217–243, 1994.
[56] V. Falkenhahn, T. Mahl, A. Hildebrandt, R. Neumann, and O. Sawodny, “Dy-
namic modeling of constant curvature continuum robots using the Euler-Lagrange
formalism,” in 2014 IEEE/RSJ International Conference on Intelligent Robots
and Systems, pp. 2428–2433, IEEE, 2014.
[57] A. Amouri, A. Zaatri, and C. Mahfoudi, “Dynamic modeling of a class of continuum
manipulators in fixed orientation,” Journal of Intelligent & Robotic Systems, vol. 91,
no. 3, pp. 413–424, 2018.
[58] Z. Li, Wire-driven mechanism and highly efficient propulsion in water. The Chinese
University of Hong Kong (People’s Republic of China), 2013.
[59] W. S. Rone and P. Ben-Tzvi, “Continuum robot dynamics utilizing the principle
of virtual power,” IEEE Transactions on Robotics, vol. 30, no. 1, pp. 275–287,
2013.
[60] W. S. Rone and P. Ben-Tzvi, “Mechanics modeling of multisegment rod-driven
continuum robots,” Journal of Mechanisms and Robotics, vol. 6, no. 4, 2014.
[61] D. C. Rucker and R. J. Webster III, “Statics and dynamics of continuum robots
with general tendon routing and external loading,” IEEE Transactions on Robotics,
vol. 27, no. 6, pp. 1033–1044, 2011.
[62] F. Renda, M. Giorelli, M. Calisti, M. Cianchetti, and C. Laschi, “Dynamic model of
a multibending soft robot arm driven by cables,” IEEE Transactions on Robotics,
vol. 30, no. 5, pp. 1109–1122, 2014.
[63] E. Tatlicioglu, I. D. Walker, and D. M. Dawson, “New dynamic models for planar
extensible continuum robot manipulators,” in 2007 IEEE/RSJ International
Conference on Intelligent Robots and Systems, pp. 1485–1490, IEEE, 2007.
[64] D. Trivedi, A. Lotfi, and C. D. Rahn, “Geometrically exact dynamic models
for soft robotic manipulators,” in 2007 IEEE/RSJ International Conference on
Intelligent Robots and Systems, pp. 1497–1502, IEEE, 2007.
[65] P. E. Dupont, J. Lock, B. Itkowitz, and E. Butler, “Design and control of concentric-
tube robots,” IEEE Transactions on Robotics, vol. 26, no. 2, pp. 209–225, 2009.
121
[66] F. Renda, M. Cianchetti, M. Giorelli, A. Arienti, and C. Laschi, “A 3D steady-state
model of a tendon-driven continuum soft manipulator inspired by the octopus
arm,” Bioinspiration & biomimetics, vol. 7, no. 2, p. 25006, 2012.
[67] S. Mbakop, G. Tagne, M.-H. Frouin, A. Melingui, and R. Merzouki, “Inverse
Dynamics Model-based Shape Control of Soft Continuum Finger Robot Using
Parametric Curve,” IEEE Robotics and Automation Letters, vol. 6, no. 4, pp. 8053–
8060, 2021.
[68] Y. Chen, B. Wu, J. Jin, and K. Xu, “A Variable Curvature Model for Multi-
Backbone Continuum Robots to Account for Inter-Segment Coupling and External
Disturbance,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 1590–1597,
2021.
[69] O. Lakhal, A. Melingui, and R. Merzouki, “Hybrid approach for modeling
and solving of kinematics of a compact bionic handling assistant manipulator,”
IEEE/ASME Transactions on Mechatronics, vol. 21, no. 3, pp. 1326–1335, 2015.
[70] J. Kennedy and R. Eberhart, “Particle swarm optimization,” in Proceedings of
ICNN’95-international conference on neural networks, vol. 4, pp. 1942–1948, IEEE,
1995.
[71] M. N. K. Kulkarni, M. S. Patekar, M. T. Bhoskar, M. O. Kulkarni, G. M.
Kakandikar, and V. M. Nandedkar, “Particle swarm optimization applications to
mechanical engineering-A review,” Materials Today: Proceedings, vol. 2, no. 4-5,
pp. 2631–2639, 2015.
[72] A. Lazinica, Particle swarm optimization. BoD–Books on Demand, 2009.
[73] A. Rezaee Jordehi and J. Jasni, “Parameter selection in particle swarm optimi-
sation: a survey,” Journal of Experimental & Theoretical Artificial Intelligence,
vol. 25, no. 4, pp. 527–542, 2013.
[74] A. Ammar, M. Chawki, Z. Abdelouahab, and M. Halim, “A New Approach to
Solve Inverse Kinematics of a Planar Flexible Continuum Robot,” in International
Conference of Computational Methods in Science and Engineering, ICCMSE, 2014.
[75] A. Amouri, C. Mahfoudi, A. Zaatri, O. Lakhal, and R. Merzouki, “A metaheuristic
approach to solve inverse kinematics of continuum manipulators,” Proceedings of
the Institution of Mechanical Engineers, Part I: Journal of Systems and Control
Engineering, vol. 231, no. 5, pp. 380–394, 2017.
[76] S. Neppalli, M. A. Csencsits, B. A. Jones, and I. Walker, “A geometrical approach
to inverse kinematics for continuum manipulators,” in 2008 IEEE/RSJ Inter-
national Conference on Intelligent Robots and Systems, pp. 3565–3570, IEEE,
2008.
[77] B. Siciliano and O. Khatib, Springer handbook of robotics. springer, 2016.
122
[78] M. D. Grissom, V. Chitrakaran, D. Dienno, M. Csencits, M. Pritts, B. Jones,
W. McMahan, D. Dawson, C. Rahn, and I. Walker, “Design and experimental
testing of the OctArm soft robot manipulator,” in Unmanned Systems Technology
VIII, vol. 6230, p. 62301F, International Society for Optics and Photonics, 2006.
[79] R. Lamraoui, M. Malla, and C. Mahfoudi, Modélisation Géométrique d’un Robot
Flexible à deux Sections Commandées par câbles, Proposition d’une Conception.
University of Larbi Ben M’hidi, Oum el Bouaghi, faculty of science and applied
sciences, Algeria, 2020.
[80] V. V. Bolotin, Nonconservative problems of the theory of elastic stability. Macmil-
lan, 1963.
[81] A. Amouri, C. Mahfoudi, and A. Zaatri, “Dynamic Modeling of a Spatial Cable-
Driven Continuum Robot Using Euler-Lagrange Method,” International Journal
of Engineering and Technology Innovation, vol. 10, no. 1, p. 60, 2019.
[82] A. Yeshmukhametov, K. Koganezawa, and Y. Yamamoto, “Design and kinematics
of cable-driven continuum robot arm with universal joint backbone,” in 2018 IEEE
International Conference on Robotics and Biomimetics (ROBIO), pp. 2444–2449,
IEEE, 2018.
[83] C. Li and C. D. Rahn, “Design of continuous backbone, cable-driven robots,” J.
Mech. Des., vol. 124, no. 2, pp. 265–271, 2002.
[84] D. ASANE, A. SCHMITZ, and S. SUGANO, “Investigating the Strain Behaviour
of Dyneema under Cyclic Loads,” in The Proceedings of JSME annual Conference
on Robotics and Mechatronics (Robomec) 2020, pp. 1P2—-K05, The Japan Society
of Mechanical Engineers, 2020.
123
Appendix A
124
Pieces 3D Drawing via SolidWorks
worm screw
Shaft 2
Freewheel-wheel
Pieces 3D drawing via SolidWorks
Pulley
Carter
Tray 1
Tray 2
Cover 1
Pièces 3D dessin via SolidWorks
Cover 2
Cover 3
Cover 4
Cover 5
Cushioned
Pieces 3D drawing via SolidWorks
Control mechanism
Base 1
Base 2
Fixing part 1
Pieces 3D drawig via SolidWorks
Fixing part 2
Flexible backbone
Spring
1- Base
2- Plaque
3- body
Moteur 4- Instrument ball
bearing_68_am
5- Pan cross
head_am