Abstract
Mobile cabledriven parallel robots (MCDPRs) is a novel concept of cabledriven parallel robots (CDPRs) developed by mounting several mobile bases to discrete the conventional fixed frame. However, the additional mobile bases introduce more degreeoffreedom (DoF), thereby causing the kinematic redundancy. Moreover, mobile bases are susceptible to disturbances causing inconsistent performance. Hence, path planning of MCDPRs becomes a challenging issue due to various internal and external constraints involved. In this article, an optimizationbased path planning method is proposed for MCDPRs in highly constrained environments with considering kinematic stability. The proposed approach quickly generates feasible paths for coupled mobile bases by using the developed multiagent rapidly exploring random tree (MARRT). In this process, the tree can share information through the heuristics method to optimize the path, and the adaptive sampling strategy is thus proposed to increase the tree growth efficiency by selfadjusting sampling space. Moreover, the developed dynamic control checking method (DCC) is integrated with MARRT to smooth the path and the kinodynamic constraints of mobile bases can be satisfied. To generate the path of the endeffector, two performance metrics are designed considering the kinematic and stability of the MCDPR. Based on the performance metrics, the gridbased search method is developed to generate the path for the endeffector. Finally, the convincing performance of the proposed method is revealed through the dynamic simulation software (CoppeliaSim) and realworld experiments based on a selfbuilt MCDPR prototype.
Similar content being viewed by others
Avoid common mistakes on your manuscript.
Introduction
Cabledriven parallel robots (CDPRs) are categorized as a particular type of parallel manipulator. In CDPRs, multiple flexible cables that reel around a fixed winchpulley system are responsible for actuating the endeffector to the desired position. Owing to the large workspace and higher payloadtoweight ratio, CDPRs are promising for several industrial applications such as picking and placing heavy loads, grasping, space and terrestrial applications [1,2,3].
Although CDPRs provide significant advantages in numerous applications, several challenges still exist. As an example, CDPRs are generally available with a large workspace, which imposes a strong requirement for the safety issue [4]. The radiate structure of cables increases the risks of cable–cable and cable–environment interferences, especially when CDPRs have a large number of cables in a cluttered environment [5]. Due to the conventional CDPRs having a fixed frame, the cable span dominates a large space during the motion of the endeffector [6], which results in restricted flexibility for CDPR.
Consequently, CDPRs require further development to improve adaptation to environmental and task requirements [7]. Based on the concept of reconfiguration, reconfigurable cabledriven parallel robots (RCDPRs) were developed, in which the cable’s attachment points on the frame and the cable’s anchor points on the endeffector of pulleys can be altered [8]. However, the existing RCDPR systems have limited reconfigurability, such as having a guideway with limited length or requiring manual intervention. These drawbacks of conventional RCDPRs lead the reconfigurable operations to be timeconsuming and costly to use.
To extend the reconfigurability of RCDPRs, as shown in Fig. 1, a mobile cabledriven parallel robot (MCDPR) is developed in this work to make it automatically be configured according to the desired task. The developed MCDPR is composed of a six degreeoffreedom (DoF) endeffector pulled by eight cables mounted on four mobile bases. A mobile base consists of a differential wheeled robot and a lifting column. Thus, MCDPR can be moved freely with the wheeled robots, and the position of the pulley can be adjusted by using the lifting column.
However, the kinematical redundancy of MCDPRs is increased due to more DoF given by additional mobile bases. These mobile bases are coupled to each other by multiple cables, resulting in complex constraints and a highdimension regime. In addition, the mobile base is susceptible to cable tension and becomes unstable, which also affects the available workspace for MCDPRs [9]. Hence, the path planning of MCDPRs becomes a challenging problem and requires to be addressed. In consequence, for displacing the endeffector from the starting point to its destination, feasible and optimal paths are required to be generated for each mobile base and the endeffector simultaneously.
For CDPRs, path planning is a challenging issue due to various constraints such as cable tension, workspace, collisions, and obstacle avoidance. In particular, MCDPRs involve in the highdimensional cooperative pathfinding problem as a result of the coupled mobile bases and endeffector. Accordingly, Jiang et al [10] developed a dynamic pointtopoint trajectory planning point trajectory planning method for a CDPR with six DoF. More recently, Idà et al. [11] proposed a resttorest trajectory planning method of CDPRs with the given motion time and path profile. However, these studies only considered an underactuated CDPR in an environment without obstacles.
In a cluttered environment, it is critical for CDPRs to avoid obstacles. However, MCDPRs involve multiple moving parts such as cables and the endeffector must avoid the obstacles simultaneously. Furthermore, the multiple mobile bases of MCDPRs introduce more constraints increasing the complexity of the path planning problem. On the other hand, the samplingbased path planning algorithms perform well to deal with various constraints by randomly sampling the state space [12, 13]. Compared with other path planning techniques, they need less time to conduct the computation and can avoid obstacle accurately. The most representative samplingbased path planning algorithm is the Rapidly exploring Random Tree (RRT) method, which relies on a feasible checking module to generate a series of candidate trajectories for constructing a graph framework [14]. However, the conventional RRT method generally generates a path that comprises a significant number of redundant nodes. To address the optimality issue, some extensions of RRT like RRT* and informed RRT* are developed to obtain an asymptotically optimal solution [15, 16].
Accordingly, Bak et al. [17] proposed a modified RRT method to generate feasible paths for CDPRs, which takes advantage of the goalbiased sampling method and postprocessing to mitigate the length of the path. Zhang et al. [18] designed a new dexteritybased cost function to accomplish collisionfree path planning for CDPR by combining RRT* and potential field guidance (PFG) methods. Recently, Mishra et al. [19] proposed an AFGRRT* method to generate optimized paths for CDPRs in cluttered environments. However, the abovecited methods only deal with the path planning for the endeffector, the multiple mobile bases and additional constraints are not involved.
For MCDPRs, the additional mobile bases lead to kinematical redundancy, and the path planning problem for MCDPRs becomes incrementally challenging. Rasheed et al. [20] developed an iterative algorithm to generate available paths for MCDPR. This approach is straightforward to traverse all possible predefined states of each mobile base, and the next state is identified by maximizing the wrench capacity. However, the traversal time cost increases exponentially with the possible states of the mobile bases and the quality of the obtained path is not desirable. To improve the path quality, the Direct Transcription method was proposed in [21], in which the trajectory is discretized according to the specific time step and the resulting paths are obtained by minimizing the goal function with a set of given constraints, but the optimizationbased method is commonly timeconsuming in terms of convergence.
In this work, we present an optimal samplingbased path planning algorithm for MCDPR. The proposed approach is capable of efficiently handling the multiple constraints and kinematic redundancies associated with the robot. In summary, the contributions of this paper are listed as follows:

(1)
First, an innovative highdimensional tree structure is proposed in this paper. A distinctive characteristic is that we maintain the tree growth in the highdimensional state space while preserving the tree to share information in the lowdimensional domain. Based on the growth state of the tree, we deploy a heuristic cost that allows the tree to be sampled adaptively in the subspace. Hence, the proposed method can generate the feasible path in a short time.

(2)
Second, various constraints of MCDPR such as mobile base/mobile base, mobile base/obstacle, cable/obstacle collisions, and the available configuration are considered. The dynamic control checking method is developed to smooth the path and satisfy kinodynamic constraints of the robot. Moreover, the heuristic method is designed to optimize the path and ensure the continuity of parent nodes. The optimal and smooth path can thus be obtained.

(3)
Third, two performance metrics are developed considering the stability and kinematics of MCDPR. Based on the performance metrics, the path of the endeffector is generated by using the proposed gridsearch method. Finally, the resulting paths are simulated in complex scenarios using the MCDPR dynamic model developed by CoppeliaSim software and validated by prototype experiments.
The remainder of this paper is organized as follows: Robot parameterization and problem formulation are introduced in Section “System modeling” . The kinematics and stability model for MCDPRs is established in Section “Consideration” . In Section “Method description”, the proposed path planning method for MCDPRs is introduced in detail. The method validation is carried out in Section “Method validation”. Finally, Section “Conclusion and future work” concludes the research work.
System modeling
MCDPR parameterization
The selfbulit MCDPR in this work is composed of a classical redundantly constrained CDPR with eight cables (\(m=8\)) and a six DoF movingplatform (\(n=6\)) mounted on four mobile bases (\(p=4\)). As depicted in Fig. 2, the origin of the global coordinate system is represented as \(O_{0}\) and the local coordinate system located at the center of the endeffector is denoted as \(O_{e}\). The jth mobile base, denoted as \(\mathscr {M}_j\), \(j = 1,...,4\) carries two cables (\(m_{j}=2\)) and has three wheels (\(c=3\)) including one caster wheel and two driven wheels. The local coordinate system attached to \(\mathscr {M}_j\) is denoted as \(O_{pj}\). The mobile base is characterized as the nonholonomic differential drive mechanism, it can provide two DoF translational motions and one DoF rotational motion.
Cables are assumed to be straight and massless. The endeffector is modeled as a cube. The cable exit point and the anchor point are represented as \(A_{ij}\) and \(B_{ij}\), respectively. Thus, ith cable vector attached onto \(\mathscr {M}_j\) is denoted as \({\varvec{l}}_{ij}\), \(i=1,...m_{j}\).
Selecting the ith closedloop vector branch, \({\varvec{l}}_{ij}\) can be expressed as follows
where \({\varvec{a}}_{ij}\) is the position vector of \(A_{ij}\) in \(O_{0}\) coordinate system. \({\varvec{P}}\) and \(\varvec{{R}}\) is a threedimensional position vector and rotation matrix of the endeffector, respectively. \({}^{e}{\varvec{b}}_{ij}\) represents the position vector of \(B_{ij}\) in the moving coordinate system \(O_{e}\). To simplify the problem, we restrict the endeffector only perform the translational motion in this work.
Problem formulation
Due to the MCDPR is designed such that \(A_{ij}\) is lie on the axis \({}^{pj}z\) of \(\mathscr {M}_j\), the rotational of \(\mathscr {M}_j\) has no effect on \({\varvec{u}}_{ij}={\varvec{l}}_{ij}/\Vert {\varvec{l}}_{ij}\Vert \), which is the unit vector along the cable \({\varvec{l}}_{ij}\). We consider the state of mobile bases \(\mathscr {M}_j\) at kth time step is \({\varvec{m}}_{j,k}=[{}^{0}{{x}_{{{j,k}}}}, {}^{0}{{y}_{{{j,k}}}}]\), \(k=1,...,N\). The state of the mutirobot system constructed by mobile bases at kth time step is represented as \({\varvec{M}}_{k}=[{\varvec{m}}_{1,k}^T, {\varvec{m}}_{2,k}^T, {\varvec{m}}_{3,k}^T,{\varvec{m}}_{4,k}^T]^T \) in \(\mathbb {R}^{2p}\) and the state of the endeffector at kth time step is \({\varvec{P}}_{k}=[{}^{0}{{x}}_{k},{}^{0}{{y}}_{k},{}^{0}{{z}}_{k}]\). Consequently, the state of MCDPR at kth time step can be denoted as \({{{\varvec{X}}}_{k}}=[{\varvec{P}}_{k}^{T}, {\varvec{M}}_{k}^{T}]^T\).
The MCDPR involves various internal and external constraints that require to be considered during the path planning. To facilitate the computation, the mobile base and the obstacles are modeled as cylindrical structures. Hence, at each time step, the following constraints are imposed for jth mobile base
Where (2–4) impose the distance constraints of the MCDPR in terms of mobile base/mobile base, mobile base/obstacle and cable/obstacle. \(L_m\) denotes the safety distance between two mobile bases. \(r_m\) and \(r_q, q=1,...,s\), represent the radius of the mobile base and the qth obstacle, respectively. \({\varvec{o}}_q\) represents the position of qth obstacle. \(\varvec{c_k}\) and \(\varvec{b_k}\) denotes the two closest point between MCDPR and obstacles at kth time step, respectively. Hence, (2) and (3) prevent the collision between mobile bases/mobile bases and mobile bases/obstacles. (4) prevent the collision between cables/endeffector with obstacles by using the minimum acceptable distance \(L_c\). Furthermore, (5) and (6) indicate that the CDPR have limited workspace and cable length, respectively. Let \(l_{min}\) and \(l_{max}\) denote the minimum and maximum length of cable. \(h_l,l=1,2\), denotes two constant heights of exit point \(A_{i,j}\) in the \(O_{0}\) coordinate system. For each \({\varvec{M}}_{k}\), the available workspace of the endeffector is given by \({\mathcal {W}}_k\).
Additionally, the MCDPR also requires to satisfy the nonholonomic and configuration constraints. Let \({\varvec{d}}_{k}={\varvec{m}}_{j,k}{\varvec{m}}_{j,k1}\) denotes the directional vector of \(\mathscr {M}_{j}\) between two adjacent states, (7) prevents the abrupt direction change of the mobile base to satisfy the nonholonomic constraints by using the maximum turning angle \(\beta _{max}\). As a result of mobile bases are coupled with cables, the MCDPR should maintain the initial formation shown in Fig. 3a, and the infeasible formation illustrated in Fig. 3b and c should be prevented to cause internal interferences, which indicates that the intersection of the line segment formed by connecting two mobile bases. We consider \(\theta _{j}\in [0,2\pi ]\) is the interior angle of \(\mathscr {M}_{j}\) shown in Fig. 3a is defined by (9), and \(\theta _{j}=\theta _{j}+2\pi \) if \(\theta _{j}<0\), (8) ensures the mobile bases do not cross each other during the motion.
The composite state space of MCDPR \({\varvec{X}}={\varvec{M}}\times {\varvec{P}} \subset \mathbb {R}^{2p+3}\) is the Cartesian product of the individual spaces. We denote the free composite state space that satisfies constraints defined in (2–8) is \({\varvec{X}}_{free}\subseteq {\varvec{X}}\). Then, the optimal path planning problem for MCDPR is to find the feasible trajectory \(\pi :[0,t]\rightarrow {\varvec{X}}_{free}\) from an initial state \(\pi (0)={\varvec{X}}_{init}\) to the goal region \(\pi (t)\in {\varvec{X}}_{goal}\) that minimizes a given optimal function and obeys the system dynamics. In this work, the optimal function is defined to minimize the total path length.
Consideration
Kinematics performance
Due to additional mobile bases lead the kinematical redundancy of the MCDPR, the kinematics performance indicator is designed in this subsection to ensure excellent kinematics performance. Derivative of (1) with respect to time and lead the endeffector only perform translational motion, the velocity of the endeffector \(\dot{{\varvec{P}}}=[{}^{0}\dot{x}_{e}, {}^{0}\dot{y}_{e}, {}^{0}\dot{z}_{e}]^T\) can be expressed as follows
where \(\varvec{\dot{l}}_{j}=[\varvec{\dot{l}}_{1j},...,\varvec{\dot{l}_{m_{j}j}} ]^T\) denotes the speed vector of the cables on \(\mathscr {M}_j\), and \({\varvec{J}}_{j}\) can be expressed as
where \({\varvec{J}}_{j}\in \mathbb {R}^{m_j\times {2}}\) is the subJacobian matrix associated with the cable actuation wrench on \(\mathscr {M}_j\). The kinematic jacobian matrix of the carried CDPR can be expressed as \({\varvec{J}}=[{\varvec{J}}_{1},...,{\varvec{J}}_{j}]^T\), which is associated with a specific position of the endeffector to map relationship from the endeffector velocity to the cable velocities.
Based on the kinematic jacobian matrix of the carried CDPR, the kinematic performance indicator is defined as the dexterity of the mechanism, which measures the accuracy of transmission between cable space and the Cartesian space of the endeffector. The dexterity of the robot can be obtained by the condition number of \({\varvec{J}}\), denoted as
where, \({\lambda }_{max}\) is the maximum eigenvalues of square matrix \({\varvec{J}}^{T}{\varvec{J}}\), and \({\sigma }_{max}\) is the maximum singular value of \({\varvec{J}}\). The condition number of kinematic Jacobian matrix \(\kappa \in [1,\infty )\). Thus, \(\kappa \) is normalized to define the kinematics performance index \(\gamma _{k} \) expressed as
The better the kinematics performance can be obtained when \(\gamma _{k}\) is closer to 1, and the robot loses its control when \(\gamma _{k}=0\). Consequently, the larger \(\gamma _{k}\) should be remained during the path planning.
Stability performance
The additional mobile bases lead the MCDPR highly flexible. However, the mobile base is susceptible to cable tension and becomes unstable. Thus, the static equilibrium of the mobile base with its tipping condition is analyzed in this section to guarantee the better stability performance.
Figure (4) illustrates the free body diagram of jth mobile base. \({\varvec{t}}_{ij}=t_{ij}{\varvec{u}}_{ij}\) denote the cable tension vector along the cable \({\varvec{l}}_{ij}\), and \(t_{ij}\) is the cable tension. We define the wheel contact points of the mobile base \(\mathscr {M}_{j} \) as \(C_{nj}\), \(n=1,2,3\), in a counterclockwise direction, and \({\varvec{c}}_{nj}\) denotes the Cartesian coordinate vector of \(C_{nj}\). The boundary between two successive contact points \(C_{nj}\) and \(C_{n+1j}\) is expressed as the \(\mathscr {L}_{C_{nj}}\), and the direction is described by \({\varvec{u}}_{C_{nj}}\). The equilibrium towards the tipping of a wheeled robot can be calculated by using ZeroMoment Point (ZMP) method [22], which depends on the moments generated at the boundaries. We consider \({\varvec{m}}_{C_{nj}}\) is the moment when \(\mathscr {M}_{j} \) loses contact with the ground that does not constitute the boundary \(\mathscr {L}_{C_{nj}}\),
where \({\varvec{g}}_{j}\) denotes the Cartesian coordinate vector of the center of gravity in \(\mathscr {M}_{j} \). \({\varvec{w}}_{gj}\) is the weight vector of \(\mathscr {M}_{j} \). To guarantee \(\mathscr {M}_{j} \) in static equilibrium, the following constraints are required to be satisfied.
Equation (16) denotes the tipping conditions of \(\mathscr {M}_{j} \), it can be regarded as linear constraints in terms of the cable tensions \(t_{ij}\). In general, the cable tensions are all bounded between a minimum and positive tension \(t_{min}\) and a maximum tension \(t_{max}\). The feasible tension space of \(\mathscr {M}_{j} \) is represented as a square with side length \(\Delta t=t_{max}t_{min} \). However, as shown in Fig. 5, the linear constraints in (16) reduce the feasible tension space to form the feasible tension polygon. We denote the area of \(\mathscr {M}_{j} \)’s feasible tension polygon is \(\mathscr {F}_{j} \). Since the cable tension has infinite solutions due to redundant actuation, we define the riskiest feasible tension polygon as
where \(\mathscr {F}_{r}\) indicates the feasible tension polygon with the smallest area, which can be obtained by corresponding vertices(i.e., \({\textbf {v}}_{13},{\textbf {v}}_{23},{\textbf {v}}_{33}\) in Fig. 5c). This polygon corresponds to a mobile base that is the most unstable to the cable tension and has a risk of tipping phenomenon. Hence, the stability performance of MCDPR can be defined as
It can be observed from (18) that MCDPR is at the nest stability performance when \(\gamma _{s}=1\). However, when \(\gamma _{s}=0\), the MCDPR will tip and lose control due to the cable tension solution not satisfying the static equilibrium.
Method description
In this section, the path planning method of MCDPRs is described in detail. In Algorithm 1, the mutiagent RRT is proposed to generate feasible path \({\varvec{M}}_{path}=(^p{\varvec{M}}_{1},^p{\varvec{M}}_{2},...,^p{\varvec{M}}_{N})\) for mobile bases. For each state of mobile bases on the path \(^p{\varvec{M}}_{k}\), the position of endeffector \(^p{\varvec{P}}_{k}\) is determined by using the gridbased search method presented in Algorithm 3 with considering kinematic stability. Moreover, the corresponding highlevel diagram of the proposed method is depicted in Fig. 6.
Path planning for mobile bases
The proposed multiagent method aims to build a treestructured graph \({\mathcal {T}}({\mathcal {V}},{\mathcal {E}})=({\mathcal {T}}_1,...,{\mathcal {T}}_4)\) by randomly sampling the state space. The vertices \({\mathcal {V}}\) represent feasible states of mobile bases \({\varvec{M}}_k\), and the edge \({\mathcal {E}}\) denotes the feasible transitions of two adjacent states. \({\mathcal {T}}_j,j=1,...,4\), denotes a subtree of \(\mathscr {M}_j\).
In Algorithm 1, the feasibility of the initial and goal state of mobile bases are checked first. Then, some attributes are assigned to vertices. \( {\varvec{M}}_{new}.\text {GoalArrived}\) is used to determine the arrival status of four mobile bases. The jth element of \( {\varvec{M}}_{new}.\text {GoalArrived}\) is changed to 1 when \(\mathscr {M}_j\) arrive its goal point, and \(\mathscr {M}_j\) becomes fixed. \(M_{new}.\text {FailureRate}\) is the ratio of the number of failed expansions to total expansions. \({\varvec{M}}_{new}.\text {GoalExtend}\) is used to record whether the node can expand toward the goal point, and it changes to 1 if the expansion fails.
To solve the highdimensional state space and increase efficiency, the adaptive sampling method (line 6 of Algorithm 1) is designed in Algorithm 2. The random node of \(\mathscr {M}_j\),\({\varvec{m}}_{rand,j}\), is assigned as the goal point if the parent node can successfully expand to the goal point. Otherwise, the proposed method can adaptively select two sampling methods based on \({\varvec{M}}_{parent}.\text {GoalExtend}\) and \({\varvec{M}}_{parent}.\text {FaiureRate}\). It should be noted that the proposed method is sampling in the subspace for each mobile base and integrated into highdimensional space.
The ForwardSector(\({\varvec{m}}_{goal,j}\), \(r_{s}\),\(\theta _s\)) expands the sampling space to a sector to guide the tree towards the goal space in which the vertex is the goal point and \({\varvec{m}}_{c,j}\) denotes the subnode with maximum cost. \(r_{s}\) and \(\theta _s\) represent the radius and angle of the sector, representatively.The BackwardBall(\({\varvec{m}}_{centor}\), \(r_b\)) represents uniformly sampling in a circular area centered on the \({\varvec{m}}_{centor}\) with radius \(r_{b}\), and \({\varvec{m}}_{f}\) is the subnode with maximum failure rate. Thus, the proposed method favors BackwardBall(\({\varvec{m}}_{centor}\), \(r_b\)) with the \({\varvec{M}}_{parent}.\text {FaiureRate}\) increasing.
Dynamic control checking and heuristic path optimization
In contrast to the conventional RRT, the Nearest( \({\varvec{M}}_{rand}\),\({\mathcal {T}}\),\(V_j\)) function (line 7 of Algorithm 1) returns a node \({\varvec{M}}_{nearest}\) closest to \({\varvec{M}}_{rand}\) by searching the remained tree to lead the mobile base fixed after it reaches the target, and the starting node of the remained tree is recorded as \(V_j\) (line 29 of Algorithm 1). In addition, to smooth the path and satisfy the kinodynamic constraints, the Steer(\({\varvec{M}}_{nearest}\),\({\varvec{M}}_{rand}\)) function in Algorithm 1 is developed based on the dynamic control checking method. As shown in Fig. 7a, each node on the tree has a set of possible control output \({\mathcal {U}}(u_k,\epsilon )\), which is constrained by the control input from the parent node and the inherent control constraints of the mobile base. According to the kinematic model of the mobile base [23], each control output \(u_k\) corresponds to an expected state \({\varvec{M}}_k\), which is determined by
where \({\varvec{m}}_{check,j}\) is a temporary control checking node associated with \(\mathscr {M}_j\) in the new node \({\varvec{M}}_{new}\). \({\varvec{m}}_{1}\) and \({\varvec{m}}_{2}\) are the two arbitrary node, \({\varvec{v}}_{1}\) is the unit vector with angle of \({\varvec{m}}_{1}\). This cost function evaluates the distance and smoothness between two nodes. Hence, by using (19) and (20), \({\varvec{M}}_{new}\) and the optimal control output \(u_{new}\) is obtained. One should note that \({\mathcal {U}}(u_k,\epsilon )\) is assigned as null if \({\varvec{M}}_{parent}.\text {GoalArrived}[j]=1\) to ensure the mobile base is fixed once it reaches goal points.
In line 1120 of Algorithm 1, the Heuristic method is proposed to optimize the path by using neighbor vertices. After a feasible new node \({\varvec{M}}_{new}\) is generated. The neighbor vertices of \({\varvec{M}}_{new}\), \({\mathcal {M}}_{near}\) are obtained by using a given search radius \(r_c\). Each \({\varvec{m}}_{near,j}\) directly connected to \({\varvec{m}}_{new,j}\) and the \({\varvec{m}}_{near,j}\) with minimum heuristic cost remained, in which \(h({\varvec{M}}_{new})\) indicates the total path length from \({\varvec{M}}_{init}\) to \(h({\varvec{M}}_{new})\). However, setting \({\varvec{m}}_{near,j}\) as the parent node could change the structure of the tree causing vertices disjunction. In this work, we propose ReSetParent() to reset the passed vertices on the edge ( \({\varvec{m}}_{near,j}\), \({\varvec{m}}_{new,j}\)), which is not change the parent node and thereby ensure the stability of the tree structure.
The proposed heuristic method in this study differs from the conventional neighborhood optimization method used in the RRT* algorithm in two key aspects. Firstly, the RRT* algorithm typically utilizes path length as its cost function without considering the feasibility of robot control, but the MCDPR is significantly more flexible and incorporates multiple constraints. As a result, the cost function in this study was enhanced, and control feasibility was taken into account. Secondly, the rewiring process in RRT* has the potential to change the parent node and thus alter the timestamp. To ensure the stability of the tree structure, the ReSetParent() function was introduced. This function enables us to reset the passed vertices on the edge, preventing changes to the parent node while maintaining the integrity of the tree structure. By implementing this additional step, we can effectively address the issue of changing timestamps that may arise during the rewiring process.
Figure 7 illustrates the proposed method, we use two subtrees to represent two mobile bases for simplicity. As shown in Fig. 7a, the neighbor vertices of \({\varvec{m}}_{8,1}\) and \({\varvec{m}}_{8,2}\) is obtained to optimize path. Thus, two path (\({\varvec{m}}_{3,1}\),\({\varvec{m}}_{8,1}\)) and (\({\varvec{m}}_{3,2}\),\({\varvec{m}}_{8,2}\)) with minimum cost can be found. The parent vertices \({\varvec{m}}_{7,1}\), \({\varvec{m}}_{7,2}\) is reset and check in Fig. 7b by using \({\varvec{m}}_{reset,j}={\varvec{m}}_{reset,j}.parent+\eta ({\varvec{m}}_{reset,j}.child{\varvec{m}}_{reset,j}.parent)\), in which \(\eta \) is initialized to 1/2. However, if \({\varvec{m}}_{reset,j}\) is not feasible, \(\eta \) is a random number ranging from 0 to 1. Moreover, due to the adaptive sampling method, the tree tends to grow toward the goal. As shown in Fig. 7c, the first tree has arrived but the second tree is not. In this case, the next sampling will be expanded on the remained vertices \({\varvec{m}}_{10,2}\) on the second tree. Finally, the algorithm is terminated when each tree has reached its target point shown in Fig. 7d.
Generation of the endeffector optimal path
After the RRT tree \({\mathcal {T}}\) is obtained from Algorithm 1, the path for mobile bases \({\varvec{M}}_{path}\) can be generated by consecutively finding \({\varvec{M}}_{parent}\) from the root of the tree. In this work, a kinematic stability index \(\gamma \) is used to determine the position of the endeffector, which is expressed as follows
Based on the kinematic stability index \(\gamma \), a gridbased search method is developed in Algorithm 3 to generate the path for the endeffector \({\varvec{P}}_{path,p},p=1,...,N\). The proposed algorithm traverses each state on the path of mobile bases \({\varvec{M}}_{path,p}\) that corresponds to a specific CDPR configuration to maximize \(\gamma \). For each configuration, we first determine a search area \({\mathcal {S}}_p\) with radius \(r_s\), and the center of the \({\mathcal {S}}_p\) depends on the last endeffector position \({\varvec{P}}_{path,n1}\). Thus, \({\mathcal {S}}_p\) is different in each \({\varvec{M}}_p\), which ensures smoothness and continuity of the path. For each \({\mathcal {S}}_p\), we discrete \({\mathcal {S}}_p\) to obtain \(Q_{p}\) cells \(\{c_{1},...,c_{Q}\}\), and traverse each cell find the largest \(\gamma \). It should be noted that some cells may not be feasible due to the cable/endeffector colliding with obstacles, which is considered in line 6 of Algorithm 3.
The path obtained through the endeffector is optimal due to the use of the gridbased search method and a kinematic stability index. Specifically, the kinematic stability index \(\gamma \) is used to determine the position of the endeffector, and a gridbased search method is developed to generate the path for the endeffector by maximizing \(\gamma \) at each configuration along the path of the mobile bases. By maximizing \(\gamma \), the algorithm ensures that the endeffector is positioned in a kinematically stable configuration at each point along the path. Additionally, the use of the gridbased search method ensures that the path is smooth and continuous. Together, these factors suggest that the path obtained through the endeffector is optimal in terms of kinematic stability and smoothness/continuity.
Method validation
Initialization setup and results
In this section, we conduct a number of simulations to demonstrate the effectiveness and efficiency of the proposed algorithm. Figure 8 illustrates the cluttered environment with the dynamic model of our MCDPR prototype developed using CoppeliaSim (formerly known as VREP) robot simulator software [24]. The cluttered environment is composed of ten obstacles and these obstacles are modeled as cylinders with three different radii, 0.15 m, 0.25 m, and 0.45 m. These obstacles have an identical height 0.4 m, and the position of obstacles is randomly assigned. The five goal points for the MCDPR are given around the dark blue obstacle that is denoted as a target obstacle in which the robot can perform the task on it, i.e., picking and/or releasing operations.
The proposed method is initialized using parameters given in Table 1. For the consecutive state transition from \({\varvec{X}}_{k}\) to \({\varvec{X}}_{k+1}\), \(\Delta T\) should be relatively small to obtain high accuracy, thereby \(\Delta T=0.2\) is used in this work. For each \(^p{\varvec{M}}_{path}\), it could determine the coordinates of a set of pulleys by using \(h_1=0.285\) m and \(h_2=0.926\) m. Accordingly, the mass center of the mobile base can be directly obtained from the MCDPR dynamic model in CoppeliaSim given by \([0.12, 0.34, 0.36]^T\) with respect to \(O_pj\) coordinate system. Hence, \(\gamma _{k}\) and \(\gamma _{s}\) can be computed in each \(^p{\varvec{M}}_{path}\). The simulation result is illustrated in Fig. 9, it is found that a feasible path is generated for each mobile base to reach their goal points and the path of the endeffector is determined by maximizing \(\gamma \). Due to the limitation of the length of the cable making MCDPR impossible to separate through large obstacles, one should note that the MCDPR adaptively performs integration mode and separation modes in Fig. 9.
To simplify the problem, the endeffector is modeled as a point to perform collision detection. Due to the endeffector was restricted to only perform the translational motion in x, y, and z direction, and the rotation of the endeffector is not considered. The x and y motion of the endeffector were depicted in Fig. 9 and the zcoordinate of the endeffector was shown in Fig. 10. The MCDPR is a type of parallel robot for which the inverse kinematics, as expressed in equations (1) and (10), can be readily determined. As a result, when given a set of threedimensional coordinates for the endeffector, it is possible to calculate the corresponding cable length and cable speed using these equations. This enables precise control of the endeffector’s translational motion through the manipulation of cable length and speed.
The three minimum distances about mobile bases/mobile bases, mobile bases/obstacles, and cables/obstacles is illustrated in Fig. 11, it can be found that the distance constraints of (2), (3), and (4) can be satisfied. Moreover, the change of four interior angles is shown in Fig. 12, it can be seen that \(\theta _1,\theta _2,\theta _3,\theta _4\in [0,\pi ]\), thereby the MCDPR configuration constraints defined by (4) is thus fulfilled.
MCDPR Verification in CoppeliaSim and experiments
In this section, the resulting MCDPR trajectories obtained from the last section are simulated in CoppeliaSim environment to verify the proposed method and the corresponding experiment is carried out. The software simulation framework is depicted in Fig. 14. For controlling the mobile bases, the continuous velocity profiles of the mobile bases are converted into the rotational velocities of the mobile base’s wheels by using its kinematic model. As shown in Fig. 13, the continuous velocity profiles of the mobile bases and the endeffector are guaranteed due to the postprocessing. One should note that these mobile bases do not arrive at the goal points at the same time. Moreover, for controlling the endeffector, we utilize (1) and (10) to adjust the length and speed of cables shown in Fig. 15.
The obtained wheels’ rotational velocities are sent to the revolute joints associated with wheels to control the mobile bases in CoppeliaSim. Additionally, the length of the cable can be adjusted by prismatic joints associated with cables. Hence, the MCDPR model is actuated by these joints. The state of MCDPR can be directly obtained from the CoppeliaSim during the motion, it will be compared with the desired path to obtain the error.
The clips of the simulation in CoppeliaSim are shown in Fig. 17, it can be seen that the MCDPR can follow the desired paths and avoid the collision. Moreover, Fig. 16 illustrates the error between the actual path of the MCDPR from the simulation and the desired path, the maximum error about the mobile base and the endeffector is approximately 3.8 cm. Thus, the feasibility and stability of the proposed path planning method can be verified.
The proposed approach is validated experimentally on our selfbuilt MCDPR, a scenario is designed as the MCDPR pass through the first obstacle shown in Fig. 9. The NVIDIA Jetson Nano\(^TM\) Developer Kit is adopted as a control computer to operate our MCDPR system, in which the designed cable length and mobile base velocities are sent to control MCDPR. The experimental results are shown in Fig. 18, it can be seen that the MCDPR is smooth and stable passing the obstacle and the total time is 24 s. Before the experiment, the cable was pretensed to 20 N, and the cable tension change measured from the load cell sensor during the experiment is shown in Fig. 19. It can be seen that the cable tension remains positive in the experiment and has a continuous profile. These results verify that the proposed method is feasible and effective.
Batch evaluation
In this section, the proposed path planning method for MCDPRs is compared with other existing methods. Due to the stochastic nature of the proposed method, a batch evaluation of 1000 simulations is performed and the proposed method is evaluated using the average value. All the simulations are performed using \(\textcircled {c}\)MATLAB with CPU computations on an Intel ®i79750 CPU@2.60GHz and 32GB RAM Windows 10 system. The identical initialization parameters defined in the previous simulations are used in these simulations.
The results of the batch evaluation are summarized in Table 2. Comparing the proposed method with the Iterative Algorithm and Direct Transcription, the proposed method reduced the CPU time by 88.7% and 79.8%, respectively. This is due to the developed adaptive sampling strategy leading the tree to grow towards the goal points. Iterative Algorithm and Direct Transcription require complex iterative processes for optimization which may become computationally more expensive with the increase of obstacles in the environment. However, the proposed method does not require an iterative search but constructs the feasible tree by adaptively exploring the state space. It should be noted that the Iterative algorithm and the Direct Transcription method resulted in the mobile base and the endeffector reaching the target point simultaneously. In our method, the growth of the subtree is terminated when it reaches the goal point. Furthermore, it can be observed that the average global performance index \(\gamma \) of the total path is improved by 56.12% and 34.21% with respect to the Iterative Algorithm and Direct Transcription. Therefore, the proposed path planning method can contribute to better stability and kinematic performance of MCDPRs.
The proposed algorithm incorporates a heuristic optimization approach to enhance the efficiency of the MCDPR path. The results demonstrate a 46.81% decrease in path length compared to the Iterative Algorithm. Although the Direct Transcription method outperforms the proposed algorithm in terms of path length due to its broader optimization radius and iterative process, the proposed method only differs by 4.51% from Direct Transcription. Moreover, the proposed algorithm offers several advantages, including faster CPU time and improved average \(\gamma \), which offset the minor difference in path length. These results highlight the ability of the proposed method to optimize path, enhance computational efficiency, and ensure kinematics stability simultaneously.
Conclusion and future work
In this work, an optimal path planning method is proposed for MCDPRs to generate feasible paths in constrainted environments with considering kinematic stability. The proposed method utilizes a heuristic approach to optimize the path, and the adaptive sampling method is developed to enhance efficiency. Hence, the various constraints of MCDPR can be considered in detail and the kinematic stability is maximized by using designed performance indicators. The proposed method was validated by simulations and subject to realworld testing on a selfbuilt MCDPR prototype. The results show that the proposed approach can generate feasible paths for mobile bases and the endeffector in a shorter time. Compared to other existing methods, the proposed method provides better kinematic stability performance and efficiency on the premise of minimizing the path length. Therefore, the reliability of the proposed method was verified.
One should note that the proposed method is developed in a static environment in which the position of the obstacle is known. Moreover, the proposed method can be extended to a variety of multiagent systems, such as UAVs. However, it is imperative for individuals to tailor the algorithm to the specific system by adjusting the cost function and constraint equations as necessary. This enables the algorithm to effectively accommodate the distinct characteristics and demands of the system. In future work, it is desirable to develop the realtime path planning method for MCDPR in a dynamic environment with the moving obstacle. To fulfill this purpose, a continuous localization system for MCDPR is also required to be designed in the future.
Data availability
The data that support the findings of this study are available upon request from the corresponding author. Restrictions apply to the availability of these data, which were used under license for the current study, and so are not publicly available. Data are however available from the authors upon reasonable request and with permission of KyoungSu Park (pks6348@gachon.ac.kr).
References
Zhang Z, Shao Z, Wang L, Shih AJ (2018) Optimal design of a highspeed pickandplace cabledriven parallel robot. In: cabledriven parallel robots: proceedings of the third international conference on cabledriven parallel pobots, Springer International Publishing, pp 340–352
Chawla I, Pathak P, Notash L, Samantaray A, Li Q, Sharma U (2021) Workspace analysis and design of largescale cabledriven printing robot considering cable mass and mobile platform orientation. Mechanism and machine theory 165:104426
Piao J, Jin X, Choi E, Park JO, Kim CS, Jung J (2018) A polymer cable creep modeling for a cabledriven parallel robot in a heavy payload application. In: CableDriven Parallel Robots: Proceedings of the Third International Conference on CableDriven Parallel Robots, Springer International Publishing, pp 62–72
Winter DL, Ament C (2021) Development of Safety Concepts for CableDriven Parallel Robots. In: Cabledriven parallel robots: Proceedings of the 5th International Conference on CableDriven Parallel Robots, Springer International Publishing, Cham, pp 360–371
Bury D, Izard JB, Gouttefarde M, Lamiraux F (2019) “Continuous collision detection for a robotic arm mounted on a cabledriven parallel robot,” arXiv:1909.10857
Lesellier M, Gouttefarde M (2019)“A bounding volume of the cable span for fast collision avoidance verification,” In: International Conference on CableDriven Parallel Robots. Springer, pp. 173–183
Pedemonte N, Rasheed T, MarquezGamez D, Long P, Hocquard É, Babin F, Fouché C, Caverot G, Girin A, Caro S (2020) Fastkit: a mobile cabledriven parallel robot for logistics. Advances in robotics research: from lab to market. Springer, New York, pp 141–163
Gagliardini L, Gouttefarde M, Caro S (2018) Design of reconfigurable cabledriven parallel robots’’. Mechatronics for cultural heritage and civil engineering. Springer, New York, pp 85–113
Rasheed T, Long P, MarquezGamez D, Caro S (2018) Tension distribution algorithm for planar mobile cabledriven parallel robots. In: Cabledriven parallel robots: Proceedings of the Third International Conference on CableDriven Parallel Robots, Springer International Publishing, pp 268–279
Xiang S, Gao H, Liu Z, Gosselin C (2020) Dynamic pointtopoint trajectory planning for three degreesoffreedom cablesuspended parallel robots using rapidly exploring random tree search. J Mech Robot 12:4
Idà E, Bruckmann T, Carricato M (2019) Resttorest trajectory planning for underactuated cabledriven parallel robots. IEEE Trans Robot 35(6):1338–1351
Lin Y, Saripalli S (2017) Samplingbased path planning for uav collision avoidance. IEEE Trans Intell Transp Syst 18(11):3179–3192
Jaillet L, Cortés J, Siméon T (2010) Samplingbased path planning on configurationspace costmaps. IEEE Trans Robot 26(4):635–646
LaValle Steven M (1998) Rapidlyexploring random trees: A new tool for path planning 98–11
Karaman S, Frazzoli E (2011) Samplingbased algorithms for optimal motion planning. Int J Robot Res 30(7):846–894
Gammell JD, Srinivasa SS, Barfoot TD (2014)“Informed rrt*: Optimal samplingbased path planning focused via direct sampling of an admissible ellipsoidal heuristic,” In: 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems. IEEE, pp. 2997–3004
Bak JH, Hwang SW, Yoon J, Park JH, Park JO (2019) Collisionfree path planning of cabledriven parallel robots in cluttered environments. Intell Service Robot 12(3):243–253
Zhang B, Shang W, Cong S (2018) “Optimal rrt* planning and synchronous control of cabledriven parallel robots,” In: 2018 3rd International Conference on Advanced Robotics and Mechatronics (ICARM). IEEE, pp. 95–100
Mishra UA, Mishra U, Métillon M, Caro S (2021) et al., “Kinematic stability based afgrrt* path planning for cabledriven parallel robots,” In: The 2021 IEEE International Conference on Robotics and Automation (ICRA 2021)
Rasheed T, Long P, MarquezGamez D, Caro S (2019) “Path planning of a mobile cabledriven parallel robot in a constrained environment,” In: International Conference on CableDriven Parallel Robots. Springer. pp 257–268
Rasheed T, Long P, Roos AS, Caro S (2019) “Optimization based trajectory planning of mobile cabledriven parallel robots,” In: 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, pp. 6788–6793
Kajita S, Kanehiro F, Kaneko K, Fujiwara K, Harada K, Yokoi K, Hirukawa H (2003) “Biped walking pattern generation by using preview control of zeromoment point,” In: 2003 IEEE International Conference on Robotics and Automation (Cat. No. 03CH37422). vol. 2. IEEE, pp. 1620–1626
Malu SK, Majumdar J (2014) Kinematics, localization and control of differential drive mobile robot. Glob J Res Eng 14(H1):1–7
Rohmer E, Singh SP, Freese M (2013) “Vrep: A versatile and scalable robot simulation framework,” In: 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems. IEEE, pp. 1321–1326
Acknowledgements
This study was supported by the National Research Foundation of Korea(NRF) grant funded by the Korea government. (MSIT) (2021R1A2C2013053).
Author information
Authors and Affiliations
Corresponding author
Ethics declarations
Conflict of interest
There is no conflict of interest.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Open Access This article is licensed under a Creative Commons Attribution 4.0 International License, which permits use, sharing, adaptation, distribution and reproduction in any medium or format, as long as you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons licence, and indicate if changes were made. The images or other third party material in this article are included in the article’s Creative Commons licence, unless indicated otherwise in a credit line to the material. If material is not included in the article’s Creative Commons licence and your intended use is not permitted by statutory regulation or exceeds the permitted use, you will need to obtain permission directly from the copyright holder. To view a copy of this licence, visit http://creativecommons.org/licenses/by/4.0/.
About this article
Cite this article
Xu, J., Kim, BG., Lu, Y. et al. Optimal samplingbased path planning for mobile cabledriven parallel robots in highly constrained environment. Complex Intell. Syst. 9, 6985–6998 (2023). https://doi.org/10.1007/s40747023011143
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s40747023011143