1. Introduction
The cable-driven robot is a mechanism that employs cables in place of rigid-body to control the end-effector pose.
The classification of cable-driven parallel robots (CDPRs) was introduced by Ming and Higuchi [
1]. A cable-driven robot with
n degrees-of-freedom and
m cables can be classified into the following four categories: (1)
: These robots are referred to as redundantly restrained positioning mechanisms (RRPM), the static forces of the robot are generally undefined. (2)
: These robots are called completely restrained positioning mechanisms (CRPM). All degrees of freedom can be controlled through cables. (3)
: This type of robot is called incompletely restrained positioning mechanism (IRPM). When external forces such as gravity applied, the robot is fully constrained. It can withstand a limited range of wrenches. (4)
: The robot is under-constrained positioning mechanism (URPM) and in general cannot withstand arbitrary external forces and torques. Due to the under-constrained nature, these robots have one feasible solution for cable tensions and mostly works under gravity conditions. This classification method is also applicable to cable-driven planar hybrid robots.
According to the structure of cable-driven robot, it is generally divided into series mechanism and parallel mechanism.
Cable-driven robot has the characteristics of simple structure, flexibility, large workspace, low inertia, high load rate, etc. It has a wide range of applications, such as: Five-hundred-meter Aperture Spherical radio Telescope (FAST), wind tunnel test, rehabilitation training, sports photography, etc. [
2,
3,
4,
5], it has become a hot spot in robotics research recent years.
The under-constrained cable-driven robots (UCR), with few drivers and low cost, has its special purpose, attracting more and more scholars’ research interest. Carricato et al. [
6,
7,
8] from Italy studied the cable-driven parallel robots with less than six cables, provided a geometrico-static model, and assessed the stability of static equilibrium within the framework of a constrained optimization problem. Several examples are provided, concerning robots with a number of cables that range from 2 to 4. Berti et al. [
9] proposed a method based on interval analysis to solve the positive geometric statics problem of an under-constrained cable-driven parallel robot, and find all possible equilibrium poses of the end effector under a given cable length. Liu Xin et al. [
10] proposed a consistent algorithm for solving the workspace of a cable-driven parallel robot under different constraints. Fu Ying et al. [
11] conducted a dynamic analysis on the cable-driven system with four cables and six degrees of freedom. Zhao Zhigang et al. [
12] proposed a comprehensive algorithm by combining the least squares method and the Monte Carlo algorithm to solve the statically balanced workspace for the cable-driven system with multi-robots. Peng Y et al. [
13] analyzed the reachable workspace for spatial 3-cable under-constrained suspended cable driven parallel robots. The above-mentioned literature put forwards the solution method of static equilibrium workspace for under-constrained parallel robots. Based on this, a consistent solution strategy for the static equilibrium workspace of both cable-driven parallel & planar hybrid robots is put forward in this paper.
Ida E et al. [
14] proposed a rest-to-rest trajectory planning for underactuated cable-driven parallel robots. Barbazza L et al. [
15] design and optimally control an underactuated cable-driven micro–macro robot. Shang Weiwei et al. [
16] proposed a geometrical approach to plan trajectories that extend beyond the static equilibrium workspace (SEW) of the mechanism. Zi B et al. [
17] studied an algebraic method-based point to point trajectory planning of an under constrained cable suspended parallel robot with variable angle and height cable mast. Shi P et al. [
18] studied Dimensional synthesis of a gait rehabilitation cable-suspended robot on minimum 2-norm tensions. The above-mentioned literature put forwards the planning trajectories for under-constrained parallel robots. Based on this, a consistent solution strategies of point-to-point trajectory planning introducing parameters for both cable-driven parallel & planar hybrid robots is put forward in this paper.
Firstly, the static equilibrium equations of the under constrained parallel and planar hybrid robots are established. Then, the mathematical description of the static equilibrium workspace of the under-constrained cable-driven robots (UCR) that meets the constraints of the driving motor power and cable strength is given. The characteristics of the static equilibrium equation and dynamics equation are analyzed, and the consistent solution strategy for the static equilibrium workspace and point-to-point trajectory planning introducing parameters of different types of under-constrained robots are given.
The paper is organized as follows:
Section 2 presents the model for under-constrained parallel robots.
Section 3 provides the model of under-constraint cable-driven planar hybrid robot.
Section 4 describes the consistent solution strategy for static equilibrium workspace.
Section 5 illustrates some results of static equilibrium workspace.
Section 6 puts forward the consistent solution strategies for point-to-point trajectory planning.
Section 7 illustrates the simulation results of trajectory planning. Finally,
Section 8 draws conclusions.
2. Model of Under-Constrained Cable-Driven Parallel Robots
The schematic structure of a cable-driven robot with
n degrees-of-freedom and
m cables is shown in
Figure 1. Here
m < n, it’s an under-constrained CDPR. The moving platform is connected to the base through m cables, the
ith cable (
i = 1,2,…,m) exits from the fixed base at point
Ai, connected to the moving platform at point
Bi. the cable length is
Li.
Oxyz is a Cartesian coordinate which fixed to the base, and
O′x′y′z′ is the Cartesian coordinate fixed to the moving platform.
is the centroid of end effector in the Oxyz frame. is the vector connecting point O’ to the point Bi in the O′x′y′z′ frame. is the fixed base at point Ai, in the Oxyz frame.
represents the rotational matrix from frame
O′x′y′z′ to frame
Oxyz, in which
are
x-
y-
z the Euler angles.
where
represents
,
represents
.
is the vector in the
Oxyz frame.
is the vector connecting point
Bi to point
Ai in the
Oxyz frame.
is the unit vector of
.
Thus, the dynamics equations for end effector are shown as follows:
where
,
is cable tensions act on the end effector.
is the construction matrix,
, and
.
is the acceleration of the end-effector centroid
in the world coordinate system, and
,
is the inertia tensor of the end-effector in the local coordinate system.
and
are the angular velocity and angular acceleration of the end-effector.
,
and
, the Euler angle, satisfy the following relationship:
Substituting Equations (5) and (6) into Equation (4) yields a general expression for the system dynamics equation [
19], i.e.,
In Equation (7), is the end-effector acceleration. is the mass matrix of the end-effector. is the force vector for a collection of Coriolis-type forces, gravitational forces, and external loads, etc. is the cable-tension to which the end-effector is subjected.
Additionally, the static equilibrium equation of the system can be expressed by
3. Model of Under-Constrained Cable-Driven Planar Hybrid Robot
The schematic structure of a cable-driven planar hybrid robot with planar
n -link serial robot with
n degrees-of-freedom and
m cables is shown in
Figure 2. All links are connected by revolute joints to form a planar multi-link mechanism. This definition can also be generalized to space model. Here,
m < n, it’s an under-constrained cable-driven planar hybrid robot.
is the base frame,
is the link frame
,
.
is the angle between link frame
and
.
is the Joint coordinates of the system.
is the position vector of the
link centroid in the fixed frame
. It can be expressed by
where
,
represents the rotational matrix from frame
to frame
,
.
is the
cable position vector of the
link in the fixed frame. It can be expressed by
where
is the cable position vector of the
link in the link frame
.
The generalized force is solved by Lagrange equation,
where
is the generalized force,
is the Lagrange function.
is the generalized coordinate.
and
are the kinetic energy and potential energy of the system, respectively.
Write Equation (12) as a generic expression,
where
is the inertia matrix, and
is the gravity, centrifugal force, Coriolis force, etc.
The expression (14) can be obtained according to the principle of virtual work
where
represents the number of cables,
is the cable tension,
is the unit vector of the cable tension, and
is the position of the
pulling point in the coordinate system.
From Equation (14), the relationship between generalized force and cable tension can be obtained
where
where
is the pseudo-Jacobian of the constraint equations,
is the
matrix,
is the
cable tension matrix.
Combining Equations (13) and (15), the system dynamics equation is obtained as follows.
Since the system is in static equilibrium, and the generalized velocity
, Formula (11) can be simplified as
where
. Taking the origin of the coordinate system as the reference point of potential energy.
Combine Equations (15) and (17), yields
4. Consistent Solution Strategy for Static Equilibrium Workspace
is the pose of the parallel robot, is the Joint coordinates of the planar hybrid robot. They are uniformly written into generalized coordinates .
Combine Equations (8) and (18), yields
where
W is the external force.
4.1. The Definition of Static Equilibrium Workspace
Due to the limitation of motor torque and cable strength, the tension of the cable must be within a certain range. Therefore, for a robot with
n degrees of freedom pulled by
m cables, the mathematical description of its static equilibrium workspace is as follows:
where
represents the generalized coordinate.
are the minimum and the maximum allowable tension of the cable, respectively.
is the cable tension, and
belongs to the Static equilibrium workspace.
4.2. Consistent Solution Strategy
For a cable-driven robot with n degrees-of-freedom and m cables, here m < n, it’s an Under-constrained Cable-driven Robot (UCR). The Static equilibrium workspace of the under-constrained cable-driven system is analyzed as follows:
In static equilibrium Equation (19), is matrix, is matrix. For the under-constrained cable-driven system, the solution of the equation is in the form of the least squares solution, and it can be expressed by . When this solution is within the limit of cable force, it is considered that the pose (generalized coordinate) is the static equilibrium point satisfying Equation (20).
Then, the following inequality holds
where
is the error of the least square solution.
To sum up, the consistent solution strategy for the Static equilibrium workspace of the UCRs is as follows:
For the under-constrained robot, given the lower limit and the upper limit of cable tension and separately, selected the controllable degrees of freedom and uncontrollable degrees of freedom and separately.
Judge the search range of the system dimension, set the search step , and generate the pose set to be searched.
Take a pose to be searched from the set and bring it into Formula (19) to solve the Jacobian matrix .
Set convex optimization solution goal: , nonlinear constraint: . Use the interior point method to solve it.
Check whether the results of step 4 meets . If the condition is true, there is a Static equilibrium point in the controllable generalized coordinate that meets the cable force condition, turn to step 6, otherwise, there is no Static equilibrium point in the controllable posture.
Calculate the next pose to be searched.
5. Simulation Results of Static Equilibrium Workspace
5.1. 3−6 Under-Constrained Parallel Robot
Solve the Static equilibrium workspace of 3−6 (3 cables pulling 6 degrees of freedom) under-constrained parallel robot. The mass of end effector is
. See
Table 1 for specific parameters.
is the lower limit of cable tension, and
the upper limit of cable tension.
is the error. The controllable degree of freedom is
, and the uncontrollable degree of freedom is
, the rotation angle of
x-axis,
y-axis, and
z-axis, respectively. Considering the volume of end effector and cable, set the search interval is
The search step of is , and the pose set to be searched is generated.
Matlab is used to solve the static equilibrium workspace of 3−6 cable-driven parallel robot.
It can be seen from
Figure 3 the 3D view,
xoy planar view and
xoz planar view of the Static equilibrium workspace that the Static equilibrium workspace of the 3−6 under-constrained parallel robot is approximately a triangular prism, whose cross section is symmetrical along the
x-axis, and there are two narrow workspace cracks in the lower half (
z < 0.75 m) of the triangular prism. Compared with the system schematic diagram 1, this situation occurs because when the center of mass of the end actuator is low, the tension force of the three cables cannot be balanced with gravity, so the pose of the end actuator cannot be kept stable. The anchor points
and
are symmetrical along the
y-axis, and the anchor point
is on the axis, so that the cross section of its Static equilibrium workspace is symmetrical about the
y-axis.
5.2. 0−0−2 Under-Constrained Planar Hybrid Robot
Solve the Static equilibrium workspace of the 0−0−2 under-constrained planar hybrid robot (no cable attached on the first and second links, and two cables attach on the third link). The
Table 2 and
Table 3 show the specific parameters of 0−0−2 cable-driven planar hybrid robot system.
The lower limit of the cable tension is , the upper limit of the cable tension is , is the error.
is the controllable degrees of freedom, and is the uncontrollable degrees of freedom.
Set the search interval is .
The search step is , and the pose set to be searched is .
The static equilibrium working space of the 0−0−2 cable-driven robot is solved by MATLAB programming.
According to
Figure 4, the static equilibrium workspace of the 0−0−2 under-constrained cable-driven planar hybrid robot is a curved surface. From
Figure 4b,
θ1θ2 planar view of the Static equilibrium workspace, the Static equilibrium points in the pose set are mainly distributed in the lower right corner area. The uncontrollable degrees of freedom of the static equilibrium point belongs to
from
Figure 4c,d.
6. Consistent Solution Strategies for Point-to-Point Trajectory Planning
6.1. Analysis of the Dynamics of Under-Constrained Systems
The end poses of the parallel robot and Joint coordinates of the planar hybrid robot are written in generalized coordinates .
Write Equations (7) and (16) uniformly as:
where
is the acceleration in generalized coordinates,
is the mass matrix, and
is the vector of the cable tensions.
For the under-constrained system, the controllable degrees of freedom,
, are
dimensional vectors. The uncontrollable degrees of freedom,
, are
dimensional vectors. As a result, Equation (22) can be written in the form of
For Equation (23), when is known, the acceleration and the cable force for the system at this moment can be obtained.
By presenting the acceleration terms for the (UDFS) uncontrollable degrees of freedom, we obtain the expressions for
Substituting the expression for
into Equation (23), we obtain the expression for the cable extension
:
6.2. Point-to-Point Trajectory Planning Introducing Parameters
In the process of point-to-point trajectory planning for under-constrained systems, the start and end points of the motion should be chosen as static equilibrium points and the speed at the start and end points should be zero.
For an under-constrained system with
n degrees-of-freedom and
m cables, there are
m controllable degrees of freedom and
uncontrollable degrees of freedom. The dynamics Equations (22) and (23) shows that during trajectory planning, only controllable degrees of freedom,
, can be trajectory planned, while uncontrollable degrees of freedom
are influenced by dynamics [
20]. When the controllable degree of freedom reaches the end, an uncontrollable degree of freedom cannot be guaranteed to reach the end with zero velocity. Therefore, it is necessary to choose a suitable trajectory plan for the controllable degrees of freedom to ensure that the uncontrollable degrees of freedom reach the end point with zero velocity.
Assume that the trajectory planned for
is
, the trajectory of
to be found is
, and the set of differential equations is established by Equation (24) as follows.
where
are the position and velocity of the non-controllable degrees of freedom at the start and end points, respectively, which are both static equilibrium points with zero velocity.
The optimal trajectory for controllable degrees of freedom is achieved when the trajectory is such that Equation (26) holds.
Since Equation (26) has variables and its boundary conditions have constraint. In order to make Equation (26) solvable, parameter needs to be added to the planned trajectory .
As an example of a conventional polynomial, a trajectory is planned for controllable degrees of freedom and parameters are introduced for the planned trajectory.
A conventional polynomial point-to-point trajectory is planned as a straight-line path [
21] with a trajectory equation of the form:
where
is the position of the controllable degrees of freedom at the start and end points, respectively,
.
For a smoothly derivable point-to-point trajectory
of order
, the law of motion
is designed as follows:
where
Introducing parameters to the trajectory of a traditional polynomial programming, the equation of the trajectory is
The law-of-motion function
can be set to
where
. In order to maintain
,
. is expressed as follows.
where
.
Equation (26) is a multivariate marginal differential equation containing parameters that are converted to a multivariate initial differential equation for solution, and the expression of the converted multivariate initial differential equation is as follows.
Since the solution of the multivariate initial differential equation removes the constraint at the end point, the result can be solved again by setting up the Newton iteration equation to ensure that the end point of the solved trajectory is the same as the planned trajectory.
The trajectory parameters for controlled degree of freedom planning is solved as follows.
Set the initial equations of the Newton iterative method: , the iterative convergence value: , and the initial values of the parameters to be solved: .
Solve the multivariate initial differential Equation (33) by taking into the solution , and calculating equation .
If the condition is satisfied, substitute the coefficient into the trajectory equation to obtain the best planning trajectory for the controllable degrees of freedom, and the solution is finished; otherwise, let , and substitute as the initial value into step 2 to continue the solution.
7. Simulation Analysis of Trajectory Planning
7.1. 3−6 Under-Constrained Parallel Robot
Point-to-point trajectory planning was performed for the 3−6 (6 degrees of freedom parallel robots with 3 cables) under-constrained parallel robot with the articulation shown in
Table 1, and
Table 4 shows the end-effector and trajectory planning parameters.
In
Table 4,
is the mass of the end-effector and
is the inertia tensor of the end-effector in a local coordinate system where the origin of the local coordinate system coincides with the center of mass.
is the initial and end pose of the trajectory planning and both are static equilibrium points.
Figure 5 shows the initial state and end state for unconstrained parallel robot trajectory planning.
The controllable degrees of freedom are and the uncontrollable degrees of freedom are . These are the angles of rotation around the x-axis, y-axis and z-axis respectively.
For the traditional polynomial trajectory planning method,
is taken to ensure that the trajectory is smoothly derivable to the third order, and
is calculated via Equation (29) with the following results.
Substitute into Equation (27) to find the conventional polynomial trajectory , and solve Equation (33) for the multivariate initial value differential equation.
For the polynomial trajectory planning method with the introduction of parameters, take
, whose coefficients
are the same as those of a conventional polynomial trajectory. Let the initial value of the parameter vector
be the 6−dimensional zero vector
, and solve for the parameters using Newton’s iterative method to obtain the following results.
Substituting the parameter into Equation (30), the traditional polynomial trajectory is obtained and solved for the multivariate initial differential Equation (33).
The solution results of the traditional polynomial trajectory planning method are compared with those of the polynomial trajectory planning method with parameters, and the comparison results are shown below.
Figure 6 shows the pose of the end-effector in the trajectory. In this case, the direction drops from 0 m to −0.15 m, the direction increases from 0.59 to 0.8 and the direction increases from 1 m to 1.17 m. The orientation angle also changes under the influence of the system dynamics, where
rises from −0.43
to −0.05
and
from 0
to 0.26
(rotated about
z-axis) and
remains largely stable during the process. The trajectory start and end points of both planning algorithms are consistent with
in
Table 4 in terms of the pose curves.
Figure 7 shows the velocity curves of the trajectories solved by the two planning algorithms. It can be seen that the difference in velocity between the trajectories planned by the two algorithms is more obvious. Both planning algorithms achieve the boundary condition of zeroing the velocity at the start and end point in the direction of
. However, for the angular velocity profile of
, the traditional trajectory planning algorithm cannot guarantee stationary at the end point, and the trajectory does not zero at
of 2.5
, which cannot guarantee the trajectory boundary condition.
7.2. 0−0−2 Under-Constrained Planar Hybrid Robot
Point-to-point trajectory planning for an under-constrained cable-driven robot with 0-2-2 (
Figure 8). The center of mass of each link is at its geometric center. The coordinates of the articulation points and the link parameters for the cable-driven robot are shown in
Table 2 and
Table 3, while the following
Table 5 shows the link inertia and trajectory planning related parameters.
In
Table 5,
is the mass product of inertia of the
link around the
-axis.
are the starting and ending points of the trajectory plan, and both are static equilibrium points.
The controllable degrees of freedom are , and the uncontrollable degrees of freedom are .
For the traditional polynomial trajectory planning method,
is taken to ensure that the trajectory is smoothly derivable to the third order, and
is calculated via Equation (29) with the following results.
Substitute into Equation (27) to obtain the traditional polynomial trajectory , and solve Equation (33) for the multivariate initial differential equation.
For the polynomial trajectory planning method with the introduction of parameters, take
, whose coefficients
are the same as those of a conventional polynomial trajectory. Let the initial value of the parameter vector
be a 2−dimensional zero vector,
, and solve for the parameters using Newton’s iterative method to obtain the following results.
Substituting the parameter into Equation (30), the conventional polynomial trajectory is obtained and solved for the multivariate initial differential Equation (33).
A comparison of the solution results of the traditional polynomial trajectory planning method with those of the polynomial trajectory planning method with the introduction of parameters is shown below.
The joint angle curves for the two planning algorithms are shown in
Figure 9. The joint angle
starts and ends at the same point in both planning algorithms, while angle
decreases from 90° to 80° and angle
changes from −25° to −45°. As can be seen from
Figure 7c, in the polynomial trajectory planning method with the introduction of parameters, the start and end points of the
curve are the same as
in
Table 5, whereas the traditional polynomial trajectory planning method does not guarantee this.
The angular velocity of the two planning algorithms is shown in
Figure 10. Both planning algorithms reach the boundary condition of zero at the start and end points for the angular velocity of
. As can be seen in
Figure 10c, for the angular velocity profile of
, stationarity is not guaranteed at the end point using the conventional trajectory planning algorithm, whereas the polynomial trajectory planning method with the introduction of parameters maintains stationarity at the end point.
In summary, for under-constrained parallel or planar hybrid systems, the traditional polynomial trajectory planning algorithm cannot guarantee zero velocity at the end of the trajectory. In contrast, the polynomial trajectory planning algorithm with the introduction of parameters at the start and end points keeps the under-constrained system stable without oscillation and satisfies the trajectory planning requirements.
8. Conclusions
In this paper, the force closure equations and geometric closure equations for incompletely constrained cable traction systems (parallel and planar hybrid) are developed, the equations are solved jointly using a convex optimization solution method with boundary conditions, a static equilibrium inverse kinematic model of the incompletely constrained cable traction system is developed, and the static equilibrium workspace is solved.
Point-to-point trajectory planning algorithms for incompletely constrained cable traction systems are investigated. Traditional purely algebraic methods such as polynomial functions or trigonometric functions for planning the trajectory of the end-effector do not take into account the dynamical model of the system, which can cause oscillations of the system at the start and end points due to insufficient controllable degrees of freedom on the UCR. In this paper, a dynamical model of the UCR is developed, which consider the cable force, external force, controllable position and orientation and uncontrollable position and orientation of the end-effector, etc. Based on this model, the traditional polynomial-based point-to-point trajectory planning algorithm is improved by adding parameters to the kinematic law function . The constraints of the dynamics model are incorporated into the trajectory planning process to achieve point-to-point trajectory planning for the UCR. The results show that the trajectory of the improved algorithm is smooth and derivable, and the end-effector is stationary and stable without oscillation at the start and end points, which proves the effectiveness of the optimized algorithm.