Professional Documents
Culture Documents
http://dx.doi.org/10.1007/s12555-019-0449-y http://www.springer.com/12555
Abstract: Continuum manipulators are a class of special compliant robots that have important potential applica-
tions in the field of human-machine interactive operations, or work in cluttered and constrained environments. In
these application scenarios, the most popular operation tasks are those with coupling force-position constraints. To
simultaneously stabilize the desired operation force and the position of the manipulator, variable impedance control
issues of the cable driven continuum manipulators are investigated in this paper. On the basis of constructing a novel
Lyapunov function, a variable impedance control law is presented and the stability of the closed-loop system has
also been analyzed. Then the operation space variable impedance control for a single segment cable driven contin-
uum manipulator is realized by the aid of a pseudo-rigid-body model. Some numerical simulations also demonstrate
the stability of the variable impedance control system.
Manuscript received June 17, 2019; revised September 22, 2019; accepted November 17, 2019. Recommended by Associate Editor Joonbum
Bae under the direction of Editor Kyoung Kwan Ahn. This work is supported by the National Key R&D Program of China under Grant
No. 2019YFB1309603, Beijing Natural Science Foundation under Grants L172001, 4204097, 3172009 and 3194047, Natural Science
Foundation of China under Grant 51775002.
Guangping He, Yanan Fan, Tingting Su, Lei Zhao, and Quanliang Zhao are with Department of Mechanical and Electrical Engi-
neering, North China University of Technology, Beijing 100144, China (e-mails: hegp55@126.com, 535424873@qq.com, {sutingting,
zhaolei}@ncut.edu.cn, zql-01@163.com). Tingting Su is also with State Key Laboratory of Management and Control for Complex Systems,
Institute of Automation, Chinese Academy of Sciences, Beijing 100190, China.
* Corresponding author.
⃝ICROS,
c KIEE and Springer 2020
2 Guangping He, Yanan Fan, Tingting Su, Lei Zhao, and Quanliang Zhao
i Θ̇
ẋxi = (JJ B )i−1 Θi−1 , (2)
[ ]
where (JJ B )i−1
i = ∂∂Θf i−1
i−1
∈ ℜ6×2 is the robot-independent
Jacobian matrix [32] of the segment oi−1 − oi , which maps
(b) a speed vector from the configuration space to the opera-
tion space. The Jacobian matrix (JJ B )i−1 i for single segment
Fig. 1. The cable driven continuum manipulator. (a) The continuum manipulator is given in the Appendix A of the
3D prototype of a four segments CDCM; (b) The paper.
compliant mechanism of a segment of the CDCM. Different from a conventional industrial robot manipu-
lator, the actuation space and the configuration space of
continuum manipulators are generally not identical. To
control the manipulator in actuation space, the kinemat-
ics between the actuation space and configuration space
is also necessary. As shown in Fig. 3, we suppose the
elastic segment oi−1 − oi of the continuum manipulators is
actuated by three cables, which are uniformly distributed
with regard to the cross sections. Since herein the relative
effective-length of the cables determines the shape of the
elastic segments, the actuation space of an elastic segment
[ ]T
can be parameterized by q i−1 = li−1,1 li−1,2 li−1,3 ,
where li−1, j ( j = 1, 2, 3) are the effective lengths of the
cables. Referring to Fig. 3, let ϕi−1, j ( j = 1, 2, 3) be the
angles between the plane A − oi−1 − oi and the radius at
the passing through points of the cables in the base cross-
Fig. 2. Parameters of a segment of a continuum manipula- section, and with the aid of a diagram (see Fig. 4) illustrat-
tor in configuration space. ing the geometric relationship associated with the cable’s
planes, it is not difficult to obtain the following forward
kinematics from the actuation space to configuration space
the body with respect to the axis zi−1 is defined to be ϕi−1 .
Θi−1 = hi−1 (qi−1 ). (3)
Considering the specific structure of the complaint mech-
anism, it is supposed that the backbone’s arc length ℓi−1 of It is similar to (1), and the inverse kinematics q i−1 =
all segments of the continuum manipulator can neither be h −1 Θi−1 ) of (3) cannot be analytically obtained gener-
i−1 (Θ
compressed nor extended, and the curvature of the elastic ally. Once more, with the help of the following differential
4 Guangping He, Yanan Fan, Tingting Su, Lei Zhao, and Quanliang Zhao
F l = J TF x . (6)
∂Fl ∂Fl ∂q
= = kJJ + , (8)
∂x ∂q ∂x
where k is the identical tensile stiffness of the cables. From
(7) and (8), it follows that
where the second term in the right hand side of (9) only de-
Fig. 4. The geometric relationship of the tendon’s planes pends on the structure parameters k and the configuration
parallel to the flexure plane of an elastic segment. of a manipulator, therefore it is said to be the “passive”
stiffness of the manipulators. For some continuum manip-
ulators, such as the concentric tube surgical robots [16],
kinematics of (3), the passive stiffness term can only be used to adjust the
operation stiffness since the structures and the actuators
Θi−1 = (JJ A )ii−1q̇qi−1 ,
Θ̇ (4) of the robot are amalgamated, and thereby the adjustment
[ ] range of the operation stiffness is rather limited. The first
where (JJ A )i−1
i = ∂∂ hq i−1
i−1
∈ ℜ2×3 is the robot-dependent Ja- term in the right hand side of (9) is said to be “active”
cobian matrix [32] of the segment oi−1 − oi , which maps a stiffness since the operation stiffness can be controlled by
speed vector from the actuation space to the configuration the actuator forces F l in a larger range. As the cable actu-
space, then the inverse kinematics of (3) can be resolved ated continuum manipulators considered in this paper, the
locally. The robot-dependent Jacobian matrix (JA )i−1 i of active stiffness term in (9) can also be used to control the
the cable driven single segment continuum manipulators operation stiffness of the continuum manipulators.
illustrated in Fig. 1(b) is presented in the Appendix B of
this paper. 3. IMPEDANCE CONTROL OF THE
MANIPULATORS
2.2. Operation stiffness analysis of the continuum ma-
nipulator 3.1. Invariant impedance control
A notable feature of a continuum manipulator is its In order to simultaneously stabilize the manipulator to a
weak structural stiffness. However, high stiffness is of given position and a desired interaction forces, impedance
paramount importance for many real world applications. control in Cartesian space is commonly established by sta-
Combined with the differential kinematics (2) and (4), the bilizing the following dynamic system
overall differential kinematics of an elastic segment of a
H x̄x¨ +D
Dx̄x˙ +K
K x̄x = F x , (10)
continuum manipulator can be written as
where x̄x = x − x d is defined to be the vector of position
ẋx = J q̇q, (5) errors in operation space, and x d is the desired position
Variable Impedance Control of Cable Actuated Continuum Manipulators 5
used in the definition of the matrix Ĉ C (see Lemma 1 in the trix K̇ K (t) ≤ Γ,
K (t) with respect to time is bounded, i.e., K̇
following). Substituting (10) into (13) and considering the where Γ > 0 is a constant. Then if there exists a constant
definition of the position errors x̄x = x −xxd , it is straightfor- α > 0 and a matrix D (t), so that the following set of in-
ward that the control law in actuation space can be given equalities is satisfied
by
α > 0,
[ d ]
Cẋxd + N̂
Mẍx + Ĉ
M̂ N K (t) + α D (t) − α 2H > 0,
F l = JT . (14)
M −H
+(M̂ C −D
H )x̄x¨ + (Ĉ D)x̄x˙ −K
K x̄x
(19)
−DD(t) + α H < 0,
In other words, under the control inputs (14), the operation
K (t) + α Ḋ
K̇ D(t) − 2α K (t) < 0,
space dynamics (13) is equivalent to the desired dynamics
(10). By choosing appropriate dynamics parameters H , D then the closed-loop system
and K , then the position errors x̄x are stable if the external
loads F x ̸= 0. When there does not exist external force,
Mẍx + Ĉ
M̂ N = F x +JJ +TF l ,
Cẋx + N̂
[ d ]
i.e., F x = 0, then the position errors x̄x of the closed-loop Cẋxd + N̂
Mẍx + Ĉ
M̂ N [
T ]
system (10) should be asymptotically stable.
F l = J
+ M −H
+(M̂ C −D
H )x̄x¨ + Ĉ D(t) x̄x˙ −K
K (t)x̄x
Lemma 1: The identity J + B = −J̇
J BJ +
B J̇ J B is valid.
Proof: Let’s see (2). For more clarity, (2) can be simply (20)
Θ, of which the acceleration relationship
written as ẋx = J BΘ̇
is globally asymptotically stable at the origin x̄x = 0 when
is given by (12). The inverse kinematics of ẋx = J BΘ̇ Θ is
the external loads F x = 0. If F x ̸= 0, then the origin x̄x = 0
given by Θ̇Θ = J+ B x
ẋ . The time derivative of the last equation
is stable.
is written as
Proof: Substituting the second equation of (20) into the
+
Θ = J+
Θ̈ x + J̇J B ẋx.
B ẍ (15) first one, it follows that
By using the definition of the position errors x̄x = x − x d , Due to the assumption K (t) > 0, if the first inequal-
then it follows that ity α 2H < α D(t) is satisfied, then the second inequality
K (t) + α D (t) > α 2H is automatically satisfied. Thus the
H x̄x¨ +D
D(t)x̄x˙ +K
K (t)x̄x = F x . (23) inequalities group (30) can be further simplified as
To prove the stability of the dynamic system (23), we se- {
α H < D (t),
lect a Lyapunov candidate function (31)
K (t) + α Ḋ
K̇ D(t) < 2α K (t).
1 1
V(x̄x˙ , x̄x,t) = (x̄x˙ + α x̄x)TH (x̄x˙ + α x̄x) + x̄xTβ (t)x̄x, (24) To solve the damping matrix D (t) from the inequalities
2 2
group (31), we change (31) to an equivalent form for more
where the scalar constant α > 0 and the time-varying ma-
clarity
trix β (t) > 0. To analyze the stability conditions of the
closed-loop system (23), the time derivative of the func- D (t) > α H ,
tion (24) along the dynamic system (23) can be given by 1 (32)
ḊD(t) < − K̇K (t) + 2K
K (t).
V̇(x̄x˙ , x̄x,t) α
1 Since the stiffness matrix K̇ K (t) ≤
K (t) is bounded, i.e., K̇
β (t)x̄x. (25)
= (x̄x˙ + α x̄x)TH (x̄x¨ + α x̄x˙ ) + x̄xTβ (t)x̄x˙ + x̄xTβ̇ Γ > 0, as given in the proposition, so we can always give a
2
small constant ρ > 0, such that there exists a positive con-
Suppose the external loads F x = 0 in (23), and substitute
stant α > 0 satisfying the equation − α1 K̇ K (t) > ρ I ,
K (t) + 2K
D(t)x̄x˙ −K
the resulted equation H x̄x¨ = −D K (t)x̄x into (25), and
where I is an identical matrix. On the basis of the above
with some straightforward arrangements, (25) can be writ-
analysis, we can conclude that the following equation
ten as
D (t) = α H + ρ I , t ≥ 0 (33)
V̇(x̄x˙ , x̄x,t) =x̄x˙ T [−D D(t) + α H ] x̄x˙
[ ]
+ x̄x˙ T β (t) −K K (t) − α D (t) + α 2H x̄x is a feasible solution of the inequalities group (19).
[ ] Remark 2: The special form of Lyapunov function (24)
1
+ x̄xT β̇ β (t) − α K (t) x̄x. (26) was first presented in [27] based on the method presented
2 in [33] for analyzing a time-varying scalar system. The
Define characteristic of the Lyapunov function (24) is that it is
virtual energy functions of weighted sums of the veloc-
β (t) = K (t) + α D (t) − α 2H , (27) ity error and position error. In addition, from (29), we can
and the time derivative of (27) is given by see that the convergence analysis of the function V̇(x̄x˙ , x̄x,t)
does not depend on the state of the controlled system. In
β (t) = K̇
β̇ K (t) + α Ḋ
D(t), (28) this paper, we extend this stability analysis method to op-
eration space variable impedance control for CDCMs. In
then (26) can be rewritten as Remark 2 we also present a different method from that
V̇(x̄x˙ , x̄x,t) in [27] to solve the stability conditions (19). It is shown
[ ] that under certain condition solving the inequalities group
1
˙T D(t) + α H ] x̄x˙ + x̄x
= x̄x [−D T
β (t) − α K (t) x̄x
β̇ can be transformed to design the unique scalar parameter
2 α . Even though the presented method shows some con-
= x̄x˙ T [−DD(t) + α H ] x̄x˙ servatism, the proposed method is feasible in real world
[ ] applications for stabilizing the continuum manipulators,
T 1 1
+ x̄x K (t) + α Ḋ
K̇ D(t) − α K (t) x̄x. (29) since most of operations for continuum manipulators are
2 2
interaction tasks, where the operation compliance is a ba-
Thus the stability conditions of the closed-loop system sic feature. Certainly, optimizing the control parameters is
(23) can be summarized as (19). The first two inequali- a valuable work, but that is beyond the scope of this paper.
ties in (19) are used since the positive definite property Remark 3: It is worth mentioning that, the controller
of the function V(x̄x˙ , x̄x,t) must be ensured, while the last F l only uses position feedbacks in the variable impedance
two inequalities in (19) are used to guarantee the negative control closed-loop systems (20), such that the hardware
definite property of the differential function V̇(x̄x˙ , x̄x,t). costs of the continuum manipulator systems can be re-
Remark 1: Under the condition α > 0, the inequalities duced, and the difficulty of installing force sensor on the
group (19) can be simplified as mechanical structure of the manipulators can be avoided.
2 To obtain velocity and acceleration error signals from the
α < α (t),
H D
position feedbacks, many kinds of observers or estimators
K (t) + α D (t) > α 2H , (30) can be utilized, such as the relevant approaches presented
K (t) + α Ḋ
K̇ D(t) < 2α K (t). in [34].
Variable Impedance Control of Cable Actuated Continuum Manipulators 7
Remark 4: It is worthy to mention that, from the view- On the basis of the pseudo-rigid-body model, by the La-
point of practical applications, the computational burden grange mechanics [35], the dynamics of the single seg-
of the invariant impedance controller (14) and the vari- ment continuum manipulators in configuration space can
able one (20) are mainly caused by calculating the coef- be written as
C , which is associated with the centrifugal
ficient matrix Ĉ ( )
d ∂L ∂L
and Coriolis forces of the system dynamics (13). How- − = J TBF x +JJ +T
A F l, (34)
ever, since the continuum manipulators are generally used dt ∂ Θ̇Θ ∂Θ
to complete interaction tasks, the movement speeds of the [ ]T
manipulators cannot be too fast. Thus the relevant forces where Θ = κi−1 ϕi−1 is the generalized coordinates
C caused by coupling velocities are rather small and
terms Ĉ in configuration space, L = T − U is the Lagrangian, and
can be neglected in designing the closed-loop systems. T is kinetic energy while Uis potential energy. Then by
some simple deductions, the configuration space dynam-
ics of the single segment continuum manipulator can be
4. NUMERICAL SIMULATIONS presented as a form of (11). The detailed form of the dy-
namics (11) for the continuum manipulator considered in
4.1. Dynamics modeling of the single segment CD- this paper is provided in the Appendix C. Then follow-
CMs
ing the same lines as that presented in the Section 3.1 or
No matter what kind of compliant mechanism is adopted Section 3.2, the invariant impedance control or variable
for designing the continuum manipulators, single segment impedance control of single segment continuum manipu-
of the continuum manipulators can only produce rather lators can be realized respectively, as that are presented in
limited motion range generally due to their special ac- the following subsections.
tuation methods [1–6]. It is reasonable of establishing a Remark 5: As shown in Section 2.1, since the DOF
pseudo-rigid-body model of single segment continuum of the configuration space is two while the dimension of
manipulator, as shown in Fig. 5, where the bending move- the actuation space is three, the cable driven single seg-
ments of the elastic segment are approximated by a coil ment continuum manipulators considered in this paper is
spring with constant stiffness kθ that locates the center of actually a redundantly actuated system. As discussed in
the base disk, while the torsional movements are approx- [36, 37], the dynamics of a redundantly actuated paral-
imated by a torsion spring with constant stiffness kϕ that lel manipulator can also be expressed as the form (11) in
also locates the center of the base disk. In addition, the terms of its generalized coordinates. For the cable driven
elastic segment is approximated to a rigid link with invari- single segment continuum manipulators shown in Fig. 1,
ant length ℓi−1 , and it is assumed that the total mass of [ ]T
the generalized coordinates are Θ = κi−1 ϕi−1 . Thus
the elastic segment is concentrated at the end of the rigid the dynamics model (see Appendix C) can be given as the
link for simplifying the dynamics. Referring to Fig. 3 and form of (11) without any difficulty.
Fig. 4, it is observed when the central angle of arc length
ℓi−1 is θi−1 , then the equivalent deformation angle of the 4.2. Numerical simulations of invariant impedance
coil spring kθ can be approximated to θi−1 /2. control
Referring to Section 3.1, by applying the robot-independ-
ent Jacobian J B and its differential matrix, which are pro-
vided in the Appendix D, the configuration space dynam-
ics (C.5) of the single segment continuum manipulator can
be transformed into the operation space dynamics (13).
Then using the control law (14), the operation space dy-
namics (13) can be stabilized to the desired dynamic sys-
tem (10).
In the first numerical simulation, the relevant structure
parameters of the single segment continuum manipulators
are listed in Table 1. The control parameters and the initial
state of the system are listed in Table 2. Under the invari-
ant impedance control law (14), the numerical simulation
results of the closed-loop system are illustrated in Figs. 6-
9.
It’s observed that, for a desired but arbitrarily given in-
[ ]T
teraction forces Fx = 0.2 0.1 , the state (as shown in
Fig. 5. Pseudo-rigid-body model of single segment con- Fig. 6) of the closed-loop system is stable, and the out-
tinuum manipulator. put interaction forces Fx are also asymptotically stabilized
8 Guangping He, Yanan Fan, Tingting Su, Lei Zhao, and Quanliang Zhao
Table 2. The initial state and the control parameters for in-
variant impedance control.
Parameters Symbols Value Unit
[ ]T
Initial position e = x̄x 0.03 −0.02 m
errors
[ ]T
Initial speed ėe = x̄x˙ 0.1 −0.1 m/s
errors
[ ]
Desired inertial 1.5 0
H Kg
matrix 0 1.0
[ ]
Desired stiffness 10 0
K N/m
matrix 0 15 Fig. 7. The output forces of the closed-loop system in in-
[ ]
Desired damping 4 0 variant impedance control.
D N/s
matrix 0 5
[ ]T
External forces Fx 0.2 0.1 N
[ ]T
to the desired values 0.2 0.1 . Correspondingly, the
actuation forces as shown in Fig. 9 are stable and the di-
rections (always less than zero) of them are not changed
in the control task. So the cables do not appear a relaxed
state. From Fig. 8, it is also observed that the variations
of the cables’ length are not large. The reason is that the
radius of the disks Ri−1 (see Fig. 2) is far less than the arc
length of the elastic segment ℓi−1 , such that a small change Fig. 8. The length of the cables of the manipulator in in-
in the cables’ length cause a relatively large deformation variant impedance control.
in the end of the manipulator. As discussed in [29], this is
a common phenomenon in continuum manipulators due to
the special driving mode.
( )
−1 2li−1,1 − li−1,2 − li−1,3 where Ug denotes the gravitational potential energy. Com-
ϕi−1 (qqi−1 ) = tan √ ,
3 (li−1,2 − li−1,3 ) pared with the elastic potential energy, the gravitational
potential energy is very small due to the small mass of
(B.1b)
the lightweight compliant mechanism. So the gravitational
where Ri−1 is the radius of the disks as shown in Fig. 1. On potential energy is omitted in our simulations.
the basis of the kinematics (B.1a) and (B.1b), the robot- In (C.1) the position of the centre of gravity (CG) is
dependent Jacobian is calculated by given by
∂ κi−1 ∂ κi−1 ∂ κi−1 cos ϕi−1 (1 − cos θi−1 )
1
∂ li−1,1 ∂ li−1,2 ∂ li−1,3 x ci = sin ϕi−1 (1 − cos θi−1 ) , (C.3)
(JJ A )i−1
i =
∂ ϕi−1 ∂ ϕi−1 ∂ ϕi−1 ,
(B.2) κi−1
sin θi−1
∂ li−1,1 ∂ li−1,2 ∂ li−1,3
which is obtained based on the position vector (A.3) pre-
where sented in Appendix A. Then the speed of the CG can be
written as
∂ κi−1 Λ1 (2li−1,1 − li−1,2 − li−1,3 )
= , cos ϕi−1 (cos θi−1 − 1)
∂ li−1,1 3Ri−1 ℓi−1
κi−1
2
∂ κi−1 Λ1 (2li−1,2 − li−1,1 − li−1,3 )
= , sin ϕi−1 (cos θi−1 − 1)
∂ li−1,2 3Ri−1 ℓi−1 ẋxci =
κ̇i−1 .
(C.4)
κi−1
2
∂ κi−1 Λ1 (2li−1,3 − li−1,1 − li−1,2 ) κi−1 ℓi−1 − sin θi−1
= ,
∂ li−1,3 3Ri−1 ℓi−1 κi−1
2
∂ ϕi−1 2
= , Then by applying (34), the configuration space dynamics
∂ li−1,1 Λ2
of the single segment continuum manipulator can be pre-
∂ ϕi−1 4 (li−1,3 − li−1,1 )
= √ , and sented as follows:
∂ li−1,2 3 (li−1,2 − li−1,3 )2 Λ2
∂ ϕi−1 4 (li−1,1 − li−1,2 ) Θ +C
M Θ̈ Θ, Θ̇
C (Θ Θ)Θ̇
Θ +N Θ) = J TBF x +JJ +T
N (Θ A F l, (C.5)
= √ ,
∂ li−1,3 3 (li−1,2 − li−1,3 )2 Λ2 [ ]T
where Θ = κi−1 φi−1 . The inertial matrix has a form
with [ ]
m11 m12
M= ,
Λ1 =(li−1,1
2 2
+ li−1,2 2
+ li−1,3 − li−1,1 li−1,2 − li−1,1 li−1,3 m21 m22
− li−1,2 li−1,3 )− 2 ,
1
ℓi−1 (1 − cos θi−1 ) (κi−1 ℓi−1 − sin θi−1 ) k Tensile stiffness of the cables
+m κ̇i−1 ,
κi−1
4
x̄x Vector of position errors in operation space
c12 =c21 = 0, and xd Desired position of the end-effector of
a manipulator
c22 =0.
M Inertial matrix of the manipulators
The potential forces term has a form Θ, Θ̇
C (Θ Θ) Coefficient matrix associated with
the centrifugal and Coriolis forces
[ ] Potential forces that include gravity and elastic
n Θ)
N (Θ
Θ) = 1 ,
N (Θ forces
n2
H Const inertial matrix of closed-loop system
where n1 = kθi−1 ℓi−1 θi−1 and n2 = kφi−1 ϕi−1 . K (t) Time-varying stiffness matrix
D (t) Time-varying damping matrix
Γ A positive scalar constant
APPENDIX D: THE ROBOT-INDEPENDENT
JACOBIAN AND ITS DIFFERENTIAL MATRIX α A positive scalar constant
USED IN NUMERICAL SIMULATIONS ρ A small positive constant
V(x̄x˙ , x̄x,t) Lyapunov candidate function
The single segment continuum manipulator consid- β (t) Positive time-varying matrix
ered in this paper has only two DOF, thus the robot- I Identical matrix
independent Jacobian and its differential matrix used in Coil spring’s constant stiffness that locates
kθ
the numerical simulations are respectively given by: the center of the base disk
[ cos ϕi−1 (cos θi−1 −1) ] kϕ Torsion spring’s constant stiffness that locates
0 the center of the base disk
κi−1
2
JB = sin ϕi−1 (cos θi−1 −1) , (D.1) Θ Generalized coordinates in configuration space
κi−1
2 0
L Lagrangian function
and T Kinetic energy
U Potential energy
−2 cos ϕi−1 (cos
κ3
θi−1 −1)
κ̇i−1 JA Robot-dependent Jacobian matrix
sin ϕi−1 (cosi−1
− θi−1 −1)
ϕ̇i−1 0 JB Robot-independent Jacobian matrix
κi−1
2
cos ϕi−1 sin θi−1 The Jacobian matrix of the manipualtors that is
− θ̇i−1 J
J̇J B = κi−1 .
2 defined byJ := JB JA
−2 sin ϕi−1 (cos θi−1 −1) κ̇ (D.2)
κi−1
3 i−1 J+ Moore-Penrose pseudo-inverse of the matrixJ
cos ϕi−1 (cos
+ θi−1 −1)
ϕ̇i−1 0 Ri−1 Radius of the disks, as shown in Fig. 2
κi−1
2
sin ϕi−1 sin θi−1
− κ2
θ̇i−1
i−1
REFERENCES
APPENDIX E: SYMBOLS TABLE [1] J. B. Kahrs, D. C. Rucker, and H. Choset, “Continuum
robots for medical applications: a survey,” IEEE Trans. on
Symbols Connotation Robotics, vol. 31, no. 6, pp. 1261-1280, 2015.
θi−1 Dihedral angle of the segmentoi−1 − oi [2] D. Ji, T. H. Kang, S. Shim, and J. Hong, “Analysis of twist
ri−1 Radius of the dihedral fan oi−1 − oi − A, as deformation in wire-driven continuum surgical robot,” In-
shown in Fig. 3 ternational Journal of Control, Automation and Systems,
ϕi−1 Torsion angle of the body with respect to the 2019. DOI:10.1007/s12555-018-0400-7
axis zi−1
[3] M. U. Farooq and S. Y. Ko, “An automated extracorpo-
ℓi−1 Backbone’s arc length of a segment of the real knot-tying system using two concentric tube robotic
continuum manipulator arms for deployment through a 3-mm port,” International
κi−1 Curvature of the elastic segmentoi−1 − oi Journal of Control, Automation and Systems, 2019. DOI:
q i−1 Actuation space of an elastic segment 10.1007/s12555-018-0424-z
li−1, j Effective lengths of the cables [4] Y. Ansari, M. Manti, E. Falotico, M. Cianchetti, and C.
Angles between the plane A − oi−1 − oi and Laschi, “Multiobjective optimization for stiffness and po-
ϕi−1, j the radius at the passing through points of the sition control in a soft robot arm module,” IEEE Robotics
cables in the base cross-section and Automation Letter, vol. 3, no. 1, pp. 108-115, 2018.
Fx External forces of a manipulator [5] X. Dong, D. Axinte, D. Palmer, S. Cobos, M. Raffles, A.
Fl Actuation forces of a manipulator Rabani, and J. Kell, “Development of a slender continuum
Operation stiffness of the continuum robotic system for on-wing inspection/repair of gas turbine
K i−1
manipulators engines,” Robotics and Computer-Integrated Manufactur-
H TE Hessian tensor ing, vol. 44, pp. 218-229, 2017.
Variable Impedance Control of Cable Actuated Continuum Manipulators 13
[6] W. McMahan, V. Chitrakaran, M. Csencsits, D. Dawson, I. [19] K. Xu and N. Simaan, “An investigation of the intrin-
D. Walker, B. A. Jones, M. Pritts, D. Dienno, M. Grissom, sic force sensing capabilities of continuum robots,” IEEE
and C. D. Rahn, “Field trials and resting of the OctArm Trans. on Robotics, vol. 24, no. 3, pp. 576-587, 2008.
continuum manipulator,” Proc. of the 2006 IEEE Interna- [20] R. E. Goldman, A. Bajo, and N. Simaan, “Compliant mo-
tional Conf. on Robotics and Automation, pp. 2336-2341, tion control for multisegment continuum robots with actu-
2006. ation force sensing,” IEEE Trans. on Robotics, vol. 30, no.
[7] C. C. Cheah, S. Kawamura, and S. Arimoto, “Stability of 4, pp. 890-902, 2014.
hybrid position and force control for robotic manipulator [21] V. Falkenhahn, T. Mahl, A. Hildebrandt, R. Neumann, and
with kinematics and dynamics uncertainties,” Automatica, O. Sawodny, “Dynamic modeling of bellows-actuated con-
vol. 39, no. 5, pp. 847-855, 2003. tinuum robots using the EulerLagrange formalism,” IEEE
[8] A. Bajo and N. Simaan, “Hybrid motion/force control Trans. on Robotics, vol. 31, no. 6, pp. 1483-1496, 2015.
of multi-backbone continuum robots,” The International [22] S. Jung, T. C. Hsia, and R. G. Bonitz, “Force tracking
Journal of Robotics Research, vol. 35, no. 4, pp. 422-434, impedance control of robot manipulators under unknown
2016. environment,” IEEE Trans. on Control Systems Technol-
[9] M. C. Yip and D. B. Camarillo, “Model-less hybrid po- ogy, vol. 12, no. 3, pp. 474-483, 2004.
sition/force control: a minimalist approach for contin- [23] C. Ott, Cartesian Impedance Control of Redundant and
uum manipulators in unknown, constrained environments,” Flexible Joint Robots, Springer-Verlag, Berlin Heidelbert,
IEEE Robotics and Automation Letters, vol. 1, no. 2, pp. 2008.
844-851, 2016. [24] J. A. Blaya and H. Herr, “Adaptive control of a variable-
[10] M. K. Soltani, S. Khanmohammadi, F. Ghalichi, and F. impedance ankle-foot orthosis to asasist drop-foot gait,”
J. Sharifi, “A soft robotics nonlinear hybrid position/force IEEE Trans. on Neural Systems and Rehabilitation Engi-
control for tendon driven catheters,” International Journal neering, vol. 12, no. 1, pp. 24-31, 2004.
of Control, Automation and Systems, vol. 15, no. 1, pp. 54- [25] F. Ficuciell, L. Villan, and B. Siciliano, “Variable
63, 2017. impedance control of redundant manipulators for intu-
[11] C. Ott, R. Mukherjee, and Y. Nakamura, “A hybrid system itive humanrobot physical interaction,” IEEE Trans. on
framework for unified impedance and admittance control,” Robotics, vol. 31, no. 4, pp. 850-863, 2015.
Journal of Intelligent and Robotic Systems, vol. 78, no. 3-4, [26] S. Wolf, G. Grioli, O. Eiberger, W. Friedl, M. Grebenstein,
pp. 359-375, 2015. H. Höppner, E. Burdet, D. G. Caldwell, R. Carloni, M. G.
[12] H. Liu, A. Farvardin, R. Grupp, R. J. Murphy, R. H. Taylor, Catalano, D. Lefeber, S. Stramigioli, N. Tsagarakis, M. V.
I. Iordachita, and M. Armand, “Shape tracking of a dexter- Damme, R. V. Ham, B. Vanderborght, L. C. Visser, A. Bic-
ous continuum manipulator utilizing two large deflection chi, and A. Albu-Schäffer, “Variable stiffness actuators: re-
shape sensors,” IEEE Sensors Journal, vol. 15, no. 10, pp. view on design and components,” IEEE/ASME Trans. on
5494-5503, 2015. Mechatronics, vol. 21, no. 5, pp. 2418-2430, 2016.
[27] K. Kronander and A. Billard, “Stability considerations for
[13] G. P. He, “Motion planning and control for endoscopic
variable impedance control,” IEEE Trans. on Robotics, vol.
operations of continuum manipulators,” Intelligent Service
32, no. 5, pp. 1298-1305, 2016.
Robotics, vol. 12, no. 2, pp. 159-166, 2019.
[28] M. T. Chikhaoui and J. B. Kahrs, “Control of continuum
[14] Y. Shapiro, G. Kosa, and A. Wolf, “Shape tracking of pla-
robots for medical applications: state of the art (invited re-
nar hyper-flexible beams via embedded PVDF deflection
view),” Proc. of The 16th International Conf. on New Ac-
sensors,” IEEE/ASME Trans. on Mechatronics, vol. 19, no.
tuators, pp. 154-164, 2018.
4, pp. 1260-1267, 2014.
[29] L. Toscano, V. Falkenhahn, A. Hildebrandt, F. Braghin, and
[15] R. J. Roesthuis, and S. Misra, “Steering of multisegment O. Sawodny, “Conguration space impedance control for
continuum manipulators using rigid-link modeling and continuum manipulators,” Proc. of The 6th International
FBG-based shape sensing,” IEEE Trans. on Robotics, vol. Conf. on Automation, Robotics and Applications, pp. 597-
32, no. 2, pp. 372-382, 2016. 602, 2015.
[16] M. Mahvash and P. E. Dupont, “Stiffness control of sur- [30] J. Z. Yang, E. P. Pitarch, J. Ptratz, S. Beck, and K. A.
gical continuum manipulators,” IEEE Trans. on Robotics, Malek, “Synthesis and analysis of a flexible elephant trunk
vol. 27, no. 2, pp. 334-345, 2011. robot,” Advanced Robotics, vol. 20, no. 6, pp. 631-659,
[17] Y. Wei, Y. Chen, Y. Yang, and Y. T. Li, “A soft robotic 2006.
spine with tunable stiffness based on integrated ball joint [31] S. Neppalli, M. A. Csencsits, B. A. Jones, and I. D. Walker,
and particle jamming,” Mechatronics, vol. 33, pp. 84-92, “Closed-form inverse kinematics for continuum manipula-
2016. tors,” Advanced Robotics, vol. 23, no. 15, pp. 2077-2091,
[18] A. Shiva, A, Stilli, Y. Noh, A. Faragasso, I. D. Falco, G. 2009.
Gerboni, M. Cianchetti, A. Menciassi, K. Althoefer, and [32] R. J. Webster III and B. A. Jones, “Design and kinematic
H. A. Wurdemann, “Tendon-based stiffening for a pneu- modeling of constant curvature continuum robots: a re-
matically actuated soft manipulator,” IEEE Robotics and view,” The International Journal of Robotics Research, vol.
Automation Letters, vol. 1, no. 2, pp. 632-637, 2016. 29, no. 13, pp. 1661-1683, 2010.
14 Guangping He, Yanan Fan, Tingting Su, Lei Zhao, and Quanliang Zhao
[33] J. J. E. Slotine and W. Li, Applied Nonlinear Control, Pren- Tingting Su received her B.S. degree in
tice Hall, Englewood Cliffs, NJ, 1991. automation from Central South University,
[34] G. Besancon, Nonlinear Observers and Applications, Changsha, China, in 2013, and her Ph.D.
Springer-Verlag, Berlin Heidelbert, 2007. degree in control theory and control en-
gineering from the Institute of Automa-
[35] R. M. Murray, Z. Li, and S. S. Sastry, A Mathematical In- tion, Chinese Academy of Sciences, Bei-
troduction to Robotic Manipulation, CRC Press, Boca Ra- jing, China, in 2018. She is currently with
ton, London, New York, Washington D.C, 1994. the Department of Mechanical and Mate-
[36] H. Cheng, Y. K. Yin, and Z. X. Li, “Dynamics and rials Engineering, North China University
control of redundantly actuated parallel manipulators,” of Technology, Beijing. Her current research interests include
IEEE/ASME Trans. on Mechatronics, vol. 8, no. 4, pp. 483- trajectory planning, robotics, and intelligent control systems.
491, 2003.
[37] A. Müller, “Consequences of geometric imperfections for Lei Zhao received his B.S. degree in pro-
the control of redundantly actuated parallel manipulators,” cess equipment and control and a Ph.D. de-
IEEE Transactions on Robotics, vol. 26, no. 1, pp. 21-31, gree in chemical engineering process and
2010. machinery from the Zhejiang University
of China, Hangzhou, China, in 2008 and
2015, respectively. From 2015 to 2016,
Guangping He received his B.S., M.S., he was with the Zhejiang Special Equip-
and Ph.D. degrees in mechanical and elec- ment Inspection and Research Institute,
trical engineering from the Beihang Uni- Hangzhou. Since 2016, he has been with
versity of China, Beijing, China, in 1994, the Department of Mechanical and Materials Engineering, North
1997, and 2002, respectively. During 1997 China University of Technology, Beijing, China. His current re-
and 2002, he was with Launch Vehicle search interests include storage and transportation of hydrogen
Technology Academy of China, Beijing. energy, micro-electromechanical devices, and microrobotics.
He was a Post-Doctoral Research Fellow
with the Department of Mechanics and En- Quanliang Zhao received his M.S. de-
gineering Science, Peking University, Beijing, from 2007 to gree in microelectronics and solid state
2008. Since 2002, he has been with the Department of Mechani- electronics from Heilongjiang University,
cal and Electrical Engineering, North China University of Tech- Harbin, China, in 2006, and his Ph.D. de-
nology, Beijing. His current research interests include dynamics gree in material processing engineering
and control of robots and micro-electromechanical devices. from the Beijing Institute of Technology,
Beijing, China, in 2010. He is currently
Yanan Fan received her B.S. degree in with the Department of Mechanical and
Mechanical Design, Manufacturing and Materials Engineering, North China Uni-
Automation from Shan Dong Jiao Tong versity of Technology, Beijing. His current research interests in-
University, Jinan, China, in 2017. Cur- clude micro-electromechanical systems and functional materi-
rently she is a master’s degree student in als.
the Department of Mechanical and Ma-
terials Engineering, North China Univer- Publisher’s Note Springer Nature remains neutral with regard
sity of Technology, Beijing, China. Her re- to jurisdictional claims in published maps and institutional affil-
search interests in variable stiffness con- iations.
trol of parallel mechanism.