Escolar Documentos
Profissional Documentos
Cultura Documentos
Driven Robot
Xavier Aguas, Marco Herrera, Oscar Camacho and Paulo Leica
Departamento de Automatización y Control Industrial
Escuela Politécnica Nacional, Ecuador, Quito
Email: {xavier.aguas, marco.herrera, oscar.camacho, paulo.leica}@epn.edu.ec
Abstract—Cable Direct Driven Robots (CDDRs) are struc- disturbances or as in [9] presents experimental performance of
turally similar to parallel robots but these are formed by robust PID using cables as an alternative to be used for very
replacing all the supporting rigid legs with cables, where the large workspace applications to different desired trajectories.
motion of the end-effector is controlled through cables which are
pulled from actuators placed off-board the robot. CDDRs control Trajectory planning can be executed by considering only
is a challenge due to the physical characteristics of cables because kinematic and geometric constraints. However, for CDDRs,
these can only apply tensile forces and no compression. The aim dynamic constraints must also be considered in most cases,
of this paper is to present a Sliding Mode Control (SMC) for a due to the unilateral tension property of cables which can
Planar 4-Cable Direct Driven Robot, SMC is designed in order exert only unidirectional forces on the payload [10]. The
to obtain fast system response and the robustness against the
model uncertainty. For the purpose of validating the proposed principal difficulty in control is keeping positive tensions in
controller the trajectory tracking test and model uncertainty test cables while the loads move, for this reason the Sliding Mode
were performed. Simulation was carried out for the proposed Controllers (SMC) have been designed to obtain fast system
controller and the results were compared with a PD Controller response for cable suspended loads [11]. In the process design
in terms of Integral Square Error (ISE) index. of CDDRs the most important stage is the simulation phase.
Index Terms—Cable Direct Driven Robots, Sliding Mode
Control, parallel manipulator, robustness, Tracking Trajectory Simulators permit us to quickly test a new conception and
observe how this implementation fits our design wherein the
highly flexible nature of the cables is extremely challenging
I. I NTRODUCTION
to simulate [12]. In this paper the Planar 4-Cable CDDR
In recent years, Cable Direct Driven Robots (CDDRs) have model [13] is considered since no rotational move and no
made huge advances into many industrial sectors [1] because moment resistance are required at the end-effector. All 4 cables
these robots are easy to install and well adapted to their convene in a single point and the end-effector is modelled
operating environment [2]. CDDRs are good candidates for as a point mass. In order to obtain fast system response
performing a broad range of applications such as pick-and- and the robustness against the model uncertainty and external
place, cleanup of disaster areas, large radiotelescope, high disturbances a SMC is designed, wherein the control actions
speed manipulation, sandblasting, suspended actuated cameras are torques to the motors and not forces on end-effector as
for sport events and coconut farms [3]. CDDRs are a type in other researches. This approach provides faster tracking
of parallel robot, wherein cables are used as its links [4], capacity than the classical PD Controller as is showed in [14].
while the cables length is changing, the end-effctor is forced For the design of the proposed controller, end-effector and
toward the desired position and orientation. CDDRs possess motor dynamics of the system was modelled and integrated.
some useful characteristics such as large workspace capability, With the full system model, effects of motor parameters
transportability, economical structure and maintenance than can be considered to improve control. The performance of
conventional parallel robots, these advantages are presented this controller is compared with a PD Controller in several
in [5]. However, substituting rigid links by cables presents parameter variations test in terms of integral square error
new defiances in the study of cable driven robots which are (ISE) index and a simulator was developed for this research
distinct to conventional robots because the cables can only to observe the behavior of the cables during its trajectory. The
apply tensile forces and no compression [6]. The majority simulation results show the ability the proposed control law in
CDDRs are designed with actuation redundancy, i.e. more comparison with the classic control. The organization of this
cables than degrees of freedom in try to avert configurations paper is as follows: Section (II) describes the dynamics model
where certain wrenches require an impossible pushing force of Planar 4-Cable CDDR. Section (III), control strategies are
in one or more cables [7]. Control for CDDRs have catched presented. Section (IV) provides the simulation results. Finally,
the attention of many investigators since its high effect on the conclusions are presented.
the performance of the robotic systems and different control
methods have been proposed for these robots as in [8] shows II. DYNAMICS M ODEL OF A P LANAR 4-C ABLE CDDR
the efficiency of the adaptive passivity-based controller when This section shows a dynamics model of a Planar 4-Cable
there is no enough knowing about system parameters and CDDR for enhanced control [9]. The dynamics model refers
to relationship between the translational motion of the end- TABLE I
effector and the required active torques [13]. The Planar 4- D ESCRIPTION OF P LANAR 4-C ABLE CDDR PARAMETERS
Cable CDDR considered is shown in Fig. 1. The mass of
Parameter Description
cables is very small compared to the end-effector and it can
Ai Motor position
therefore be neglected.
θi Cable angle
Ri Pulley radio
βi R = −∆Li (4)
ti
Ai i
q
2 2
where Li = (x − Aix ) + (y − Aiy ) is the length for cable
q
Ri i and L0i = Aix 2 + Aiy 2 is the initial length for cable i.
The βi can be written as:
ci i q
2 2
i i 1
L01 − (x − A1x ) + (y − A1y )
βi (X) = ..
(5)
R q .
Ji 2
L04 − (x − A4x ) + (y − A4y )
2
RT = τ − J Ẋ − J Ẍ − C Ẋ (10) +
dt ∂X ∂X ∂X
By grouping (10) in terms of Ẋ and Ẍ: d
dt Kd
d ∂β ∂β ∂β
RT = τ − J +C Ẋ − J Ẍ
dt ∂X ∂X ∂X
(11) Fig. 3. PD controller scheme.
With the statics relationship ST = FR given in [13], T can
be represented in the form: The tracking error vector is defined as follows:
+
T = S FR (12)
e(t) = Xd (t) − X(t) (16)
T −1
where S + = S T (SS ) is the right pseudoinverse of statics
jacobian matrix. Replacing (1) in (12), T is written as: where Xd (t) is the desired position vector and X(t) is the
end-effector position vector. PD controller has the following
T = S + M Ẍ (13) form:
By combining (13) and (11), the equation of motion can be de(t)
expressed as: P D(t) = Kp e(t) + Kd (17)
dt
Applying this controller to dynamics model of Planar 4-Cable
∂β
d ∂β
∂β
CDDR and in order to have a input as torques vector τ
S + RM + J Ẍ+ J +C Ẋ = τ is necessary multiply by S + because the controller directly
∂X dt ∂X ∂X
(14) applies a virtual force as control actions on end-effector.
The equation of motion can be written alternatively in the de(t)
following general form: uP D (t) = τ = S + (K p e(t) + Kd ) (18)
dt
where Kp and Kd are tuning parameters.
Meq (X)Ẍ + N (X, Ẋ)Ẋ = τ (15)
∂β B. Sliding Mode Controller
In this equation, Meq (X) = S + RM + J ∂X
In this subsection, a sliding mode controller for Planar 4-
d ∂β ∂β
and N (X, Ẋ) = J dt ∂X + C ∂X where Meq (X) is Cable CDDR based on the analysis dynamic of the robot in
section II. The scheme of this controller is illustrated in Fig. 4.
the inertial matrix and N (X, Ẋ) is the matrix of Coriolis.
The parameters considered of Planar 4-Cables CDDR in this X d (t ) X (t )
research are presented in Table II.
e(t )
+ 0 SMC
Plant
- u (t) u (t) c d
0.2
λ0 0.1
uc (t) = Meq (X)Ẍd + Meq (X)ė(t) + N (X, Ẋ)Ẋ (25)
axis Y
λ1 0
defined: -0.2
-0.3
1 T
V = σ(t) σ(t) > 0 (26) -0.4
2 -0.5
-0.5 -0.4 -0.3 -0.2 -0.1 0 0.1 0.2 0.3 0.4 0.5
The derivative of the function V must be negative-definite: axis X
the trajectory. Fig. 6 shows the trajectory reference and real Reference
PD
0.05
Square Trajectory
0.2
axis y [m]
Reference
PD 0
0.15
SMC
0.1 -0.05
0.05
axis y [m]
-0.1
0
-0.15
-0.05 -0.15 -0.1 -0.05 0 0.05 0.1 0.15
axis x [m]
-0.1
-0.2
-0.2 -0.15 -0.1 -0.05 0 0.05 0.1 0.15 0.2 Circular Trajectory
axis x [m]
Reference
0 PD
SMC
Fig. 6. XY graph, square trajectory.
-0.05
Tracking performance is shown in Fig. 7. From this graph,
axis y [m]
one can notice that PD controller has degraded tracking
performance in the X direction.
-0.1
Square Trajectory
-0.1 Reference
PD -0.15
SMC
-0.02 -0.01 0 0.01 0.02 0.03 0.04 0.05 0.06 0.07 0.08
-0.11 axis x [m]
-0.13
Table IV shows ISE index in mass variation test when
-0.14 mp = 0.15m. PD controller presents oscillations on reaching
the trajectory while the proposed SMC reaches faster the
-0.15
reference and without oscillation problems.
0.146 0.147 0.148 0.149 0.15 0.151 0.152 0.153 0.154
axis x [m] TABLE IV
ISE M ASS VARIATION T EST
Fig. 7. XY graph, corner of square trajectory.
Position PD SMC ∆%
X 0.00136 5.491e-7 199.8386
Table III shows ISE index in traking trajectory test. The Y 0.00925 0.003289 95.079
result shows which PD controller has a constant error in steady
state.
C. Rotational Inertial Variation Test
TABLE III The Planar 4-Cable CDDR model is simulated using the
ISE S QUARE T RAJECTORY T EST.
following parameters: The rotational inertia is changed in
Position PD SMC ∆% motor 1 and 4 (J1 = 25J and J4 = 25J). Fig. 10 and
X 0.004063 0.003291 20.995 Fig. 11 llustrate dynamic behavior with the proposed control
Y 0.004158 0.003291 23.278
algorithm.
The result shows which the proposed SMC again has an
advantage over the conventional PD Controller. The position
B. Mass Variation Test outputs track the desired values pretty good and the steady
In this test, the end-effector mass is changed mp = 0.15m, state errors are very small. In the Table V presents the
where mp is the test mass and m is the end-effector mass. comparison between both controllers.
0.2
Circular Trajectory ment of the project PIJ-15-17 ”Development and construction
Reference of a PID-robust prototype based on advanced control tech-
0.15 PD
SMC niques to improve the robustness of industrial processes”
0.1
R EFERENCES
0.05
[1] H. Bayani, M. T. Masouleh, and A. Kalhor, “An experimental study on
axis y [m]
-0.08
Intelligent and Robotic Systems, vol. 46, pp. 73–94, 2006.
-0.1
[8] M. Zarebidoki, A. Lotfavar, and H. R. Fahham, “Effectiveness of
-0.12 adaptive passivity-based trajectory tracking control of a cable-suspended
-0.14 robot,” 2012.
[9] M. A. Khosravi and H. D. Taghirad, “Robust pid control of fully-
-0.16
constrained cable driven parallel robots,” Mechatronics, vol. 24, no. 2,
-0.18 pp. 87–97, 2014.
-0.08 -0.06 -0.04 -0.02 0 0.02 0.04 0.06 0.08
[10] X. Jiang, E. Barnett, and C. Gosselin, “Periodic trajectory planning
axis x [m] beyond the static workspace for 6-dof cable-suspended parallel robots,”
IEEE Transactions on Robotics, pp. 1–13, 2018.
Fig. 11. X Y graph, beginning of the circular trajectory J1 = 25J and [11] A. Nowacka-Leverton and A. Bartoszewicz, “Itae optimal sliding mode
J4 = 25J. control of cable suspended loads,” in Control Applications,(CCA) &
Intelligent Control,(ISIC), 2009 IEEE. IEEE, 2009, pp. 1511–1516.
[12] M. Michelin, C. Baradat, D. Q. Nguyen, and M. Gouttefarde, “Simula-
tion and control with xde and matlab/simulink of a cable-driven parallel
TABLE V robot (cogiro),” in Cable-Driven Parallel Robots. Springer, 2015, pp.
ISE ROTATIONAL I NERTIAL VARIATION T EST 71–83.
[13] R. L. Williams Ii and P. Gallina, “Translational planar cable-direct-driven
Position PD SMC ∆%
robots,” Journal of Intelligent and Robotic systems, vol. 37, no. 1, pp.
X 0.00631 5.491e-07 199.965
69–96, 2003.
Y 0.00845 0.00328 88.15
[14] A. Zaatri and B. Bouchemal, “Sliding mode versus pd control for cable-
based robots,” World Journal of Engineering, vol. 11, no. 3, pp. 287–296,
2014.
[15] J. Villacres, M. Herrera, N. Sotomayor, and O. Camacho, “A fuzzy
C ONCLUSION sliding mode controller from a reduced order model: A mobile robot
experimental application,” in Control, Decision and Information Tech-
In this paper a sliding mode control using a PD controller nologies (CoDIT), 2017 4th International Conference on. IEEE, 2017,
pp. 0674–0678.
as sliding surface for the end-effector position control of [16] F. L. Lewis, D. M. Dawson, and C. T. Abdallah, Robot manipulator
Planar 4-Cable CDDR is developed. In order to show the control: theory and practice. CRC Press, 2003.
effectiveness of this controller several tests are performed
for circular and square trajectories. The simulation results
indicate that controller proposed presents robustness against
the model uncertainty when some parameters of robot model
were changed. The results of SMC controller for square
trajectory test, rotational inertial test and mass variation test
present lower ISE index than PD controller. In brief, SMC
shows the robustness to the parameter uncertainties.
ACKNOWLEDGMENT
The authors gratefully acknowledge the financial support
provided by the Escuela Politécnica Nacional, for the develop-