Professional Documents
Culture Documents
d
System and Vibration, Manufacture for Thin-walled Structures,
ite
Shanghai Jiao Tong University, Shanghai Jiao Tong University,
800 Dongchuan Rd, Shanghai, China 800 Dongchuan Rd, Shanghai, China
Email: leungchan@sjtu.edu.cn Email: z.zhang@sjtu.edu.cn
ed
Hao Wang
py
State Key Laboratory of Mechanical System and Vibration, and Shanghai Key Laboratory
of Digital Manufacture for Thin-walled Structures, Shanghai Jiao Tong University,
Co
A611 Mechanical Building, Dongchuan Road, Shanghai, 200240, China
Email: wanghao@sjtu.edu.cn
ot
tN
This paper presents a general discretization-based approach of design, analysis and control of those mechanisms dramati-
to the large deflection problems of spatial flexible links in cally increases over their traditional counterparts. Therefore,
compliant mechanisms. Based on the principal axes de- establishment of effective and efficient solutions to the large
rip
composition of structural compliance matrices, a particular deflection problems of flexible links becomes one of the most
type of elements which relate to spatial 6-degree-of-freedom fundamental issues.
(DOF) serial mechanisms with passive elastic joints, is de-
To this end, many researchers have made their great con-
sc
1 Introduction
Owing to their inherent advantages, like compactness in In addition, discretization-based techniques are widely
structure, reduction of wear and backlash, and conservation used for solving the large deflection problems in compliant
of energy [1], compliant mechanisms have benefited a wide mechanisms. Frame finite element methods (FEM) [20] were
range of applications, such as micro-electromechanical sys- utilized for the synthesis of compliant mechanisms involving
tems (MEMS) [2], biomimetic robots [3], minimally invasive nonlinear force-deflection characteristics. Although the non-
surgical devices [4] and even DNA origami mechanism [5]. linear FEM is general and can deal with various large deflec-
However, unlike the traditional rigid-body ones, the compli- tion problems, it suffers from extensive computational cost
ant mechanisms usually undergo large deflection problems and numerical instability. To overcome this drawback, the
in the flexible members [6, 7]. Consequently, the complexity chain algorithm [21] adopted a recursive method to analyze
d
a sequence of linear ones. The smooth curvature model [28] of robot kinematic/statics. To validate the correctness of the
was developed as an efficient approach to predict the large proposed method, Sec. 4 conducts a large deflection exper-
ite
deflections of flexure-jointed robots. And recently, the beam- iment on a specialized apparatus. In Sec. 5, a planar com-
constraint model (BCM) [29] was improved based on Timo- pliant parallel manipulator is exemplified as a case study to
ed
shenko beam theory, which results in an analytical model to exhibit the effectiveness of the proposed general approach.
identify the bistable behavior of compliant mechanisms. In the end, some conclusions are drawn in Sec. 6.
Among the existing methods, most of them focus on the
py
load-deflection relation of flexible rods at their tip points.
As a consequence, they are not applicable to complex com- 2 Stiffness Modeling of Small Segment Elements
pliant mechanisms in which flexible links undergo coupling
Co
In this section, a brief introduction to the ‘principal axes
constraints, such as Festo’s delicate Bionic Tripod 3.0 [30]. decomposition’ of spatial compliance matrices is presented.
On the other hand, most of the aforementioned approaches Based on this idea, an approximation approach is established
were particularly developed for planar compliant mecha- to characterize the force-deflection relation of small segment
ot
nisms. And only few of them [24] can deal with the large elements discretized from spatial flexible rods. The main fea-
deflection problems of spatial flexible links. ture of the proposed stiffness modeling method is the use of
tN
In this paper, a general discretization-based approach is a mechanism/robotics way, rather than the mechanics ones,
proposed for the large deflection problems of spatial flexi- to solve the large deflection problems.
ble rods. Based on the principal axes decomposition of spa-
rip
To some extent, such an element can be regarded as a spe- synthesis of spatial robot compliance using springy elements.
cial kind of ‘pseudo-rigid-body model’, in which the pas- In these approaches, parallel or serial elastic mechanisms are
sive elastic joints are associated with the segments’ physi- utilized to realize a given spatial stiffness/compliance matrix.
nu
cal appreciations, such as the concepts of ‘center of compli- The motivation of the principal axes decomposition is to in-
ance’, ‘wrench-compliant axes’ and so on. As a result, serial troduce such kind of technique for the structural compliance
Ma
hyper-redundant mechanisms under various load/geometric an applied wrench into a twist deformation as
constraint conditions.
The benefit of such an approach is that the large deflec-
pt
redundant mechanisms under external load conditions and/or where F ∈ R6×1 denotes the applied wrench (a force screw)
geometric constraints. To make the derivation concise, the whose moment m ∈ R3×1 and force f ∈ R3×1 are expressed
product-of-exponential (POE) formula is adopted to model in Plücker’s axis coordinates. X ∈ R6×1 is the corresponding
the motion/force transmission, such that the closed-form so- twist deformation with its angular and linear components,
lution to the mechanism’s overall stiffness matrix can be ob- ω ∈ R3×1 and v ∈ R3×1 , assembled in the form of Plücker’s
tained in a straightforward manner. Hence, the correspond- ray coordinates.
ing equilibrium problems can be solved efficiently by means In relation (1), C ∈ R6×6 denotes the spatial compliance
of the gradient-based searching algorithms. Experiments are matrix which is symmetric and positive semi-definite (PSD).
conducted on an apparatus for measuring the force-deflection The 3 × 3 blocks A, D and B are its rotational, translational
relation of flexible links. And the results verified the correct- and coupling aspects, respectively. It is easy to validate that
T T 6
I3 I3 03 03
C= A + Λ = ∑ ci t i tTi (4)
B B U U i=1
d
And t i ∈ R6×1 are unit joint twists, given by
ite
ei
, ci = ai , i = 1, 2, 3
ed
Fig. 1. Principal axes decomposition of a general compliance.
b
i
ti = (5)
03 , ci = λi−3 , i = 4, 5, 6
A ∈ R3×3
both the rotational aspect and the translational one
py
u i−3
D ∈ R3×3 are symmetric and PSD matrices.
It should be noted that, in the linearized force-deflection
Co
relation (1), the twist X, wrench F and compliance matrix C where bi denotes the i th column of B. ai is the i th diagonal
are all represented with respect to the same coordinate frame. entry of A. e1 = [1, 0, 0]T , e2 = [0, 1, 0]T and e3 = [0, 0, 1]T
In other words, their components are all related to the same are unit vectors.
reference point and expressed in the same frame. Based on the rank-one decomposition (4) of compliance
ot
Since Plücker’s axis and ray coordinates are employed matrix, the force-deflection relation of the elastic system can
to represent the twist and wrench quantities, respectively, the be approximately characterized via a serial 6-DOF passive
tN
congruence transformation [32] should be utilized to map the mechanism, as illustrated in Fig. 1, by means of successively
6 × 6 spatial compliance matrix from one coordinate frame connecting the joints t i with compliance ci .
to another as It is known that the first set of decomposed twists relate
rip
HTg = (H∗g )−1 . For more detail, please refer to [32, 33]. The proposed approach to the large deflection problems
In [31], it has been proved that, for a given compliance, of spatial flexible rods is a discretization-based methodology.
there is a unique coordinate frame, termed {P}, in which the
Ac
δ δ 2
EIxx 0 0 0 − 2EIxx
0
δ2
0 δ
EIyy 0 2EIyy 0 0
0 δ
0 GIzz 0 0 0
Ci = (7)
δ2 δ3
0 0 0 0
2EIyy 3EIyy
δ2 δ3
− 2EIxx 0 0 0 0
3EIxx
δ
0 0 0 0 0 EA
d
ite
where A represents the area of cross section, Ixx , Iyy , and Izz
are the three principal area moments. While E and G are the
elastic and shear modulus, respectively.
ed
Based on the principal axes decomposition presented in
Sec. 2.1, the principal frame, termed {Pi }, of the element’s
Fig. 2. Mechanism approximation of the segment elements.
py
structural compliance can be specified readily in the middle
of segment, as shown in Fig. 2. Then, (7) can be simplified
to a diagonal matrix with respect to {Pi } as
Particularly, in the case of spatial thin and flexible rods, the
Co
effects of shearing and elongation can be neglected [1, 10],
"
Ai 03
#
Ai = diag( EIδ , EIδ , GIδ ) so that only the three orthogonal revolute joints are required
xx yy zz
Ci = ⇒ (8) for the mechanism approximation of the discretized segment
03 Di D = diag( δ 3 , δ 3 , δ )
ot
i 3EIyy 3EIxx EA elements.
tN
As a result, the decomposed joint twists and compliance 2.3 Force-Deflection Relation of Segments
coefficients of the discretized segment elements can be given Since the segment elements have been modeled as serial
directly as elastic mechanisms, the calculation of deformations can be
rip
, 03 03 , 03
c = δ c = δ
δ
niques in robot kinematics/statics can be employed to charac-
i,1 EIxx i,2 EIyy
c
i,3 = GIzz terize the force-deflection relation of those small segment el-
nu
c = δ3
δ3
δ
ci,5 = 3EI ci,6 = Using the POE formula, the relative pose of {Li+1 } with
i,4 3EIyy xx EA
respect to {Li } can be represented as
From (9), it is known that the pitches of t i, j , j = 1, 2, 3
ed
vanish, so the helical joints in the serial elastic mechanisms gi (θθ i ) = exp(t̂ i,1 θ i,1 ) · · · exp(t̂ i,6 θ i,6 ) g i,0 (10)
degenerate into revolute ones. Moreover, all these revolute
joints pass through the origin of {Pi } and keep parallel to the
pt
corresponding coordinate axes, so do those prismatic joints where t̂ i, j ∈ se(3), j = 1, · · · , 6 denotes the standard represen-
t i, j , j = 4, 5, 6. Further, this property of joint distribution is tation of the joint twists with respect to {L i }. Here, the joint
ce
independent of the segment length. In other words, using the variables θ i = [θ i,1 , · · · , θ i,6 ]T correspond to the deflections
proposed approach, a segment of an arbitrary length can be of the elastic joints. g i,0 = gi (0) represents the initial pose of
{Li+1 } with respect to {L i } in the mechanism’s undeformed
Ac
d
where g 0,0 ∈ SE(3) is the constant pose of {L1 } with respect
to the system’s inertial frame, denoted by {S}.
ite
In (14), the joint twists ti, j are represented in their local
frames {Li }. Using adjoint transformation, they can be uni-
ed
Fig. 3. Hyper-redundant mechanism approximation of flexible rods. formly mapped to {S}. Then, the local POE formula can be
rewritten in the form of global one as
The components of Jacobian, ti,0 j , j = 1, · · · , 6 corresponds
py
N
to the joint twists in the current configuration, which can be
gst (θθ ) = ∏ exp(ξˆ k θ k ) g st,0 (15)
derived as ti,0 j = Hexp(t̂i,1 θi,1 )··· exp(t̂i, j−1 θi, j−1 ) ti, j . Here, H(·) is
Co
k=1
the adjoint operator, defined in (2), associated with the POE:
exp(t̂i,1 θi,1 ) · · · exp(t̂i, j−1 θi, j−1 ) ∈ SE(3).
where θ = [θ1 , · · · , θN ]T ∈ RN×1 denotes the joint variables
As it is known, the static equilibrium configuration can
of the hyper-redundant mechanism. ξ k = Hg0,0 ··· gi−1,0 ti, j are
ot
be achieved once the load-induced reaction torques/forces in
the joint twists represented in {S}, obtained by the identity
the elastic joints are balanced by their deflections, namely
ξˆ k ≡ g0,0 · · · gi−1,0 t̂i, j g−1 −1
i−1,0 · · · g0,0 . g st,0 = g0,0 g1,0 · · · gn,0
tN
relates to the initial pose of {T} with respect to {S}. Here,
τ i = Kθ i θ i − JTi Fi → 0 (12) the subscript ‘k’ is determined by i and j as k = 6(i − 1) + j
i = 1, · · · , n, j = 1, · · · , 6. N = 6n is the total number of joints.
rip
where Fi is the applied wrench with respect to {Li }. And the Comparing (15) to (10), it is known that the hyper-
transpose of Ji corresponds to the force Jacobian which maps redundant mechanism equivalent to the whole rod shares the
the wrench Fi to the joint reactions. Kθ i = diag( c1i,1 , · · · , c1 )
sc
i,6
same form in kinematics as discretized segments. Therefore,
relates to the stiffness of elastic joints. the same approach can be employed for the overall stiffness
By differentiating (12) with respect to θ i , the overall modeling of the whole equivalent mechanism.
nu
joint stiffness matrix of the equivalent elastic mechanism can Analogous to (11), the system’s Jacobian matrix of the
be derived as hyper-redundant elastic mechanism can be represented as
Ma
∂τi 0 0 0
Ki = = Kθ i + KJi + KFi (13) Jθ = ξ 1 , ξ 2 , · · · , ξ N ∈ R6×N (16)
∂θi
ed
0
∂ JT where the components ξ k = Hexp(ξˆ θ ) ··· exp(ξˆ θ ) ξ k are
where KJi = − ∂ θii Fi ∈ R6×6 and KFi = −JTi ∂∂ θFii ∈ R6×6 1 1 k−1 k−1
are two configuration-dependent items [37]. The details of the joint twists in the current configuration and represented
with respect to {S}. Similarly, JTθ is just the force Jacobian
pt
0 0 ··· 0
FT Z 0 ξ 0 0
.. ..
∂ JTθ ξ1 2
. .
KJ = F= (18)
∂θ .. .. ..
. . . 0
0 0
F Zξ 0 ξ N · · · FT Zξ 0
T
ξN 0
1 N−1
d
i
with respect to {S}.
ite
On the other hand, the situation of KF = JTθ ∂∂ θF ∈ RN×N
will be different in terms of various external load conditions.
If a non-following wrench is applied at the tip-frame of the
ed
Fig. 4. Experimental setup for the large deflection problems.
flexible rod, this item will vanish since F is independent of
end configuration, namely ∂∂ θF ≡ 0. Otherwise, it should be
py
taken into account during the determination of mechanism’s a gradient-based searching algorithm is established based
equilibrium configurations. And the concrete situations will on the motion/force transmission property of the equivalent
be discussed in the following sections. hyper-redundant mechanism.
Co
Based on the kinematics/statics presented in this section, In this case, a multi-objective function which combines
two kinds of static equilibrium problems which correspond both the tip-frame pose and the joint reaction forces/torques,
to typical load/constraint conditions of spatial flexible rods, is defined for the iterative searching algorithm as
ot
will be investigated in the rest of this section. The first prob-
lem relates to the condition that a specific external wrench log(g−1
" #
θ ))∨
t g(θ
is exerted at the tip frame of the equivalent hyper-redundant min c(θθ , F) = ∈ R(6n+6)×1 (20)
tN
mechanism. In the second case, on the contrary, the tip frame Kθ θ − JTθ F
of the flexible rod is restricted to some particular geometric
constraints.
rip
In the case of applying an external load, the equilibrium The objective function (20) requires to identify a proper
problem of the flexible rod corresponds to statics analysis of combination of the joint variable θ and external wrench F,
such that the tip frame approaches its target pose, meanwhile,
nu
equilibrium configuration, as Thus, the gradient of the objective function (20) can be
derived as
∇= , = ∈ R(N+6)×(N+6) (21)
∂θ ∂F Kθ + KJ −JTθ
where τ j is the bias of joint deflection forces/torques from
pt
(
approaches zero. And the resultant configuration is simply
δθ
θ j+1 = θ j + δ θ j
−1
the solution to the corresponding equilibrium problem. =∇ c⇒ (22)
δF F j+1 = F j + δ F j
parameters values
radius r = 1.0 mm
length L = 950 mm
elastic modulus E = 56.0 GPa
shear modulus G = 21.5 GPa
second moments of area Ixx = Iyy = 41 π mm4
polar moment of inertia Izz = 12 π mm4
d
Fig. 5. Experimental result of the flexible rod with large deflection.
ite
As shown in Fig. 4, to apply/measure external loads and
ed
geometric constraints to the spatial flexible rod, the experi-
mental setup includes the following parts:
py
1) A spatial flexible rod: a long and thin glass-fiber link is
adopted as the spatial flexible rod, whose specifications
are given in Table 1;
Co
2) A manipulation robot: a KUKA-KR10-R900-sixx robot
is used to apply external loads or geometric constraints
to the tip-frame of the flexible rod. The payload of the
ot
Fig. 6. Accuracy evaluation of the proposed method.
robot is 10 kg and its repeated positioning precision is
±0.03 mm;
tN
3) A force sensor: a six-axis force-torque sensor (the ATI On the other hand, the measured 1 and predicted reaction
Gamma SI-130-10) is mounted between the robot and torques/forces are given by
flexible rod to measure the reaction forces/torques. The
rip
sensing ranges are 130 N for Fx , Fy , 400 N for Fz and 0.085 0.089
−0.002 0.003
10 Nm for Tx , Ty , Tz . While the resolution is 1/40 N for
−0.022 −0.030
Fx , Fy , 1/20 N for Fz and 1/800 Nm for Tx , Ty , Tz .
sc
Fm =
, F p = −0.423
(23)
4) A vision system: a FARO-Edge-ScanArm HD is used −0.472
−0.385 −0.379
to measure the exact deflection of rod in its equilibrium
nu
0.334 0.271
configuration. The measurement accuracy is ±25µm.
where the torque and force units are Nm and N, respectively.
Since both tip-frame pose and external load of the flexi-
Ma
result is also illustrated as a comparison. Based on the above discussion, this section presents an
From the figure, it is known that the result obtained by application of the proposed method to the kinematics/statics
the proposed approximation method is very close to the one analysis of a planar 2-DOF compliant parallel manipulator.
achieved through the physical experiment. The standard 3D As exhibited in Fig. 7, the mechanism constitutes two planar
(RMS) deviation between calculated and measured results is parallelogram linkages consisting of rigid links and flexible
2.271 × 10−4 m with the maximums of −1.737 × 10−3 m and rods, respectively.
1.376 × 10−3 m, respectively, as shown in Fig. 6. It should
be noted that the measurement is given in the form of point
cloud of the rod’s surface, so that this evaluation is based on 1 It
should be noted that the reading of ATI sensor fluctuates even when
the distances of those points to the calculated ones. the flexible rod reaches its equilibrium configuration. Hence, the result in
(23) is a mean value of the sensor reading within a time interval.
ASME JMR-17-1331, Chen 7
" #
e3
ξi = , i = 1, · · · , n (24)
− 1n (i − 21 )l e2 × e3
d
(log(g−1 ∨
t g))
ite
min c(x) = Kθ θ − JTθ F ∈ R(n+7)×1 (25)
fy
ed
Fig. 7. A planar 2-DOF translational compliant mechanism. where x = [ l, θ , F ]T ∈ R(n+7)×1 denotes the variables of the
py
optimization problem, including the effective length l ∈ R,
the joint deflections θ ∈ Rn×1 and external wrench F ∈ R6×1 .
As shown in the figure, the rigid limb is actuated by a gt ∈ SE(3) is the configuration of mid-platform actuated by
Co
revolute joint, such that the mid-platform can translate along the rigid limb. Here, fy = eT5 F corresponds to the component
a circular trajectory. Meanwhile, the length of flexible limb of F in y-direction and e5 = [0, 0, 0, 0, 1, 0]T ∈ R6×1 .
is controlled by a prismatic joint. Thus, the height of end- Since the length of segments, as well as the joint twists,
effector can be actively adjusted to compensate the vertical
ot
changes during the iterative searching process, the influence
motion of rigid limb and deflection of flexible one. Hence, of the rod’s effective length should also be taken into account
this compliant parallel manipulator can perform planar pick-
tN
in the gradient of (25). Then, we have
and-place tasks by controlling the active joints properly.
It is known that one of the key issues for controlling such
Jl Jθ 06
a compliant mechanism is to accurately calculate the large
rip
∂c ∂c ∂c
∇= , , = Kl Kθ + KJ −JTθ (26)
deflection of the flexible limb. In this case, the equilibrium ∂l ∂θ ∂F
problem is slightly different from those in the above section. 0 01×n eT5
sc
in Appendix B.
And this implies that the vertical external force reacted in the
It is worth noting that in planar cases three components
linear guides should be vanished when the flexible limb is in
in both (log(g−1 ∨
t g)) and F are always zeros. Therefore, the
its static equilibrium state.
associated components in the objective function c(x), as well
ed
The difficulty of this equilibrium problem is caused by as the corresponding rows and columns in ∇, are eliminated
the change of effective (deformed) length of the flexible rod. from the optimization model in order to make the searching
To overcome this issue, a variable segment length is adopted
pt
length of flexible limb for a given pose of its tip frame, such
that in the equilibrium configuration the corresponding force
component in vertical direction vanishes. which will be iteratively repeated until the objective function
It should be noted that, in planar cases, only the bending c approaches zero and the variable x converges stably.
effect within the plane is taken into account in the deflection As a result, the effective length of the flexible limb and
of flexible rods. In other words, in each segment, only the the concrete deflection in its equilibrium configuration can
revolute joint perpendicular to the plane is taken into account be simultaneously obtained in terms of the resultant l and θ .
in the proposed approximation method. Meanwhile, the corresponding constraint force reacted in the
As a result, a planar n-R hyper-redundant mechanism is mid-platform can also be identified according to F following
obtained for large deflection calculation of the flexible limb. the proposed update theme.
d
ite
ed
Fig. 8. Verification via the simulation results of FEA model. Fig. 9. Residual errors of the proposed method from FEA model.
py
According to the identified equilibrium configuration of
flexible limb, the kinematics and statics of the studied planar
compliant mechanism can be accomplished. Thus, the exact
Co
position of end-effector and the reaction forces in joints can
be predicted for a given set of actuations. On the other hand,
given a prescribed position for the end-effector, the required
ot
inputs of the mechanism’s active joints can also be achieved
by compensating the change of limb’s effective length.
tN
It is known that the total length of flexible limb does not
influence the configuration of its deflected part, but imposes
a purely vertical displacement to the end-effector. Therefore,
rip
software Abaqus/Standard 6.13 and the simulation results are elements is larger than 50, the maximal position errors will
also drawn in Fig. 8. It should be noted that since the two decrease to less than 4.0 × 10−4 m, which is less than 5.0h
rods in the flexible limb are identical to each other, only one of the end-effector’s vertical movement.
pt
of them is illustrated in the figure. For the sake of clarity, To validate the computational efficiency of the proposed
the rod’s deflected configuration is moved to the middle of approximation approach, the consuming time corresponding
ce
symmetric mechanism. The corresponding trajectory of the to different discretization of the flexible limb is investigated.
mechanism’s end-effector is drawn in Fig. 8, where the FEA The results are drawn in Fig. 10, with the comparison of the
Ac
d
studied planar compliant mechanism, the effective length of ∂
the flexible limb can be estimated accurately and efficiently Hexp(t̂i,1 θi,1 )··· exp(t̂i, j−1 θi, j−1 ) ti, j
ite
∂ θi,k
via the proposed method. Accordingly, the exact vertical po- = Hexp(t̂i,1 θi,1 )··· exp(t̂i,k−1 θi,k−1 ) ∂ −1
∂ θi,k Hexp(t̂i,k θi,k ) Hexp(t̂i,k θi,k )
sition of the mechanism’s end-effector can be predicted pre-
ed
cisely and compensation to the flexible limb deflection can H−1 Hexp(t̂i,1 θi,1 )··· exp(t̂i, j−1 θi, j−1 ) ti, j
exp(t̂ i,1 θi,1 )··· exp(t̂i,k−1 θi,k−1 )
be implemented for prescribed pick-and-place tasks.
= Hexp(t̂i,1 θi,1 )··· exp(t̂i,k−1 θi,k−1 ) Zti,k H−1 t0i, j
py
exp(t̂ i,1 θi,1 )··· exp(t̂i,k−1 θi,k−1 )
= Zt0 t0i, j
i,k
(29)
Co
6 Conclusions −1
where ∂
∂ θi,k Hexp(t̂i,k θi,k ) Hexp(t̂i,k θi,k ) = Zti,k ∈ R6×6 corresponds
In this paper, a general discretization-based approach is
proposed for the large deflection problems of spatial flexible to the adjoint representation of joint twist t̂i,k , which satisfies
the following identity [33] as
ot
rods in compliant mechanisms. Based on the principal axes
decomposition of compliance matrices, a specialized type of
tN
elements is established to approximate the force-deflection "
ω
# "
ω
ω̂ 03
#
relation of small segments with 6-DOF elastic mechanisms. ξ= ⇒ Zξ = ⇒ Hg Zξ H−1
g ≡ ZHg ξ ≡ Zξ 0
Using the proposed approach, the large deflection problems v v̂ ω
ω̂
rip
iments carried out on a particularly constructed apparatus. In According to (29), it is known that the entries vanish in
the end, a planar 2-DOF compliant mechanism is designed as the case of k ≥ j. Thus, the stiffness item KJi in (13) can be
a potential application of the established solving algorithm. obtained readily as
Ma
. .
. 0
T 0 0
Acknowledgements Fi Zt ti,1 ··· FTi Zt0 t0i,5 0
ce
i,6 i,6
and the National Basic Research Program of China (973 Pro- On the other hand, the item KFi is caused by the change
gram) under Grant 2014CB046600. of external loads due to the deviations of joint variables. So
it replies on the loading conditions. If the applied wrench is
independent of the mechanism configuration, this item yields
to zero, namely ∂∂ θFii = 0.
APPENDIX A Derivative of Configuration-Dependent Here, a specific case that Fi keeps constant in the distal
Stiffness Items frame {Li+1 } is provided as an example. Let Fi = H∗gi Fi,0 ,
The first item KJi represents the effects of small changes where Fi,0 denotes a constant wrench in {Li+1 } and H∗gi is
in force transmission due to the deviations of joint variables. the co-adjoint operator between {Li+1 } and {Li }. Then, this
d
form in terms of the current values of variables. Then, the
∂ H∗gi ∂ H−T
T
ite
gi ∂ Hgi −1
(H∗gi )−1 = HTgi =− H = −ZTt0 equilibrium configuration can be identified by repeating the
∂ θi,k ∂ θi,k ∂ θi,k gi i,k
update them (27) until it converges.
ed
which relates to the inverse transpose of the adjoint represen-
tation of t0i,k . References
py
[1] Howell, L., 2001. Compliant Mechanisms. John Wiley
& Sons, New York, NY.
[2] Saxena, R., and Saxena, A., 2009. “Design of elec-
Co
APPENDIX B Derivation of Jacobian and Stiffness due
to the Change of Rod Length trothermally compliant mems with hexagonal cells us-
The item Jl represents the linear approximation between ing local temperature and stress constraints”. ASME
the deviation of tip frame and the small change of rod length. Journal of Mechanical Design, 131(5), p. 051006.
ot
Using the POE-based error model of serial robots [36], it can [3] Asbeck, A., and Cutkosky, M., 2012. “Designing com-
be represented as pliant spine mechanisms for climbing”. ASME Journal
tN
of Mechanisms and Robotics, 4(3), p. 031007.
[4] Edelmann, J., Petruska, A., and Nelson, B., 2017.
(∂ gst g−1
st )
∨ n+1
∂ξ “Magnetic control of continuum devices”. The Interna-
Jl = = ∑ Hexp(ξˆ θ )··· exp(ξˆ θ ) Ai i (32)
rip
∂l i=1
1 1 i−1 i−1 ∂l tional Journal of Robotics Research, 36(1), pp. 68–85.
[5] Marras, A., Zhou, L., Su, H., and Castro, C., 2015.
“Programmable motion of DNA origami mechanisms”.
sc
where ξˆ n+1 = log(g0 ) denotes the twist associated with the Proceedings of the National Academy of Sciences,
initial pose of tip frame. Ai ∈ R6×6 is a polynomial matrix 112(3), pp. 713–718.
of the joint twist Zξ i , given by [6] Midha, A., Norton, T., and Howell, L., 1994. “On the
nu
with the coefficients [8] Frisch-Fay, R., 1962. Flexible bars. Butterworths,
ai,1 = θi Washington D.C.
ai,2 = 12 (4 − θi sin θi − 4 cos θi ) [9] Kimball, C., and Tsai, L., 2002. “Modeling of flexural
pt
ai,4 = 21 (2 − θi sin θi − 2 cos θi ) [10] Zhang, A., and Chen, G., 2013. “A comprehensive el-
liptic integral solution to the large deflection problems
ai,5 = 12 (2θi − 3 sin θi + θi cos θi )
Ac
d
[16] Jensen, B., and Howell, L., 2004. “Identification [31] Chen, G., Wang, H., Lin, Z., and Lai, X., 2015. “The
of compliant pseudo-rigid-body four-link mechanism principal axes decomposition of spatial stiffness matri-
ite
configurations resulting in bistable behavior”. ASME ces”. IEEE Transactions on Robotics, 31(1), pp. 191–
Journal of Mechanical Design, 125(4), pp. 701–708. 207.
ed
[17] Midha, A., Bapat, S., Mavanthoor, A., and Chinta, V., [32] Murray, R. M., Sastry, S. S., and Li, Z. X., 1994. A
2012. “Analysis of a fixed-guided compliant beam with Mathematical Introduction to Robotic Manipulation.
an inflection point using the pseudo-rigid-body model CRC Press, Inc.
py
(PRBM) concept”. ASME Journal of Mechanisms and [33] Selig, J. M., 2005. Geometric Fundamentals of
Robotics(45035), pp. 351–361. Robotics. Springer, New York.
[18] Vogtmann, D., Gupta, S., and Bergbreiter, S., 2013. [34] Archer, R., and Lardner, T., 1978. An Introduction to
Co
“Characterization and modeling of elastomeric joints the Mechanics of Solids. McGraw-Hill series in engi-
in miniature compliant mechanisms”. ASME Journal neering sciences. McGraw-Hill.
of Mechanisms and Robotics, 5(4), p. 041017. [35] Chen, I., Yang, G., Tan, C., and Yeo, S., 2001. “Local
ot
[19] Zhou, L., Marras, A., Castro, C., and Su, H., 2016. POE model for robot kinematic calibration”. Mecha-
“Pseudo rigid-body models of compliant DNA origami nism and Machine Theory, 36(11-12), pp. 1215–1239.
tN
mechanisms”. ASME Journal of Mechanisms and [36] Chen, G., Wang, H., and Lin, Z., 2014. “Determination
Robotics, 8(5), p. 051013. of the identifiable parameters in robot calibration based
[20] Saxena, A., and Ananthasuresh, G., 2001. “Topology on the POE formula”. IEEE Transactions on Robotics,
rip
[21] Her, I., 1986. “Methodology for compliant mechanisms tions on Robotics and Automation, 5(2), pp. 151–165.
design”. Ph.d. thesis, Purdue University. [38] Dai, J., 2014. Screw Algebra and Lie Groups and Lie
[22] Campanile, L., and Hasse, A., 2008. “A simple and Algebra. Higher Education Press, Beijing.
nu
2516.
[23] Pauly, J., and Midha, A., 2006. “Pseudo-rigid-body
model chain algorithm: Part 1 - introduction and con-
cept development”. In International Design Engineer-
ed
d
ite
ed
py
Co
ot
tN
rip
sc
nu
Ma
ed
pt
ce
Ac
d
ite
ed
py
Co
ot
tN
rip
sc
nu
Ma
ed
pt
ce
Ac
d
ite
ed
py
Co
Table 1. Specifications of the tested spatial flexible rod.
ot
parameters values
tN
radius r = 1.0 mm
length L = 950 mm
rip