Professional Documents
Culture Documents
net/publication/327602189
CITATIONS READS
0 1,489
5 authors, including:
SEE PROFILE
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Ramin Mersi on 04 November 2018.
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.
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:
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.