You are on page 1of 7

See discussions, stats, and author profiles for this publication at: https://www.researchgate.

net/publication/327602189

Design and Control of a Suspended Cable-Driven Parallel Robot with Four


Cables

Conference Paper · September 2018


DOI: 10.1109/ICRoM.2018.8657534

CITATIONS READS

0 1,489

5 authors, including:

Ramin Mersi Sina Vali


Shahid Beheshti University Shahid Beheshti University
1 PUBLICATION   0 CITATIONS    1 PUBLICATION   0 CITATIONS   

SEE PROFILE SEE PROFILE

Mehdi Tale Masouleh


University of Tehran, School of Electrical and Computer Engineering
185 PUBLICATIONS   1,124 CITATIONS   

SEE PROFILE

Some of the authors of this publication are also working on these related projects:

parallel robot View project

ShrewdShoe View project

All content following this page was uploaded by Ramin Mersi on 04 November 2018.

The user has requested enhancement of the downloaded file.


Design and Control of a Suspended Cable-Driven
Parallel Robot with Four Cables
Ramin Mersi, Sina Vali Morteza Shahamiri haghighi, Ghasem Abbasnejad Mehdi Tale Masouleh
Human and Robot Human and Robot Human and Robot
Interaction Laboratory Interaction Laboratory Interaction Laboratory
University of Tehran School of Electrical School of Electrical
Tehran, Iran and Computer Eng. and Computer Eng.
Email: r.mersi@mail.sbu.ac.ir, University of Tehran University of Tehran
s.vali@mail.sbu.ac.ir Tehran, Iran Tehran, Iran
Email: morteza.shahamiri@ut.ac.ir, Email: m.t.masouleh@ut.ac.ir
ghasem.abbasnejad@ut.ac.ir

Abstract—This paper presents the state of the art of design be taken into account, simultaneously. As such, displacement-
and control of a new suspended under-constrained cable-driven analysis problems become significantly more complex than
parallel robot with four cables. In order to improve the estimation tasks concerning fully-constrained manipulators [6, 7]. In [8],
of the cable lengths, an auxiliary roller screw mechanism is
utilized to move the winch linearly for proper cable coiling on robot configurations that ensure static equilibrium of the
one layer. Also, in order to compute the configuration of the robot payload at a desired pose are developed while constraints on
in real-time, a gyro sensor is installed on the end-effector. The the tension of the cables is considered. In [9], the fact that
collected data from the gyro sensor is used to make equivalent robot configurations may admit multiple payload equilibrium
the solution of the direct geometric-static problem to the solution solutions is addressed by developing constraints that guarantee
of linear system of equations. The foregoing reduced system can
be readily solved and leads to the position of the end-effector in the existence of a unique payload pose. In [10, 11, 12], a
real-time which is a definite asset in control. Moreover, kinematic general methodology for the kinematics, static and stability
problem of the cable-driven parallel robot is provided and a new analysis of general under-constrained CDPRs is proposed. The
approach for solving the forward kinematic problem is proposed. method allows one to find the entire set of configurations
of under-constrained CDPRs when all the n cable lengths
Index Terms—Cable-driven parallel robot; Kinematics; For-
ward kinematics; Real-time; Control are assigned, e.g., Direct Geometrico-static Problem (DGP)
is dealt. In [13], direct geometrico-static analysis of under-
constrained cable-driven parallel robots with three cables is
I. I NTRODUCTION
studied. An interval-analysis-based procedure is proposed to
Cable-driven parallel robots (CDPRs) employ cables in numerically find all the real equilibrium configurations of the
place of rigid-body legs to control the end-effector (EE) pose. end-effector for a robot of generic geometry. As extension of
The use of cables in CDPRs provides several advantages such the aforementioned work, in [14], the authors utilized a similar
as reduced weight and inertia, larger operational distance, ease approach to compute all the equilibrium configurations for
of assembly and disassembly, high transportability, modular- under-constrained CDPRs with an arbitrary number of cables.
ity and reconfigurability. CDPRs are called over-constrained None of the above literatures propose a method for solving
when the number of cables m is bigger than the number of the DGP of under-constrained cable-driven parallel robots in
degrees of freedom (DOF), n, that the EE possesses with real-time and there is still a gap in the literature regarding the
respect to the base (m > n) and they are referred to as latter issue. The best computational time to solve the DGP
under-constrained when the number of cables is less than of under-constrained cable-driven parallel robots is presented
the number of degrees of freedom (m < n). In the case of in [14], which is 702s by a single-core execution, and 178s
under-constrained CDPRs, only some EE’s DOF may be con- by over 4 CPUs for a 4 cable robot and cannot be regarded
trolled [1, 2], and the EE actual configuration depends on the as a real-time approach. In [15], a new method based on the
applied forces [2]. Several applications of such robots consist data obtained by a gyro sensor installed on the EE is proposed
of measurement, rescue, service or rehabilitation operations for real time computation of the DGP of an under-constrained
[3, 4, 5], where a limited number of controlled DOFs are CDPR with four cables. From the data of the gyro, and upon
required in order to decrease complexity, cost, set-up time, applying some mathematical manipulations, the DGP is made
likelihood of cable interference, etc. equivalent to the solution of a system of linear equations which
A major challenge in the control of under-constrained CD- reduces the computation time, significantly.
PRs arises from the fact that for determining the EE configu- In this paper, the design of a new 4-cable under-constrained
ration, geometric constraints and mechanical equilibrium must CDPR is introduced which is as extension of the design
introduced in [15]. Compared to the design of the robot in [15], TABLE I
this robot is improved in terms of its cable actuation. In the T HE CHARACTERISTICS OF THE EXPLOSION CONFIGURATION OF CDPR.
former design, classical winches were utilized on which the No. Component Model
cables were free to coil and motor shaft bore the weight of the - Driver Kinko FDA422-LA-000
winch system. This design suffered from the major drawback 1 Actuator Kinko SME80S-0075-30AAK-3LKH
2 Coupling JT50
of error in the estimation of cable lengths. In the new design 3 3-bar Pad -
presented in this paper, however, the winches are mounted on 4 Aluminium Winch -
an auxiliary roller screw mechanism to ensure the only one 5 Ball Screw Nut SCI02005
6 Screw -
layer for the coiled cables which allows a good estimation of 7 Chromic bar -
the cable length. In addition, the skeleton of the robot bears the 8 Upper Plate -
weight of the winch system. The DGP of the robot is solved 9 Bottom Plate -
10 Ball Bearing SKF 6002
similar to the approach proposed in [15], by collecting the 11 Angle Contact -
data of a gyro sensor installed on the EE. As such, real-time
computation of the DGP can be ensured in order to control
the EE on its trajectory, which is the subject of an upcoming A. Mechanical Design
section of this paper. Figure 1 illustrates the under study CDPR constructed at
The remainder of this paper is organized as follows. In the Human and Robot Interaction Laboratory. The workspace
Section II, the experimental setup of the CDPR is divided of the robot is in the form of a cube with dimensions
into mechanical and electrical design which are described in 5m×3m×2.5m. The manipulator consists of four cables
details. Section III presents the forward and inverse kinematics rolling packs, a moving platform and four electrical motors
problems of the CDPR, and a new approach for solving which are controlled by PC to coil and uncoil cables. Figure 2
the forward kinematics is expressed. In section IV, a control demonstrates the explosion plan of one of the four cable rolling
algorithm is designed based on the kinematics problem and a packs in details with all its components listed in Table I.
PID controller is implemented. In section V, the experimental According to the latter figure, two horizontal and four vertical
results of this paper has been shown. Finally, in section VI steel plates are connected to each other which build the
the paper concludes with some hints and remarks as ongoing skeleton of the system. The actuator is connected to the rolling
work. system through a coupling which serves as a mechanical fuse.
Using a rolling screw system and three long rods, rotary and
II. E XPERIMENTAL S ETUP OF CDPR translational motion can be achieved simultaneously by the
actuators. The main idea behind the design of the moving
In this section, the mechanical design and geometric config- winches and their grooved shape consists in avoiding multi-
uration of the new designed 4-cable CDPR built at the Human layer cable coiling and to keep the attachment point of the
and Robot Interaction Laboratory of University of Tehran in cable to the winch fixed all the time. It has been attempted
addition to the utilized electrical parts are introduced. to lessen the friction to its minimum point by separating the
moving parts from the static parts by using ball bearings and
ball screw system.
B. Electrical Design
Figure 3 depicts the general view of the experimental
setup of the CDPR which defines the relation between the
components. In order to control the CDPR, an Arduino Due
is utilized which sends the data using the HC-05 Bluetooth
module. Furthermore, the length of the cables are determined
by using the encoders inside the motors and a load cell sensor
is installed on the spool to ensure the presence of a certain
amount of force in cables. In the case of a 4 cables under-
constrained CDPR, up to a combination of 3 DOFs can be
controller among the possible 6 DOF of the EE. For the sake
of practical application, in this project, the EE is intended
to exhibit translational movement, therefore an MPU sensor
is placed on the EE for solving the kinematic problems, more
precisely, forward kinematic problem, which is fully discussed
in what follows.
1) MPU sensor: In order to get the feedback from the EE’s
Fig. 1. The cable-driven parallel robot constructed at the Human and Robot orientation, an accelerometer is used. The MPU-9150 is a 9-
Interaction Laboratory, University of Tehran. DOF Inertial Measurement Unit (IMU) in a single package.
Fig. 2. Explosion view of the designed cable rolling system.

support the Modbus and the internal protocol to communicate,


but the RS-485 can just use Modbus. In Modbus, due to
the security considerations, the communication’s baud rate
reached to the lower value, so the RS-232 is selected with
the internal protocol.
III. K INEMATICS
The main purpose in the kinematic investigation of manipu-
lators consists in determining the geometry of motion without
considering forces and torques. Kinematics is divided into two
types namely forward and inverse kinematics and are outlined
in this section.
A. Inverse Kinematic Problem
The inverse kinematic problem pertains to obtaining the
length/position of actuators, in this case, the length of the
cables, with respect to the pose of the EE [16].
Fig. 3. General view of experimental setup of the cable robot, electrical and According to Fig. 4, which shows the schematic model of
mechanical equipments.
the 6-DOF spatial CDPR, Ai and Bi denote the attachment
points of ith cable to the actuator and EE, respectively. OG
It contains a 3-axis accelerometer, 3-axis gyroscope, 3-axis stands for the origin of the global coordinate system and
magnetometer and a Digital Motion Processor™ (DMP™) OE shows the origin of the local coordinate system which
hardware accelerator engine. It uses I2C communication at a is located on the center of the EE. Note that ai and bi are
maximum of 400 kHz baud rate. The range of each sensor is constant vectors in OG and OE coordinates, respectively. The
configurable: the accelerometer’s scale can be set to ±2g, ±4g, closed-loop position equations associated with ith kinematic
±6g, ±8g, or ±16g, the gyroscope supports ±250, ±500, chain could be written as follows [9]:
and ±2000 °/s, and the magnetometer has the full-scale range
of ±1200T (±12 gauss). The data of these three sensors are ai + li = p + bi (1)
combined to obtain the roll, pitch and yaw angles of the EE Equation (1) could be written in OG as follows:
with minimum possible error. The latter is possible due to
the fact that a data fusion procedure based on the so-called ai + li = p + Rbi (2)
Kalman filter is applied.
2) Driver: Drivers can use RS-232 and RS-485 serial where R is the rotation matrix from OE to OG which could
communication to communicate with the computer. Both of be written as follows:
them can be used to communicate between some devices as
⎡ ⎤
master/slave communication, which in this case, the PC is used cψ c φ cψ sφ sθ − sψ cθ cψ sφ cθ + sψ sθ
as master and the Drivers are used as slave. The maximum R = ⎣ sψ cφ sψ sφ sθ + cψ cθ sψ sφ cθ − cψ sθ ⎦ (3)
baud rate for both of them is 115.2 kHz. The RS-232 can −sφ cφ sθ cφ cθ
Fig. 5. Top view of the four spheres. The EE’s position is located on their
Fig. 4. Schematic view of a CDPR with i cables. intersection point p

In the above s denotes the sine, while c denotes the cosine of


its indexed argument. Moreover, θ , φ and ψ stand for angles of
rotation about x, y and z axis, respectively. As aforementioned, (bi − ai )T p = x(bi1 − ai1 ) + y(bi2 − ai2 ) + z(bi3 − ai3 ) (10)
the angles of rotation of the EE are determined by the MPU
Substituting Eqs. (7) to (10) into Eq. (6) leads to:
attached to the EE.
By replacing bi with Rbi and rearranging Eq. (2), one has: L2i =x2 + y 2 + z 2 + (bi1 − ai1 )2 + (bi2 − ai2 )2 + (bi3 − ai3 )2
+ 2x(bi1 − ai1 ) + 2y(bi2 − ai2 ) + 2z(bi3 − ai3 )
li = p + bi − ai (4) (11)
By rearranging the above equations, one can obtain the
By multiplying the two sides of the equation with their following:
transpose leads to the following:

lTi li = (p + bi − ai )T (p + bi − ai ) (5) L2i = (x + (bi1 − ai1 ))2 + (y + (bi2 − ai2 ))2 + (z + (bi3 − ai3 ))2
(12)
Eventually, the inverse kinematic problem for each cable is Clearly, this equation represents the equation of a sphere.
achieved: In the manipulator under study, four cables exist. So, as it can
be observed from Fig. 5, there are a total of four spheres. The
|li |2 = |p|2 +|bi − ai |2 +2(bi − ai )T p (6) intersections of these four spheres are two points that indicate
the possible location of the EE. The one that is situated in the
manipulator’s configuration space is the right position.
B. Forward Kinematic Problem
Having three spheres out of four is sufficient for finding the
In turn, the forward kinematic problem concerns with ob- intersection points, there are different methods to obtain these
taining the position of the EE by knowing the length of the points like the GQFK method [17]. Another method is finding
cables which can be computed from the position of the motor points using analytic geometry that is discussed in details in
shafts. In parallel manipulators, solving forward kinematics is the following section.
much more complicated than its inverse. Here, a new method
for solving the forward kinematic problem is introduced. For C. Finding Intersection Points of Three Spheres Using Ana-
solving the latter problem, a closed loop chain should be lytic Geometry
written as discussed before. Therefore, Eq. (6) is going to Assuming that there are three spheres and by writing their
be applied in this section. Upon simplifying the components algebraic equations and subtracting two of them from the other
of Eq. (6), one has: one, equations of the two planes will be achieved which is
illustrated in Fig. 6. According to the parametric form of the
line equation:
|bi − ai |2 = (bi1 − ai1 )2 + (bi2 − ai2 )2 + (bi3 − ai3 )2 (7) ⎧
⎨ x = at + x0
y = bt + y0 (13)
|li |2 = L2i (8) ⎩
z = ct + z0
and by rearranging the equations in vector representation,
|pi |2 = x2 + y 2 + z 2 (9) it could be written as follows:
kinematic problem of the robot can only be solved using the
EE’s position.
As aforementioned, forward kinematic problem is required
to measure the cable lengths and orientation of the EE.
The obtained position from the forward kinematic problem,
compared to the desired position and the calculated error is
mapped to the joint space by using the Jacobian matrix of the
robot. The controller tries to compensate this error by applying
a speed proportional to the error.
By using trial and errors practical tests, the PID coefficients,
Kp , Ki and Kd tuned experimentally as follows:

Kp = 2.4, Ki = 0.3, Kd = 0.1 (16)


Fig. 6. The three spheres and two planes formed by subtracting the equations
representing the intersection on p1 and p2 .
V. E XPERIMENTAL R ESULTS
In order to experimentally ensure the validation of the
proposed algorithm, this algorithm is implemented practically
p = u × t + p0 (14) on the robot. As previously explained, the EE’s position is
obtained from the solution of the proposed forward kinematic
where u is a vector parallel to the intersection line, p0 is
problem. It should be noted that, the length of the cables
a point on this line and t is a variable. By intersecting the
are derived from the data obtained by the encoder and the
line with one of the spheres, the value of t along with the
initial cable length at the robot reference point. The MPU is
intersection points will be determined.
mounted on the EE. For this purpose, a square-shaped path
For finding a vector parallel to the intersection line of the
with dimensions 1m×1m is defined in space with plenty of
two planes, the cross product of the normal vectors can be
points. The torque of the motor is depicted in Fig. 8, where the
taken into consideration:
robot tracks the latter path. As expected, on each sides of the
square path, two motors are pulling the cable and two other
u = n1 × n2 (15)
motors are running out of the cable, so two of them have the
where n1 and n2 are the normal vectors of the planes. In positive torque and two others have negative. Also, due to the
order to achieve a mutual point on the two planes, a constant small load and the inherent property of ball screw to increase
number could be assigned to one of the variables of the planes the power transmission, the torque applied by the actuators are
and two others would be determined by solving the two plane relatively small.
equations. Figure 9 shows the desired and tracked paths. The maximum
absolute error along X ,Y and Z axis are as follows:
IV. C ONTROL OF THE CDPR
Figure 7 depicts the control block diagram for controlling M AEx = 1.06 cm M AEy = 1.69 cm M AEz = 4.51 cm
the under study CDPR. Because the robot has four actuators
and they are only capable to pull the cables, three out of six VI. C ONCLUSION
DOF can be controlled; then, x, y, and z are used as input
parameters which represent the EE’s position. Since the size This paper presented an experimental setup of a new mech-
of the EE is negligible with respect to the robot dimensions, anism for a cable driven parallel robot. The design of the cable
and the feedback from the forward kinematic problem can be rolling system was such that the winch has a helix motion that
compensated for positional error, the EE can be assumed as prevents the cable intertwining. By using ball bearings and
a mass point. In other words, the orientation of the EE in ball screw system, friction has been significantly reduced and
the space becomes constant. With this assumption, the inverse performance became smoother. Forward and inverse kinematic
problem have been solved by knowing the cable lengths and
EE angles which are derived from motor encoders and the
+ MPU, respectively. In addition, a new method for solving the
- Jacobian Controller System forward kinematic problem, an important issue in control of
Desired
Trajectory such robot, was introduced. Based on the solved kinematic
MPU
problems, a PID controller was implemented on the system,
Forward the manipulator was launched and the results were extracted.
kinematics Data fusion
From the practical tests, it can be inferred that the robot had
a smooth operation and perform the commands with the least
errors.
Fig. 7. The block diagram structure of kinematic control of CDPR.
for measuring the inertia properties of rigid bodies.
Motor1 Mechanical Systems and Signal Processing, 25:305–318,
0.5 2011.
0 [6] A. Fattah and S. K. Agrawal. On the design of cable-
-0.5 suspended planar parallel robots. ASME Journal of
0 100 200 300 400 Mechanical Design, 127:1021–1028, 2006.
Motor2 [7] Q. Jiang and V. Kumar. The direct kinematics of objects
0.5 suspended from cables. In Proc. of the ASME 2010 Int.
0 Design Engineering Technical Conferences, pages 1–10,
Torque(N.m)

-0.5 Paper no. DETC2010–28036, Montreal, Canada, 2010.


0 100 200 300 400 [8] N. Michael, S. Kim, J. Fink, and V. Kumar. Kinematics
Motor3 and statics of cooperative multi-robot aerial manipulation
0.5
with cables. In Proc. of the ASME 2009 Int. Design
0 Engineering Technical Conferences, volume 7A, pages
-0.5 83–91, paper no. DETC2009–87677, San Diego, USA,
0 100 200 300 400 2009.
Motor4 [9] J. Fink, N. Michael, S. Kim, and V. Kumar. Planning and
0.5
control for cooperative manipulation and transportation
0
with aerial robots. International Journal of Robotics
-0.5 Research, 30:324–334, 2011.
0 100 200 300 400
[10] M. Carricato and J.-P. Merlet. Geometrico-static analysis
Sample
of under-constrained cable-driven parallel robots. In
J. Lenarčič and M. M. Stanišic̀, editors, Advances in
Fig. 8. The amount of torque of each motor to perform a square path. Robot Kinematics: Motion in Man and Machine, pages
309–319. Springer, Dordrecht, 2010.
[11] M. Carricato and J.-P. Merlet. Direct geometrico-static
Tracked path problem of under-constrained cable-driven parallel robots
250 Desired path
with three cables. In Proc. of the 2011 IEEE Int. Conf. on
200
Robotics and Automation, pages 3011–3017, Shanghai,
Z(cm)

150
China, 2011.
100 [12] M. Carricato and J.-P. Merlet. Inverse geometrico-static
60
40 60
problem of under-constrained cable-driven parallel robots
20 20 40
0
-20
-40 -40 -20 0 with three cables. In Proc. of the 13th World Congress
-60 -60 X(cm)
Y(cm) in Mechanism and Machine Science, pages 1–10, Paper
No. A7 283, Guanajuato, Mexico, 2011.
Fig. 9. The desired path compared to the tracked path.
[13] A. Berti, J.P. Merlet, and M. Carricato. Solving the direct
geometrico-static problem of 3-3 cable-driven parallel
robots by interval analysis: Preliminary results. In Bruck-
R EFERENCES
mann T., Pott A. (eds) Cable-Driven Parallel Robots.
[1] A. Ming and T. Higuchi. Study on multiple degree- Mechanisms and Machine Science, volume 12. Springer,
of-freedom positioning mechanism using wires—Part 1: 2013.
Concept, design and control. Int. Journal of the Japan [14] A. Berti, J.-. P. Merlet, and M. Carricato. Solving
Society for Precision Engineering, 28:131–138, 1994. the direct geometrico-static problem of underconstrained
[2] M. Carricato, G. Abbasnejad, and D. Walter. Inverse cable-driven parallel robots by interval analysis. 35(6),
geometrico-static analysis of under-constrained cable- 2016.
driven parallel robots with four cables. In Lenarcic J., [15] A. Aflakian, A. Safaryazdi, Mehdi Tale Masouleh, and
Husty M. (eds) Latest Advances in Robot Kinematics. A. Kalhor. Experimental study on the kinematic control
Springer, Dordrecht, 2012. of a cable suspended parallel robot for object tracking
[3] T. Morizono, K. Kurahashi, and S. Kawamura. Analysis purpose. 50:160–176, 2018.
and control of a force display system driven by parallel [16] J.P. Merlet. Parallel Robots, volume 128. Springer
wire mechanism. Robotica, 16:551–563, 1998. Netherlands, 2006.
[4] J.-P. Merlet and D. Daney. A portable, modular parallel [17] A. Salimi Lafmejani, M. Tale Masouleh, and A. Kalhor.
wire crane for rescue operations. In Proc. of the 2010 Trajectory tracking control of a pneumatically actuated
IEEE Int. Conf. on Robotics and Automation, pages 6-dof gough-stewart parallel robot using backstepping-
2834–2839, Anchorage, USA, 2010. sliding mode controller and geometry-based quasi for-
[5] M. Gobbi, G. Mastinu, and G. Previati. A method ward kinematic method. 54:96–114, 2018.

View publication stats

You might also like