Professional Documents
Culture Documents
CableCon2019 - Development of Emergency Strategies For Cable-Driven Parallel Robots After A Cable Break
CableCon2019 - Development of Emergency Strategies For Cable-Driven Parallel Robots After A Cable Break
CableCon2019 - Development of Emergency Strategies For Cable-Driven Parallel Robots After A Cable Break
1 Introduction
Cable-driven parallel robots are currently making their way into application.
This covers multiple fields and industrial branches, including large-scale 3D
printing [1], warehousing and other applications [2]. As this typically includes
high end effector masses, from a safety perspective, system failures have to be
investigated to avoid damage to the robot, the payload, the environment and
especially humans. Intuitively, one of the most expected failures for cable robots
is a failure of a cable due to cable break. On the other hand, for the construction
of machines employing cables, extensive compilations of guidelines and norms
exist which ensure a durable and reliable operation of cable-driven systems. Still,
and especially under prototyping conditions, the failure of mechanical compo-
nents, sensors, motors and control algorithms may be an issue that leads to
loss of cable tension or a breaking cable, respectively. Clearly, this is a sudden
change in the dynamics of the system and there is the immediate danger of an
end effector crash, which includes the platform and the payload. On the other
hand, cable robots typically use a large number of cables which opens the po-
tential to recover and to safely guide the platform into a safe position with the
remaining cables. This issue has already been adressed in some publications, e.g.
in [3, 4]. Both publications focus mainly on defining dynamic trajectories back
into the post-failure workspace. This work instead proposes two new strategies
to recover the payload, in which the trajectory does not need to be pre-defined.
At first a brief introduction about cable-robots is given, afterwards the basics
of a kinematic and dynamic robot model are explained. This is followed by a
short discussion about the problems to be faced after a cable breakage at the
system and why it is important to develop special strategies for guidance of
the robot platform afterwards. Two strategies are introduced, which consist of
known methods, combined in new ways. A simulation model for evaluation is set
up and analyzed regarding its workspace before and after a cable failure. Both
strategies are tested using the model. In the end a conclusion and outlook for
future work is given.
mP , I
P
6
-
P
pi
fi τE
B
fE RP , Φ
B
rP
B
li
B
bi
6
B
-
The robot model equations and notation used here base on [2]. The robot is
defined by the inertial coordinate-system 6 B and the fixed coordinate-system
-
on the platform 6 P
- , using a number of m cables and n degrees-of-freedom. The
redundancy of the platform is given by r = m − n. The posture of the platform
T T
in coordinates of the inertial frame is B xP = [B r T P Φ ] , which contains the
B
position vector r P and the orientation Φ of the end effector. The orientation
with respect to the inertial coordinate-system is described by the rotation matrix
B
RP in the means of roll-pitch-yaw angles. Assuming a point-shaped guidance
of the cable, the modeling of pulleys is neglected in the following. The cable
vectors B li as shown in figure 1, can be obtained by
B
l i = B bi − (B r P + B R P P pi ), 1 ≤ i ≤ m. (1)
B
p Bi
Development of Emergency Strategies for Cable-Driven… 271
Given the cable vectors, the length of each cable and hence the joint coordinates
can be determined as
qi = B li 2 , 1 ≤ i ≤ m. (2)
The cable force vector f ∈ Rm×1 contains all tensions fi where each fi is mea-
sured along cable direction ν i . The direction of the ith cable force f i is obtained
from inverse kinematics by
li
f i = fi · = fi · ν i , 1 ≤ i ≤ m. (3)
li 2
Based on the force equilibrium, the force and torque acting on the end effector
wp and a structure matrix AT can be obtained as
⎡ ⎤
f1
f ν1 . . . νm ⎢ .. ⎥ T
wp = p = ⎣ . ⎦ = A f. (4)
τp p 1 × ν 1 . . . pm × ν m
fm
The vectors ẋp and ẍp are the first and second time derivative of the end effector
pose, respectively. The matrix H and its time derivative can be obtained from
the kinematic Kardan equations [5]. M p is the mass matrix of the platform,
dependent on the mass of the platform mp and the inertia tensor I. E is a
3 × 3 identity matrix. Note that the inertia tensor needs to be expressed in
the inertial system 6 B and depends on the orientation of the platform. The
-
Coriolis and centrifugal forces and torques are described by the cartesian space
vector wC while vector wE contains the acting external forces and torques. To
avoid cable sagging on one hand and to limit the maximum motor torque on
the other hand, the cable forces are limited by a minimum force vector f min
and a maximum force vector f max . Solving Eq. 5 with respect to the cable force
limits is a known problem in the field of cable-robotics. Approaches include e.g.
calculating the forces as an optimization-problem [6] or applying the barycentric
method [7].
Now assume the case of a cable break. Typically, the robot is suddenly located
outside the post-failure workspace of its remaining set of cables. Thus, a solution
of Eq. 5 cannot be found in that case and the given methods fail to operate. A
method to deal with this circumstance is proposed in [8]: The constraints of
minimum and maximum cable forces cannot be changed, therefore Eq. 5 needs
to be relaxed. Hence a so called slack variable s is added to the equation. In [8], a
272 R. Boumann and T. Bruckmann
way to solve the resulting problem via quadratic programming is also proposed.
The implementation takes the form
minimize )T D 2 (f − f
sT D 1 s + (f − f )
with AT f + w + s = 0 (6)
f min ≤ f ≤ f max .
3 Development of emergency-strategies
The occurrence of a cable breakage can have fatal consequences towards loss of
payload, machine damage or harm to humans and the environment, caused by
an uncontrolled movement of the robot. As the control system often depends on
model-based control [9], it cannot react to the changed system condition. For
simplicity, assume the break of one cable. Afterwards, a cable robot structure
with m − 1 cables still exists. The structure matrix of the remaining system is
reduced by the column of the broken cable AT∗ ∈ Rn×m−1 . The remaining cable
force distribution is f ∗ ∈ R(m−1)×1 . Note, the following considerations might
also work for the failure of multiple cables as long as a single cable remains.
Accordingly, the control system can still influence the platform motion and thus
stop the motion in a controlled manner, but has to deal with the fact that the
platform may be outside the workspace of the remaining cable robot. Thus, two
strategies are presented in the following.
J and K are 3 × 3 identity matrices. The input vector consists of the vector of
the remaining cable forces
u(k) = f ∗ (k). (13)
The nonlinear system function f x(k), u(k) returns the state vector in the next
time step x(k+1) under consideration of Eq. 5 and a numerical integration based
on the Euler-Cromer method:
ṙ p (k + 1) ṙ p (k) T∗ ∗
= + M −1 p A f + w E − w C (k)Δtc (14)
Φ̇(k + 1) Φ̇(k)
r p (k + 1) r (k) ṙ p (k + 1)
= p + Δtc . (15)
Φ(k + 1) Φ(k) Φ̇(k + 1)
The prediction step size is Δtc . The quality function over prediction horizon np
and control horizon nc can be formulated as
np
T
J= y(k + i) − y r (k + i) Q y(k + i) − y r (k + i) + . . .
i=1
nc
T ∗
f ∗ (k + i − 1) − f ∗ (k + i − 2) r f (k + i − 1) − f ∗ (k + i − 2) .
i=i
(16)
This quality function is minimized every time step under consideration of the
cable force limits, to determine the set-point cable forces f ∗ . If the reference
output y r is chosen as zero, the function holds the minimum value when the
robot comes to a full stop and the cable forces remain at a constant value. The
parameters Q and r can be used to weight the optimization problem.
274 R. Boumann and T. Bruckmann
Repulsive fields While the repulsive fields should avoid collision between the
end effector and obstacles, they should not influence the platform when its far
enough away. Thus, a field is chosen which equals zero at a certain distance from
the obstacle ρ0 and rises to infinity in direction of the obstacle boundary. In case
of ρ(r p ) ≤ ρ0 , the potential of such field yields
2
1 1 1
U rep (r p ) = η − . (20)
2 ρ(r p ) ρ0
Development of Emergency Strategies for Cable-Driven… 275
Herein, ρ(r p ) is the shortest distance between the end effector-position r p and the
nearest boundary of an obstructive object and η is a scalar amplification of the
field. If the object boundary consists of a single convex region, the corresponding
repulsive force is given by the negative gradient of the repulsive field:
⎧
⎪
⎨η 1
−
1 1
∇ρ(r p ) : ρ(r p ) ≤ ρ0
F rep (r p ) = −∇U rep (r p ) = ρ(r p ) ρ0 ρ2 (r p )
⎪
⎩
0 : ρ(r p ) > ρ0 .
(21)
The gradient of the distance to the nearest obstacle is given by
rp − b
∇ρ(r p ) = , (22)
r p − b
where b is the point on the obstacle boundary closest to the actual platform-
position. The virtual force acting onto the end effector, caused by all attracting
and repelling fields and based on the current position, is included in wE with
reverse sign.
Parameter Value
0011
Position of pulleys B= m
0110
1 1
0.8 0.8
y-axis [m]
y-axis [m]
0.6 0.6
0.4 0.4
0.2 0.2
0 0
0 0.2 0.4 0.6 0.8 1 0 0.2 0.4 0.6 0.8 1
x-axis [m] x-axis [m]
(a) Workspace of simulation model (b) Failure of upper cable
Fig. 2. Static workspace before and after cable failure, black dots indicate the winch
positions
Especially for cable robots the wrench-feasible workspace is of interest as the set
of all postures that can be reached under a certain wrench with respect to Eq. 5
and the cable force limits [9]. Neglecting dynamic effects, the static equilibrium
workspace can be obtained. Using a point grid and solving Eq. 5 for each point,
an approximation of the workspace is generated. Fig. 2 compares the workspace
before and after a break of one upper cable. It can be observed that the static
workspace after a cable failure is nearly halved. This also occurs for the break of
a lower cable. Thus the probability is high, that the robot is no longer inside the
workspace after the cable break. Now the robot must be guided into a position
inside of the remaining workspace to stop the motion and to prevent the end
effector from hitting the ground or the robot frame. This calls out for emergency
strategies as they are introduced in Sec. 3.
Parameter Value
T
Start position platform xstart = 0.1 0.9 m
T
Start velocity platform ẋstart = 0 0 m/s
Control and prediction horizon np = n c = 1
0.7 0
Weighting Paramters for prediction Q= , r = 2.5e − 5
0 1
0
5
ẋ
ẏ
0
-5
150 f1
100 f3
50 f4
0
0 0.2 0.4 0.6
time [s]
frame. Two repelling fields are defined to avoid collisions with the ground and
the frame opposite to the broken cable. The floor and frame wall are defined
as repulsive objects, causing the forces F rep,B (r p ) and F rep,W (r p ), respectively.
The influence distances of both repulsive fields are chosen such that they just
reach the goal position.Thus the platform is pushed back during overshooting
the goal position on the one hand, and on the other hand the target point itself
is free from virtual forces. In order to further improve the deceleration of the
end effector, a virtual damping based on the current end effector velocity can
be implemented, which overcomes the virtual forces of the potential fields with
increasing velocity and thus limits the total virtual force. The resulting virtual
damping force as a proportional function of the damping constant DP is F DP .
The wrench including all virtual and external forces results in
w(r p , ṙ p )E = F E − F att (r p ) + F rep,B (r p ) + F rep,W (r p ) + F DP (ṙ p ) . (23)
Since the demanded virtual force may not be producible by the cables, an ap-
proximate solution is used as explained in Eq. 6. The desired tension f̃ is chosen
as the mean force in between the force limits. The weighting matrices are chosen
as shown in Tab. 2. The optimization problem is also solved using an interior-
point algorithm and the results are shown in Fig. 4. It can be seen that the
end effector is pulled into the goal after about 0.2s, but since a speed of about
6m/s per axis is built up, it cannot be decelerated enough and thus overshoots.
The position and speed curve show that the end effector is successfully pushed
away from the floor and the wall. It circles around the goal and roughly reaches
there after 0.5s. After about 1s, the cable forces have settled and the robot is
completely stopped. Cable force limits are reached but not exceeded by the al-
gorithm. The desired platform motion can be adjusted by choosing a different
set of parameters, which is also important for usage with different starting po-
Development of Emergency Strategies for Cable-Driven… 279
-10
150 f1
100 f3
50 f4
0
0 0.5 1
time [s]
Acknowledgment
This research received funding from the EFRE.NRW (2014-2020) Joint Research
Funding Programme of the European Union (EFRE) and the Ministry of Econ-
omy, Energy, Industry, and Handicrafts of the German Federal State of North
Rhine-Westphalia (NRW) under grant agreement EFRE-0800365 (ML-1-1-019B,
LEAN).
References
1. Izard, J.B., Dubor, A., Herve, P.E., Cabay, E., Culla, D., Rodriguez, M., Barrado,
M.: Large-scale 3D printing with cable-driven parallel robots. Construction Robotics
1, pp. 69-76 (2017)
2. Bruckmann, T., Lalo, W., Sturm, C.: Application Examples of Wire Robots. In:
Multibody System Dynamics, Robotics and Control. Springer, Vienna (2013)
3. Berti, A., Gouttefarde, M., Carricato M.: Dynamic recovery of cable-suspended
parallel robots after a cable failure. In: Lennarčič J., Merlet JP.(eds) Advances in
Robot Kinematics. Springer, Cham (2016)
4. Passarini, C., Zanotto, D., Boschetti, G.: Dynamic trajectory planning for failure
recovery in cable-suspended camera systems. J. Mechanisms and Robotics 11(2),
(2018)
5. Hiller, M.: Mechanische Systeme: Eine Einführung in die analytische Mechanik und
Systemdynamik. Springer, Heidelberg (1983)
6. Bruckmann, T., Pott, A., Hiller, M.: Calculating force distributions for redundantly
actuated tendon-based Stewart platforms. In: Lennarčič J., Roth B.(eds) Advances
in Robot Kinematics. Springer, Dordrecht (2006)
7. Mikelsons, L., Bruckmann, T., Hiller, M., Schramm, D.: A real-time capable force
calculation algorithm for redundant tendon-based parallel manipulators. In: IEEE
International Conference on Robotics and Automation, pp. 3869-3874. Pasadena,
CA (2008)
8. Côté, A.F., Cardou, P., Gosselin, C.: A tension distribution algorithm for cable-
driven parallel robots operating beyond their wrench-feasible workspace. In: 16th
International Conference on Control, Automation and Systems (ICCAS), pp. 68-73.
Gyeongju (2016)
9. Pott, A.: Cable-driven Parallel Robots: Theory and Application. Springer Tracts in
Advanced Robotics, (2018). - ISBN 978-3-319-76137-4
10. Grüne, L., Pannek, J.: Nonlinear Model Predictive Control: Theory and Algo-
rithms. Springer, London (2011). – ISBN 9780857295019
11. Vivas, A., Poignet, P.: Predictive functional control of a parallel robot. In: Control
Engineering Practice 13(7), pp. 863-874 (2005)
12. Zi, B., Lin, J., Qian, S.: Localization, obstacle avoidance planning and control
of a cooperative cable parallel robot for multiple mobile cranes. In: Robotics and
Computer-Integrated Manufacturing 34, pp. 105-123 (2015)
13. Spong, M.W., Hutchinson, S., Vidyasagar, M.: Robot Modeling and Control. Wiley,
(2005). – ISBN 9780471649908