Conference PaperPDF Available

Real-Time Planner for Multi-segment Continuum Manipulator in Dynamic Environments

Authors:

Abstract

In this paper, a potential-field-based real-time path planning algorithm for a multi-segment continuum manipulator is proposed. This planner is employed to enable a continuum-style manipulator to move autonomously in dynamic environments in real-time. The classic potential field method is modified to make it applicable for a kinematics model based on the constant-curvature assumption. The contribution of this paper lies in the design of a novel potential field in the actuator space satisfying the mechanical constraints of the manipulator. The planning algorithm is tested and validated in real-time simulation for a 3 segments continuum manipulator. Preliminary tests for a tendon-driven single-segment continuum manipulator prototype confirm the performance of the proposed planner.
Real-Time Planner for Multi-segment Continuum Manipulator in
Dynamic Environments*
Ahmad Ataka, Peng Qi, Hongbin Liu, and Kaspar Althoefer
Abstract In this paper, a potential-field-based real-time path
planning algorithm for a multi-segment continuum manipulator
is proposed. This planner is employed to enable a continuum-
style manipulator to move autonomously in dynamic environ-
ments in real-time. The classic potential field method is modified
to make it applicable for a kinematics model based on the
constant-curvature assumption. The contribution of this paper
lies in the design of a novel potential field in the actuator space
satisfying the mechanical constraints of the manipulator. The
planning algorithm is tested and validated in real-time sim-
ulation for a 3 segments continuum manipulator. Preliminary
tests for a tendon-driven single-segment continuum manipulator
prototype confirm the performance of the proposed planner.
I. INTRODUCTION
Nowadays, continuum manipulators, such as those inspired
by the octopus [1] or the snake [2] have gained much
popularity in the field of robotics due to their flexibility
and dexterity. In recent years, researchers tried to implement
continuum manipulators in application areas where a high
risk may be posed if tasks were handled by rigid-link
manipulators - examples include surgery and other medical-
related areas. However, although the robot’s ability to bend
at any point along its backbone makes it particularly safe to
be used in the medical field, automation is still needed to
further improve safety and ensure high maneuverability.
In the last decade, various continuum robot structures
have been reported by several researchers [3]- [5]; studies
on the kinematic modelling, Jacobian, dynamic modelling,
and control of continuum manipulator start to appear as
reported in [6]. However, research on continuum manipulator
navigation is still in its infancy and clearly a challenging
problem, largely because of the complexity of the manipu-
lator’s model.
One recent study on path planning for continuum manip-
ulator’s which uses a simple and fast geometrical inverse
kinematic solution of a constant-curvature steerable needle
was reported in [7]. However, this method cannot be used
to deal with obstacles dynamically changing their position,
because it assumes a static and well-defined environment.
Most works which use optimization-based planning [8]- [10]
*The work described in this paper is partially supported by the STIFF-
FLOP project grant from the European Communities Seventh Framework
Programme under grant agreement 287728, the Four By Three grant from
the European Framework Programme for Research and Innovation Horizon
2020 under grant agreement no 637095, and the Indonesia Endowment Fund
for Education, Ministry of Finance Republic of Indonesia.
Ahmad Ataka, Peng Qi, Hongbin Liu, and Kaspar Althoefer is with The
Centre for Robotics Research (CoRe), Department of Informatics, Kings
College London, London WC2R 2LS, United Kingdom. Corresponding
author e-mail: ahmad ataka awwalur.rizqi@kcl.ac.uk
and sampling-based planning [11]- [13] also suffer from the
same drawback.
Studies on path planning for real-time applications have
been reported in recent years. Xiao proposed a real-time
adaptive motion planning approach for OctArm manipulator
in dynamic environments [14]. However, the algorithm is
limited to the planar case and does not produce solutions
in actuator space limiting its applicability. Chen proposed
inverse-Jacobian-based planning which provides solutions in
actuator space [15], but it is specifically designed to guide
the movement of manipulator inside a tubular environment.
Another research work reported by Godage [16] exploits the
null space of a highly redundant multi-segment continuum
manipulator model. However, its mathematical calculation
is costly due to the fact that it involves successive matrix
multiplication. Besides, the hard-limiting function used to
model the mechanical constraint influences the smoothness
of manipulator’s movement when the tendons are close to
their limits.
One of the popular works in this area is the artificial
potential field method [17]. It is largely used for robots such
as mobile robots and rigid manipulators, especially because
of its simplicity and straightforward way of implementing.
Some researchers have applied potential field method to
continuum robots, such as steerable needle [18]. Although
the algorithm does not ensure global convergence, a global
map of the environment is not needed and, hence, it can be
used in dynamic and unknown environments, thus, makes it
suitable for real-time applications.
In this work, we propose potential-field-based real-time
path planning for a multi-segment continuum manipulator.
The planner presented in [17] is modified to make it ap-
plicable to a constant-curvature kinematic model. We also
propose a novel potential field for the actuator space to
satisfy the mechanical constraints of the manipulator. The
novel potential field in actuator space also improves the
standard hard-limiting function usually employed to satisfy
mechanical constraints due to the fact that the proposed
method does not disturb the smoothness of the manipulator
motion. The planning algorithm is tested and validated in a
real-time simulation on a 3 segment continuum manipulator.
Conducting tests on a real tendon-driven single-segment
continuum manipulator prototype (previously described in
[19]) confirms the performance of the proposed planner in a
real-world application.
(a) (b)
Fig. 1. (a) The single-segment tendon-driven continuum manipulator used
in the experiment. (b) Three segments continuum manipulator with movable
base. A point P located at δs3along the backbone of the third segment can
be expressed with the help of the scalar coefficient vector ξ= [1 1 δ]T
II. CONTINUUM MANIPULATOR MODEL
In this section, the constant-curvature kinematic model is
described. We assume that every segment of the manipulator
acts like the arc of a circle with a constant radius of curvature
along each individual robot segment. Hence, assuming the
manipulator moves in R3, each segment can be parameterized
by three configuration space variables ki=κiφisiT.
These variables represent the curvature (κi), rotational de-
flection angle (φi), and arc length (si) of a segment-i. The
homogeneous transformation matrix describing the tip pose
of segment iwith respect to the base, i
i1T(ki)SE(3), can
be expressed as function of kias given in [6].
We assume the base of the continuum manipulator is
movable with 6 degrees of freedom, such that the pose of the
end effector with respect to the world frame for Nsegments
manipulator can be expressed as follows
N
0T(k) = TB
N
i=1
i
i1T(ki)(1)
where k=k1k2... kNTand TBSE(3)represents
the standard homogeneous transformation matrix of the
frame attached to the base with 6 degrees of freedom.
Further mapping is needed to construct the relation be-
tween the previous configuration space variables kto the
actuator space variables q. For a tendon-driven continuum
manipulator, the actuator space variables of segment-ican
be expressed as qi=li1li2li3Twhere li j represents the
length of tendon- jin segment-i. The overall actuator space
variables for Nsegments manipulator can then be written as
q=q0q1... qNTwhere q0R6represents the base’s
position and orientation. The configuration space variables of
segment-i,ki, can be expressed as function of manipulator’s
cross-section radius dand tendon length in segment-i,qi, as
expressed in [6].
The scalar coefficient vector, defined in [16], is used
to express the pose of any point along the backbone of
the manipulator. A scalar ξi[0,1]is assigned to each
segment to specify the point along the segment, from the
base (ξi=0) to the tip (ξi=1) of segment-i. The set
of scalars of all segments are then formed into a vector,
ξ=ξ1ξ2... ξNT. The value of the vector is defined
as ξ={ξr=1 : r<i,ξi,ξr=0 : r>i}.An example is
presented in Figure 1b.
Hence, the complete forward kinematic relation can be
expressed as follows
N
0T(q,ξ) = R(q,ξ)x(q,ξ)
01×31(2)
where R(q,ξ)SO(3)denotes the rotation matrix and
x(q,ξ)R3denotes the position vector of the point along
the body of manipulator. A Jacobian, defined as J(q,ξ) =
x(q,ξ)
qR3×(3N+6), relates the velocity vector as follows
˙
x(q,ξ) = J(q,ξ)˙
q˙
q=J(q,ξ)1˙
x(q,ξ).(3)
III. POTENTIAL-FIELD-BASED PATH PLANNING
A. Classic Potential Field
The planning algorithm, used in this paper, is based on
[17]. The manipulator in general moves in configuration
space (C-Space) filled employing an artificial potential field
U(q)which attracts the manipulator to the desired target
configuration, whilst repelling it from configurations where
the manipulator would touch obstacles (C-obstacle region).
The generalized force which guides the movement of the
manipulator can be expressed as
F(q) = U(q).(4)
The attractive parabolic potential function for a desired
configuration qdcan be expressed as
Ud(q) = 1
2k(qqd)T(qqd),(5)
where kis constant gain. The repulsive potential produced
by obstacles Ocan be expressed as follows
UO(q) = (1
2η(1
ρ1
ρ0)2if ρ<ρ0
0 if ρ>ρ0
(6)
where ρ=p(qqO)T(qqO)is the closest Euclidean
distance between the manipulator’s configuration and the C-
obstacle region in C-Space, ηis positive constant, and ρ0is
the limit distance of the potential influence.
The resulting potential is given by a linear combination
of attractive and repulsive potentials from all obstacles. An
illustration is shown in Figure 2a.
B. Modified Potential Field
The potential field can be easily applied in a C-Space.
However, to construct the C-Space for Nsegments contin-
uum manipulator with a movable base, which has 3N+6
degrees of freedom, is not feasible especially for real-time
planning purpose. Hence, we can use the same approach
applied to rigid-link manipulator [17] or steerable-needle
[18] by producing a potential function U(x)in the workspace
of manipulator.
Since we will use the kinematic model of a continuum
manipulator, a generalized force Fin the classic algorithm
is considered as the velocity of the manipulator ˙
x. Hence,
the spatial velocity ˙
x(x), derived from the gradient of the
potential U(x), is then mapped to an actuator space velocity
˙
q(q)by an inverse Jacobian relation in (3).
The attractive velocity in workspace is given by
˙
xxd(x) = Ud(x) = k(xxd),(7)
where xdrepresents the desired end effector’s position in
the workspace. The repulsive velocity can be calculated as
follows
˙
xOb(x) = UOb(x) = (η(1
ρb1
ρ0)1
ρ2
b
ρb
xif ρb<ρ0
0 if ρb>ρ0
.
(8)
Here, ρb=p(xxOb)T(xxOb)represents the closest Eu-
clidean distance between the manipulator’s end effector’s
position and the obstacle-bin workspace.
Applying the repulsive velocity to the end effector alone
is not sufficient to ensure that the whole body of the
manipulator will avoid the obstacles. An approach given
in [17] applied the repulsive force on each point subjected
to potential (PSP) along the body of the manipulator. The
higher the number of PSPs along the body of the manipulator,
the more collisions with obstacles are avoided.
Finally, we transform each spatial velocity, applied in the
end effector and PSPs, to the corresponding actuator space
velocity. For mnumber of PSP and nnumber of point
obstacles in the vicinity of the robot, the total velocity in
the actuator space can be expressed as follows
˙
q(q) = Je(q)+˙
xxd(x) +
m
a=1
n
b=1
Ja(q)+˙
xOb(x)(9)
where Jeand Jastands for the Jacobian of the end effector’s
and the Jacobian of the PSP-arespectively, with the elements
value of scalar coefficient vector ξdepending on the position
of the PSP along the backbone of the manipulator. The
(+) operation represents the pseudo-inverse matrix operation
based on [20] defined as
J+=JT(JJT)1.(10)
C. Mechanical Constraint Avoidance
The novelty of this work compared to previous works is
the utilization of a novel potential field in the actuator space
to guide the continuum manipulator to avoid limits due to
the mechanical design of the manipulator. The continuum
manipulator used in this paper is assumed to have mechan-
ical constraint in its tendon length, namely it can only be
extended or shortened with ratio ζ. In other words, the length
of each tendon is inside the region (1ζ)L<li j <(1+ζ)L
where Lstands for the normal length without contraction or
elongation.
Rather than applying the repulsive potential for these
limits, which will disturb the movement’s smoothness when
the tendons’ length are close to the limits, we apply an
attractive potential to plane lij =L. In other words, this
potential will attract the tendon’s length towards the normal
length L, which in turn will ensure that mechanical constraint
conditions are avoided.
The proposed potential function can be expressed as
follows
Ulim(q) =
N
i=1
3
j=1
σ(li j L
ζL)2,(11)
where σis positive constant. The attractive velocity field is
as follows
˙
qlim (q) = 2σ1
ζ2L2(lL),(12)
where l=l11 ... l13 l21 ... lN3Tand L=L13N×1.
However, producing a potential field with this behavior
will reduce the accuracy of the end effector planning to reach
a desired position in workspace. It is caused by the fact that
this new added potential will keep the resultant velocity field
in the actuator space equals zero although the end effector
does not reach the desired target point yet. Thus, we need to
define a weight function which will reduce the newly-added
potential field’s contribution as the end effector approaches
the target position as follows
w(x) = (1eµk(xxd)k),(13)
where µis positive constant. An illustration of the potential
as a function of the tendon’s length and the distance between
the end effector and the target is shown in Figure 2b. The
overall actuator space potential field is added to (9). This
potential does not affect the base’s movement, ˙
q0R6, so
the total new potential ˙
qnew(q)R(3N+6)can be expressed
as follows
˙
qnew(q,x) = 06×1
w(x)˙
qlim (q)(14)
The total potential field in the actuator space can be
expressed as
˙
q(q) = Je(q)+˙
xxd(x) +
m
a=1
n
b=1
Ja(q)+˙
xOb(x) + ˙
qnew(q,x)
(15)
IV. SIMULATION RESULTS
The algorithm is implemented in a constant-curvature
kinematic model of a continuum manipulator in the Robot
Operating System (ROS) Environment. All simulations in
this section are run in real-time. The simulation is imple-
mented on a computer platform with an Intel Core i3 @2.40
TABLE I
PROP ERT IE S OF MA NI PU LATO R AN D POTE NT IA L FIE LD
Number of segments (N) 3
Total Number of PSPs (m) 9
Number of Obstacles (n) 2
Manipulator’s radius (d) 0.0134 m
Attractive Field Constant (k) 5.0 (s) or 0.1 (e)
Repulsive Field Constant (η) 3 ×107(s) or 2 ×109(e)
Limit of Potential Influence (ρ0) 0.025
Maximum extension ratio (ζ) 0.3
Normal length (L) 0.012 m
Constraint-Potential-Field constant (σ) 0.04167
Weight constant (µ) 2.5
−10
0
10
−10
0
10
0
2
4
x (m)
y (m)
Potential Function
(a)
−0.05
0
0.05
0
0.5
0
0.5
1
1.5
2
2.5
Length (m)
Distance (m)
Potential Function
(b)
Fig. 2. (a) Illustration of combined attractive and repulsive potential
function applied to a manipulator whose C-Space is in R2. (b) Illustration of
the proposed potential function designed to satisfy mechanical constraint as
function of the tendon’s length and end-effector-to-target Euclidean distance.
GHz and 1.5 GB RAM running the Linux Mint 13 Operating
System.
We use a three-segment manipulator (N=3) with a 6-
degree-of-freedoms movable base. We choose 3 PSPs dis-
tributed uniformly along the body of each segment. The
obstacles are assumed to have a spherical form with a radius
equals 0.01 m. The complete properties of the manipulator
and the potential field constants, both in simulation (s) and
experiment (e) are given in Tab. I.
A. Moving Obstacle with a Static Target
In the first simulation, we simulate two dynamic obstacles
moving in a space close to the manipulator. The tip’s target
position is assumed to be constant. The initial value of
actuator space variables are chosen such that the initial
position of the end effector coincides with the target. Each
obstacle moves in XY -plane with a constant velocity.
From Figure 3, we can see that the manipulator success-
fully avoids the dynamic obstacles (black spheres) moving
close to its body. Besides the repulsive avoid-obstacle move-
ment, the attractive go-to-goal potential is still applied to the
end effector of the manipulator, resulting in its movement
back to the target point (small red dot) when the obstacle
influence disappears after moving farther away from the
manipulator’s body, as shown in the lower right picture. In
Figure 4, the moving obstacle moves in the vicinity of the
bottom segment. We can see how the manipulator with its
movable base avoids the obstacle while at the same time
ensures that the end effector stays on the target position.
The comparison is made in terms of average execu-
tion time per cycle between the proposed algorithm and
a previous proposed approach [16] employing real-time
redundancy-based-obstacle avoidance as shown in Tab. II.
Employing the same simulation environment and machine
specification, it is shown that the proposed algorithm has an
execution time per cycle of 0.2423 s compared to previously
proposed redundancy-based planning with an execution time
per cycle of 1.1751 s. This is due to the fact that the computa-
tional load of the proposed method is lower when compared
to the computational load of the previous approach. Hence,
the proposed algorithm is relatively more efficient and more
suitable for high-speed real-time applications.
Fig. 3. The movement of the 3-segments-continuum-manipulator with a
static target position (small red dot) when 2 obstacles (2 black spheres)
move in the vicinity of the manipulator’s tip. The order of movement is as
follows: upper left picture, upper right picture, lower left picture, and finally
lower left picture.
B. Static Obstacle with a Moving Target
In the second simulation, the environment consists of two
static obstacles floating in space close to the manipulator’s
desired trajectory. The tip’s target position is assumed to
move with a constant velocity (k˙
xdk=0.001 m/s) at each
iteration. The velocity vector points from the initial target
position to the final target position. The initial value of the
tendon length and target position are chosen to have the same
value as in the first simulation. The obstacles are located in
space close to the target’s path.
From Figure 5, we can see that the manipulator starts
to track the moving target point (small red dot). When the
tendons’ length approach the limits, the proposed potential
field term ˙
qnew(q,x)will be big enough to avoid the tendon
increasing its length. This will in turn lead to a motion of
the redundant, movable base in the direction of the moving
target as a result of the attractive field. Hence, the proposed
Fig. 4. The movement of the 3-segments-continuum-manipulator with a
static target position (small red dot) when moving obstacle (black sphere)
move in the vicinity of the manipulator’s bottom segment. The order of
movement is as follows: upper left picture, upper right picture, lower left
picture, and finally lower left picture.
TABLE II
AVERA GE EXECUTION TIM E PE R CYC LE COMPARISON
Case Execution Time per Cycle (s)
Proposed Algorithm Redundancy-based Algorithm
A 0.2423 1.1751
B 0.1841 1.1050
potential field enables the manipulator to track the target
smoothly and without violating its mechanical constraints.
Our mechanical-constraint-potential-field method is superior
to standard hard-limiting function used to satisfy the me-
chanical constraint, since the proposed method does not
disturb the smoothness of the movement of the continuum
manipulator. Besides that, the manipulator also successfully
avoids the obstacles on its path.
As with the previous simulation, in terms of average
execution time per cycle shown in Tab. II, the proposed
algorithm is more efficient (with an average execution time
per cycle of 0.1841 s) than the redundancy-based path
planning algorithm in [16] (with an average execution time
per cycle of 1.1050 s).
V. EXPERIMENTAL RESULTS
A. System Description
The proposed algorithm is implemented in a tendon-driven
single segment continuum manipulator, as presented in [19],
as shown in 1a. In this experiment, it is assumed that the
Fig. 5. The movement of the 3-segments-continuum-manipulator with
a moving target position (small red dot) and 2 static obstacles (2 black
spheres) floating in space close to the manipulator’s desired path. The order
of movement is as follows: upper left picture, upper right picture, lower left
picture, and finally lower left picture.
0.05
0.1 −0.06−0.04−0.0200.02
0.08
0.1
0.12
y (m)
x (m)
z (m)
(a)
0 20 40 60 80
0.025
0.03
0.035
Time (s)
Distance (m)
(b)
Fig. 6. (a) The manipulator’s tip (red line) tracks the desired trajectory
(blue line) and avoids static obstacle (black spheres) nearby. (c) The graph
shows the closest distance from the obstacle to the estimated manipulator’s
body (red line) and to the target (blue line) respectively.
PSP is located only at the tip. The obstacle is assumed to be
a point located close to the manipulator’s tip.
We use three Maxon DC Motors as actuators. Each motor,
equipped with encoders to ensure precise velocity control,
is connected to the manipulator’s tendons via a gearbox
with a 128:1 reduction ratio. The rotational speed of the
motors governs the tendons’ linear velocities and changes
the tendons’ lengths.
The end effector position is measured by tracking the
electromagnetic-based Aurora sensor coil embedded in the
tip of the manipulator. The second sensor coil is hung in the
air by a thread to represent the center of the static spherical
obstacle with a radius of 0.01 m. The information is fed
to the computer via the NDI Aurora tracking system. The
target’s trajectory is chosen to be a straight line measured
with respect to the base of the robot.
B. Results and Discussion
In Figure 6a, the target’s movement is drawn with a blue
line, the tip’s movement is drawn with a red line, and the
obstacle is drawn as black spheres. The tip’s manipulator
starts to track the desired trajectory because of the attractive
field induced by the target. The repulsive movement occurs
when a part of the manipulator’s body enters the region of
the obstacle’s influence so that the tip’s movement deviates
from the desired path away from the obstacle.
Figure 6b shows the closest Euclidean distance from
the obstacle to the estimated manipulator’s body (drawn
with a red line) and to the target (drawn with a blue
line) respectively. We can observe that when the distance
between the obstacle and the tip is less than ρ0=0.025
m (i.e. the limit distance of obstacle’s influence), the tip
does not monotonically follow the target, but instead keeps
a certain distance from the obstacle until the moment when
the distance between target and obstacle is greater than ρ0.
This confirms that the obstacle-avoidance movement works
well for the continuum manipulator prototype in real-time.
One important thing to be noted is that the experiment
does not yet guarantee the whole body of the manipulator
to be safe from colliding just like in the simulation section.
It is due to the fact that the Aurora tracker sensor is only
located at the tip.
VI. CONCLUSIONS AND FUTURE WORKS
We propose a potential-field-based real-time path planning
algorithm for a multi-segment continuum manipulator. The
continuum manipulator’s constant-curvature kinematic model
is used to test the algorithm. The manipulator moves in
space under the influence of artificial potential fields. We also
propose a novel potential field in actuator space to satisfy
mechanical limits of the manipulator. The overall strategy is
tested and verified in a real-time simulator for a 3-segment
continuum manipulator and a test is successfully conducted
for a tendon-driven single-segment continuum manipulator
prototype. The path planning algorithm shows promising
result and can be further implemented for real-time planning
of other continuum manipulators.
In the future, the algorithm can be equipped with a non-
linear observer used to estimate the actuator space variables
of the manipulator so that the position of the PSP along the
backbone of manipulator can be estimated. This will reduce
the risk of collisions between the robot and obstacles. It
can also be combined with priori global information of the
environment to solve local minima problems.
REFERENCES
[1] W. McMahan, V. Chitrakaran, M. Csencsits, D. Dawson, I. Walker,
B. Jones, M. Pritts, D. Dienno, M. Grissom, and C. Rahn, “Field trials
and testing of the OctArm continuum manipulator, in Robotics and
Automation, 2006. ICRA 2006. Proceedings 2006 IEEE International
Conference on, May 2006, pp. 2336–2341.
[2] S. Hirose, Biologically inspired robots: snake-like loco-
motors and manipulators, ser. Oxford science publica-
tions. Oxford University Press, 1993. [Online]. Available:
https://books.google.co.uk/books?id=TaIQAQAAMAAJ
[3] Y.-J. Kim, S. Cheng, S. Kim, and K. Iagnemma, “A Novel Layer
Jamming Mechanism With Tunable Stiffness Capability for Minimally
Invasive Surgery,” Robotics, IEEE Transactions on, vol. 29, no. 4, pp.
1031–1042, Aug. 2013.
[4] T. Mahl, A. Hildebrandt, and O. Sawodny, A Variable Curvature
Continuum Kinematics for Kinematic Control of the Bionic Handling
Assistant,” Robotics, IEEE Transactions on, vol. 30, no. 4, pp. 935–
949, Aug. 2014.
[5] F. Maghooa, A. Stilli, Y. Noh, K. Althoefer, and H. Wurdemann,
“Tendon and pressure actuation for a bio-inspired manipulator based
on an antagonistic principle,” in Robotics and Automation (ICRA),
2015 IEEE International Conference on, May 2015, pp. 2556–2561.
[6] R. J. Webster, III and B. A. Jones, “Design and Kinematic Modeling
of Constant Curvature Continuum Robots: A Review, Int. J. Rob.
Res., vol. 29, no. 13, pp. 1661–1683, Nov. 2010. [Online]. Available:
http://dx.doi.org/10.1177/0278364910368147
[7] V. Duindam, J. Xu, R. Alterovitz, S. Sastry, and K. Y.
Goldberg, “Three-dimensional Motion Planning Algorithms for
Steerable Needles Using Inverse Kinematics, I. J. Robotic
Res., vol. 29, no. 7, pp. 789–800, 2010. [Online]. Available:
http://dx.doi.org/10.1177/0278364909352202
[8] G. Niu, Z. Zheng, and Q. Gao, “Collision free path planning based
on region clipping for aircraft fuel tank inspection robot,” in Robotics
and Automation (ICRA), 2014 IEEE International Conference on, May
2014, pp. 3227–3233.
[9] D. Palmer, S. Cobos-Guzman, and D. Axinte, “Real-time
method for tip following navigation of continuum snake
arm robots,” Robotics and Autonomous Systems, vol. 62,
no. 10, pp. 1478 1485, 2014. [Online]. Available:
http://www.sciencedirect.com/science/article/pii/S0921889014001080
[10] L. Lyons, R. Webster, and R. Alterovitz, “Motion planning for active
cannulas,” in Intelligent Robots and Systems, 2009. IROS 2009.
IEEE/RSJ International Conference on, Oct. 2009, pp. 801–806.
[11] L. Torres and R. Alterovitz, “Motion planning for concentric tube
robots using mechanics-based models,” in Intelligent Robots and
Systems (IROS), 2011 IEEE/RSJ International Conference on, Sep.
2011, pp. 5153–5159.
[12] C. Bergeles and P. Dupont, “Planning stable paths for concentric tube
robots,” in Intelligent Robots and Systems (IROS), 2013 IEEE/RSJ
International Conference on, Nov. 2013, pp. 3077–3082.
[13] J. Xu, V. Duindam, R. Alterovitz, and K. Goldberg, “Motion planning
for steerable needles in 3d environments with obstacles using rapidly-
exploring Random Trees and backchaining, in Automation Science
and Engineering, 2008. CASE 2008. IEEE International Conference
on, Aug. 2008, pp. 41–46.
[14] J. Xiao and R. Vatcha, “Real-time adaptive motion planning for a
continuum manipulator, in Intelligent Robots and Systems (IROS),
2010 IEEE/RSJ International Conference on, Oct. 2010, pp. 5919–
5926.
[15] G. Chen, M. T. Pham, and T. Redarce, “Sensor-based
guidance control of a continuum robot for a semi-
autonomous colonoscopy, Robotics and Autonomous Systems,
vol. 57, no. 67, pp. 712 722, 2009. [Online]. Available:
http://www.sciencedirect.com/science/article/pii/S0921889008002042
[16] I. Godage, D. Branson, E. Guglielmino, and D. Caldwell, “Path
planning for multisection continuum arms,” in Mechatronics and
Automation (ICMA), 2012 International Conference on, Aug. 2012,
pp. 1208–1213.
[17] O. Khatib, “Real-time obstacle avoidance for manipulators and mo-
bile robots,” in Robotics and Automation. Proceedings. 1985 IEEE
International Conference on, vol. 2, Mar. 1985, pp. 500–505.
[18] S. DiMaio and S. Salcudean, “Needle steering and motion planning in
soft tissues,” Biomedical Engineering, IEEE Transactions on, vol. 52,
no. 6, pp. 965–974, Jun. 2005.
[19] P. Qi, C. Qiu, H. Liu, J. Dai, L. Seneviratne, and K. Althoefer,
“A novel continuum-style robot with multilayer compliant modules,”
in Intelligent Robots and Systems (IROS 2014), 2014 IEEE/RSJ
International Conference on, Sep. 2014, pp. 3175–3180.
[20] B. Siciliano, “Kinematic control of redundant robot manipulators:
A tutorial,” Journal of Intelligent and Robotic Systems,
vol. 3, no. 3, pp. 201–212, 1990. [Online]. Available:
http://dx.doi.org/10.1007/BF00126069

Supplementary resource (1)

... One of the prominent trends in robot navigation is taking inspiration from natural physical phenomena such as the electric potential field [17]. Being relatively simple and straightforward, this method has been extensively applied for mobile robots, rigid manipulators, and even continuum manipulators [18,19]. The global convergence is not guaranteed in this algorithm. ...
... In this article, we present our recent works on continuum manipulator navigation which is inspired by the physical phenomena of electromagnetism. The use of electric field to keep manipulator body from collision is based on our works in [18]. Another method presented here is the use of magnetic field to avoid the collision, in which the backbone of the manipulator is considered as the means for current flow, resembling an electrical wire which induces a field on nearby objects. ...
... These configuration space variables k are normally different from the real controllable parameters of the actuator and generally very robot-specific due to the wide range of choices in design and actuating mechanism. For a tendon-driven robot like the one used in [18], the actuator space variables are the tendon length and can be written as q i = l i1 l i2 l i3 T in which l i j denotes the length deviation of tendon-j in segment-i from normal length L. For N-segment manipulator, the whole actuator space is expressed as q = q 1 q 2 ... q N T . The mapping between configuration space variables of segment-i, k i , and tendon length in segment-i, q i , depends on the manipulator's cross-section radius d as has been derived in [11]. ...
... Various motion planning and control approaches have been investigated for continuum robots. Ataka et al. [34] proposed a potential field-based planning algorithm for multi-link continuum robots. Yip and Camarillo [35] developed a model-free feedback control strategy for continuum manipulators in constrained environments by estimating the robot Jacobian online. ...
Preprint
Full-text available
This paper presents a novel method for modeling the shape of a continuum robot as a Neural Configuration Euclidean Distance Function (N-CEDF). By learning separate distance fields for each link and combining them through the kinematics chain, the learned N-CEDF provides an accurate and computationally efficient representation of the robot's shape. The key advantage of a distance function representation of a continuum robot is that it enables efficient collision checking for motion planning in dynamic and cluttered environments, even with point-cloud observations. We integrate the N-CEDF into a Model Predictive Path Integral (MPPI) controller to generate safe trajectories. The proposed approach is validated for continuum robots with various links in several simulated environments with static and dynamic obstacles.
... Godage et al. [31] incorporated proximity sensors into the continuum robot to detect environmental information and prevent collisions with obstacles during its motion. Ataka et al. [32] introduced a real-time path-planning algorithm for continuum robots utilizing a potential field approach, with efficient modifications based on the constant curvature assumption. Ouyang et al. [33] introduced a human-robot interactive control system for continuum robots, which proposes a shape correspondence approach based on user-defined desired curves. ...
Article
In confined multi-obstacle environments, generating feasible paths for continuum robots is challenging due to the need to avoid obstacles while considering the kinematic limitations of the robot. This paper deals with the path-planning algorithm for continuum robots in confined multi-obstacle environments to prevent their over-deformation. By modifying the tree expansion process of the Rapidly-exploring Random Tree Star (RRT*) algorithm, a path-planning algorithm called the continuum-RRT* algorithm herein is proposed to achieve fewer iterations and faster convergence as well as generating desired paths that adhere to the kinematic limitations of the continuum robots. Then path planning and path tracking are implemented on a tendon-driven four-section continuum robot to validate the effectiveness of the path-planning algorithm. The path-planning results show that the path generated by the algorithm indeed has fewer transitions, and the path generated by the algorithm is closer to the optimal path that satisfies the kinematic limitations of the continuum robot. Furthermore, path-tracking experiments validate the successful navigation of the continuum robot along the algorithm-generated path, exhibiting an error range of 2.51%–3.91%. This attests to the effectiveness of the proposed algorithm in meeting the navigation requirements of continuum robots.
... The main challenges for tendon-driven soft robots are to solve the problems of model complexity, poor realtime motion planning [18,19], and high control difficulty [20,21]. Currently, piecewise constant curvature (PCC) is a commonly used hypothesis for the kinematic modelling of a continuum. ...
Article
Full-text available
Most directed energy deposition (DED) implementations employ a rigid end effector to deposit material layer-by-layer, which is insufficient in cases with space constraints. To enhance the flexibility, this paper proposes a novel soft-robotic gun (SRG) based DED technology. The ideology is to replace the rigid weld gun with a tendon-driven omnidirectional-steering continuum manipulator, which a computer can numerically control. To this end, both requirements and concepts of the SRG-DED are introduced. A prototype system is designed and implemented before dedicated kinematic modelling and trajectory planning mechanisms are presented. As demonstrated by the experimental results, the developed trajectory planning algorithm improves the computational efficiency of tendon variables and enhances the consistency of trajectory tracking. The prototype system can deposit a complex path on an inclined substrate and fabricate a thin-wall component within a pipeline. The validation work confirms the feasibility and applicability of the prototype system for metal additive manufacturing applications.
... However, when applied to CRs, the complexity of the potential field and motion planning increases due to the multiple degrees of freedom. Ahmad Atakaiu improved the traditional APF by integrating a novel attractive potential field in the actuator space to avoid the limits of the mechanical design [57]. Nevertheless, this may lead the robot to be trapped in the local solution. ...
Article
Full-text available
Secure and reliable active debris removal methods are crucial for maintaining the stability of the space environment. Continuum robots, with their hyper-redundant degrees of freedom, offer the ability to capture targets of varying sizes and shapes through whole-arm grasping, making them well-suited for active debris removal missions. This paper proposes a pre-grasping motion planning method for continuum robots based on an improved artificial potential field to restrict the movement area of the grasping target and prevent its escape during the pre-grasping phase. The analysis of the grasping workspace ensures that the target is within the workspace when starting the pre-grasping motion planning by dividing the continuum robot into delivery and grasping segments. An improved artificial potential field is proposed to guide the continuum robot in surrounding the target and creating a grasping area. Specifically, the improved artificial potential field consists of a spatial rotating potential field, an attractive potential field incorporating position and posture potential fields, and a repulsive potential field. The simulation results demonstrate the effectiveness of the proposed method. A comparison of motion planning results between methods that disregard and consider the posture potential field shows that the inclusion of the posture potential field improves the performance of pre-grasping motion planning for spatial targets, achieving a success rate of up to 97.8%.
... Other scholars also used numerical solutions [12], geometric solutions [13], artificial neural networks [14], and other methods to study the PTP planning of flexible manipulators. Reference [15] proposed a real-time path planning method to solve the end path to the target position and the corresponding joint variables. Although the method can plan the end in real-time, it has no constraints on the attitude of the end. ...
Article
Full-text available
To solve the trajectory planning problem of the flexible manipulator under various constraints such as end-camera attitude, drive space, and obstacles during video inspection along a continuous path in narrow three-dimensional space, this paper proposes a time-optimal trajectory planning method from the initial configuration to the final configuration. The trajectory planning problem is transformed into a multi-constraint optimization problem. First, to realize continuous video inspection in an unstructured complex environment, by analyzing the geometric model of the two-segment flexible manipulator with a camera at the end, the pose constraints between the camera and the shooting surface are formulated by the space vector method, the driving constraints are formulated based on kinematics, and the obstacle constraints are formulated by space mapping. Then, a multi-constraint optimization model is constructed to generate the smooth trajectory of the drive cable of the flexible manipulator by minimizing the total time of continuous path motion. Compared with the conventional point-to-point collision avoidance planning solution method, this paper starts from the global perspective and investigates the less considered continuous path trajectory planning problem; also, the swarm intelligence algorithm artificial jellyfish search algorithm (JS) is employed to optimize the solution and find the minimum time trajectory conforming to a variety of complex constraints. Finally, a simulation is conducted with CoppeliaSim, and the continuous path video inspection experiment is carried out in the 500KV GIS (Gas Insulated Switchgear) equipment, the simulation and experimental results indicate that the planned drive cable trajectory is smooth and effective. In addition, each path point is tracked and obstacles are avoided safely. When the flexible manipulator moves along the whole path, the pose of the camera satisfies the relaxed attitude constrain The proposed method can guide the two-segment flexible manipulator to complete the continuous video inspection task of the GIS cavity wall and conductive column surface.
Thesis
Full-text available
This paper presents a proposal for the implementation of the Artificial Potential Fields algorithm (APF) in a SCARA manipulator (Selective Compliant Assembly Robot Arm). We explore a case study on the machine-machine interaction, represented by the manipulator and a mobile robot. This study was carried out through the implementation of the APF algorithm, which is a classic algorithm, the same is used in the generation of collision free paths in a dynamic environment, monitored by an image sensor, in real time.. Several approaches are explored between the manipulator and the mobile robot. These approaches, which take into account the combinations between the mobile robot and the manipulator as the extended body and point. The algorithm was implemented in the manipulator to generate the collision-free, dynamic obstacle paths with random positions, in real time. The results show the efficiency of the algorithm with respect to productivity and were satisfactory in this case study. We also present the results of the efficiency of the algorithm through OEE (Overall Equipment Effectiveness), the energy consumption and the results of the error analysis between the positions generated by the potential field algorithm and the actual positions of the manipulator.
Article
Full-text available
Muscular antagonism caused by muscle fibers and muscle layers is vital for the hydrostatic skeleton of soft creatures. This article introduces a crossed-fiber arrangement and a hybrid material structure to a hydrostatic-skeleton-inspired soft manipulator that mimics the bending motion of worms. Deformation tests on radial expansion, torsion, and bending motion verify that the proposed design is controllable under large deformations to the manipulator. To achieve accurate control, this article proposes a sparse-Bayesian-learning-based piecewise constant curvature kinematic model and designs a feedback controller based on the kinematic model. The proposed controller demonstrates superior accuracy and reduces vibration compared with the linear least-squares-based controller and the neural-network-based controller in tracking desired movements during experiments.
Conference Paper
Full-text available
This paper introduces a novel continuum-style robot that integrates multiple layers of compliant modules. Its essential features lie in that its bending is not based on natural compliance of a continuous backbone element or soft skeletal elements but instead is based on the compliance of each structured planar module. This structure provides several important advantages. First, it demonstrates a large linear bending motion, whilst avoiding joint friction. Second, its contraction and bending motion are decoupled. Third, it possesses ideal back-drivability and a low hysteresis. We further provide an analytical method to study the compliance characteristics of the planar module and derive the statics and kinematics of the robot. The paper provides an overview of experiments validating the design and analysis.
Conference Paper
Full-text available
This paper proposes a soft, inflatable manipulator that is antagonistically actuated by tendons and pneumatics. The combination of the two actuation mechanisms in this antagonistic robot structure is inspired by the octopus which uses its longitudinal and transversal muscles to steer, elongate, shrink and also stiffen its continuum arms. By 'activating' its antagonistic muscle groups at the same time, the octopus can achieve multiple motion patterns as well as stiffen their arms. Being organized in a similar fashion, our robot manipulator uses, on the one hand, pneumatic actuation and, on the other hand, tendon-based actuation - one opposing the other, achieving an overall antagonistic actuation framework. Controlling the pressure inside the robot while at the same time controlling the tendons' displacements, the robot can be moved into a wide range of configurations while simultaneously controlling the arm's stiffness. This paper builds on earlier work by the authors: Here, we present a new conic-shaped manipulator structure and the control architecture. Using a constant curvature model, we have derived an approach suitable for controlling the robot manipulator. The manipulator's reachable workspace is analyzed and proof-of-concept experiments were conducted to show the robot's stiffness control and motion abilities.
Article
Continuum robot has potential to run freely through a cluttered environment as aircraft fuel tank. To improve manual maintenance, we designed an aircraft fuel tank inspection robot which was composed of cable-driven sections. A suitable path is essential for the robot to reach the target zone while avoiding obstacles, but path planning for continuum robot is a challenge due to their complex kinematics models. To depict the collision free planning problem, a nonlinear, constrained optimization formulation was adopted. Projection strategy was presented and an imaginary straight line between the origin and the target was made up as a reference line to simplify the planning problem. We focused on the decrease of computing time complexity, and based on region clipping, a novel forward search method was proposed to solve this optimization-based planning problem. With the reference straight line, the minimum distance summation (MDS) was calculated to decide the optimal path relatively. Experiments on MATLAB were reasonably designed. Simulations and results analysis demonstrated excellent performance of region clipping search method and feasibility of the avoidance algorithm.
Article
We present a new variable curvature continuum kinematics for multisection continuum robots with arbitrarily shaped backbone curves assembled from sections with three degrees of freedom (DoFs) (spatial bending and extension, no torsion). For these robots, the forward kinematics and the differential forward kinematics are derived. The proposed model approach is capable of reproducing both the constant and variable backbone curvature in a closed form. It describes the deformation of a single section with a finite number of serially connected circular arcs. This yields a section model with piecewise constant and, thus, a variable section curvature. Model accuracy and its suitability for kinematic real-time control applications are demonstrated with simulations and experimental data. To solve the redundant inverse kinematics problem, a local resolution of redundancy at the velocity level through the use of the robot’s Jacobian matrix is presented. The Jacobian is derived analytically, including a concept for regularization in singular configurations. Experimental data are recorded with Festo’s Bionic Handling Assistant. This continuum robot is chosen for experimental validation, as it consists of a variable backbone curvature because of its conically tapering shape.
Article
This paper presents a novel technique for the navigation of a snake arm robot, for real-time inspections in complex and constrained environments. These kinds of manipulators rely on redundancy, making the inverse kinematics very difficult. Therefore, a tip following method is proposed using the sequential quadratic programming optimization approach to navigate the robot. This optimization is used to minimize a set of changes to the arrangement of the snake arm that lets the algorithm follow the desired trajectory with minimal error. The information of the Snake Arm pose is used to limit deviations from the path taken. Therefore, the main objective is to find an efficient objective function that allows uninterrupted movements in real-time. The method proposed is validated through an extensive set of simulations of common arrangements and poses for the snake arm robot. For a 24 DoF robot, the average computation time is 0.4 s, achieving a speed of 4.5 mm/s, with deviation of no more than 25 mm from the ideal path.
Conference Paper
Continuum arms have interesting features useful for navigation in unstructured environments such as minimally invasive surgeries and inspection tasks. However, planning motions to avoid obstacles for these arms is challenging due to their complex kinematics. In this paper a path planning and obstacle avoidance algorithm for multisection continuum arms in dynamic environments is presented. This work is potentially applicable to surgical procedures to navigate near vital organs and reach surgical targets without injuring surrounding tissues. On the macro scale it can snake a continuum arm through constrained spaces such as inside of tubes for search and rescue purposes. Simulation results are presented for obstacle avoidance in static and dynamic environments. The algorithm utilizes a mode shape function based kinematic model of continuum arms and yields accurate solutions efficiently. This approach can be easily extended for other configurations of continuum arms.
Article
This paper presents a novel “layer jamming” mechanism that can achieve variable stiffness. The layer jamming mechanism exploits the friction present between layers of thin material, which can be controlled by a confining pressure. Due to the mechanism's hollow geometry, compact size, and light weight, it is well suited for various minimally invasive surgery applications, where stiffness change is required. This paper describes the concept, the mathematical model, and a tubular snake-like manipulator prototype. Various characteristics of layer jamming, such as stiffness and yield strength, are studied both theoretically and experimentally.
Conference Paper
Concentric tube robots are continuum robots that can navigate natural pathways to reach locations deep inside the human body. Their operation is based on rotating and telescopically actuating concentric tubes to achieve robot tip pose control. During tube manipulation, the elastic energy stored in the robot structure may give rise to unstable robot configurations and loss of control. This can occur, in particular, for highly curved and elongated tubes that are required for certain surgical interventions. This paper presents a path planning methodology that allows the utilization of such generally unstable concentric tube robots by ensuring that they operate in their stable configuration regions.
Article
This paper presents a unique real-time obstacle avoidance approach for manipulators and mobile robots based on the artificial potential field concept. Collision avoidance, tradi tionally considered a high level planning problem, can be effectively distributed between different levels of control, al lowing real-time robot operations in a complex environment. This method has been extended to moving obstacles by using a time-varying artificial patential field. We have applied this obstacle avoidance scheme to robot arm mechanisms and have used a new approach to the general problem of real-time manipulator control. We reformulated the manipulator con trol problem as direct control of manipulator motion in oper ational space—the space in which the task is originally described—rather than as control of the task's corresponding joint space motion obtained only after geometric and kine matic transformation. Outside the obstacles' regions of influ ence, we caused the end effector to move in a straight line with an upper speed limit. The artificial potential field ap proach has been extended to collision avoidance for all ma nipulator links. In addition, a joint space artificial potential field is used to satisfy the manipulator internal joint con straints. This method has been implemented in the COSMOS system for a PUMA 560 robot. Real-time collision avoidance demonstrations on moving obstacles have been performed by using visual sensing.