Hostname: page-component-cd9895bd7-hc48f Total loading time: 0 Render date: 2024-12-23T19:38:06.752Z Has data issue: false hasContentIssue false

The optimal path of robot end effector based on hierarchical clustering and Bézier curve with three shape parameters

Published online by Cambridge University Press:  21 February 2022

Vahide Bulut*
Affiliation:
Department of Engineering Sciences, Izmir Katip Celebi University, Cigli, Izmir 35620, Turkey
Rights & Permissions [Opens in a new window]

Abstract

Recent improvements in robotic arms have increased their interest in many areas such as the industry and biomedical sectors. Path planning is an essential part of the robotic arm, since most automated factories seek to move things from one place to another with obstacles providing the shortest route. This paper presents a novel optimal path planning algorithm based on the 3D cubic Bézier curve with three shape parameters and its geometric properties and hierarchical clustering. The proposed method utilizes a feature vector which is obtained from curvature, torsion, and path length of candidate curves. A hierarchical clustering is applied to determine curve pairs. Then, a multi-objective function is used to determine the best curve pair, which gives the best curve for the robotic arm. Besides forming the optimal 3D cubic Bézier path, the optimal ruled and developable path surfaces are obtained. In addition to presenting theoretical results, this work also demonstrates the proposed method on several Kinova Gen3 robotic arm cases.

Type
Research Article
Creative Commons
Creative Common License - CCCreative Common License - BY
This is an Open Access article, distributed under the terms of the Creative Commons Attribution licence (http://creativecommons.org/licenses/by/4.0/), which permits unrestricted re-use, distribution and reproduction, provided the original article is properly cited.
Copyright
© The Author(s), 2022. Published by Cambridge University Press

1. Introduction

In recent years, robotic arms have risen their importance because of their need in many areas such as the military, industry, and medical areas. Trajectory planning is one of the key problems in robotics. Robotic motion planning has been studied for a long time, and many important contributions have been made [Reference Latombe1]. Different applications of collision-free path planning are studied for both vehicles and mobile robots [Reference Cai, Chen, Qin, Xie and Xu2, Reference Li, Wu and Luo3, Reference Yulong, Chen, Xuewu, Yahui and Xiangkun4, Reference Ma, Perruquetti and Zheng5, Reference Achour6, Reference Simba, Sano and Uchiyama7].

Achour [Reference Achour6] focused on path optimization by genetic algorithm to determine the optimal path for mobile robots. A visibility graph and Bezier curves-based method are proposed by Simba et al. [Reference Simba, Sano and Uchiyama7] to form a collision-free smooth trajectory for wheeled mobile robots. Kim et al. [Reference Han, Park, Kim and Kim8] proposed a motion planning algorithm for robot manipulators and applied it to 2-DOF and 3-DOF manipulators. Also, they designed smoother and shorter paths. In ref. [Reference Costa, Lima, Silva, Neto and Moreira9], they present a graph search algorithm based on the A-star algorithm to calculate the shortest path for pick-and-place operations with obstacles in the work environment. An optimal path is determined in terms of genetic algorithms to reduce the number of steps taken from the initial point to the goal point in ref. [Reference AL-Taharwa, Sheta and Al-Weshah10]. Hayat and Kausar [Reference Hayat and Kausar11] presented a simulated annealing-based algorithm in an environment with circular shape obstacles. For mobile robots, the Markov Decision Process-based probabilistic formal models for three different avoiding obstacles strategies are given by Wang et al. [Reference Wang, Wang, Guan and Li12] in an uncertain dynamic environment. Sun et al. [Reference Sun, Liu, Tian and Zhang13] presented the new artificial potential field method to obtain an optimal path that provides avoiding moving obstacles and the local minimum problem. A novel avoiding obstacles-based algorithm is proposed for path planning and path following for 2D and 3D navigation in ref. [Reference Sgorbissa14].

We expressed the differential geometric analysis of the trajectories on terrain for the autonomous wheel-legged robots in ref. [Reference Bulut15]. Moreover, we gave the relationship between the consecutive wheel center curves and the optimum posture of the MHT robot. An ant colony merged with the artificial potential field method-based path planning algorithm is proposed for lunar robots to determine the shortest path besides obtaining the reduced convergence speed in the environment with dynamic obstacles in ref. [Reference Zhu, Zhu, Zhang and Cao16]. Xie et al. [Reference Xie17] presented an algorithm for the multi-joint manipulator to obtain the optimal path to avoid obstacles in a workspace. Hyejeong [Reference Ryu18] expressed an effective hierarchical path planning method for mobile robots in 2D complex environments.

Curve-based methods are also used for path planning. The solution is based on finding a collision-free path curve between the starting and goal points. Miura proposed a method that focuses on forming a smooth collision-free path between the initial and end point in 2D or 3D space using the support vector machines [Reference Miura19]. Some researchers have used parametric curves, for instance, Bezier [Reference Han, Yashiro, Nejad, Do and Mita20, Reference Elhoseny, Tharwat and Hassanien21] and Clothoid [Reference Shimizu, Kobayashi and Watanabe22] curves, since they are flexible to generate smooth obstacle-avoided paths in complex workspaces. This study also focuses on the curve-based method to obtain a smooth collision-free path curve between the starting and goal points in an environment with obstacles.

Determining the position, velocity, and acceleration of the robotic arm is crucial during the motion. On the other hand, when a robotic arm needs to be moved along a predetermined path, many candidate trajectories might be possible that the robot can follow. Several researchers have recently focused on Bézier curves for path planning due to easy calculations besides passing from the starting and goal points and lying within their control polygons. Hu et al. [Reference Hu, Li, Han and He23] expressed a novel path planning method based on the Bézier curve and a two-layer planning framework. In ref. [Reference Cassany, Moze, Aioun, Guillemard, Moreau, Melchior and Victor24], a Bézier curve optimization method is presented for obstacle avoidance problems. A trajectory planning method with Bézier curve and cubic spline is presented in ref. [Reference Wei, Wang, Zhang, Xu, Zhang, Liu, Chen and Wang25]. They also compared the performance of these trajectory plannings, transition paths, the velocity of the end effector, and joint angle position. It is not possible to generate multiple Bezier curves with different shapes for the same control polygon. The control points are needed to be changed to alter the curve’s shape. Therefore, the classical Bézier curves are deficient in terms of flexibility to control the shape of the curve. However, flexibility is often demanded to optimize and fine-tune the paths. Hence, modifiable Bézier curves with shape parameters have been formed in refs. [Reference Yang and Zeng26, Reference Chen and Wang27]. We studied the path planning, and velocity, acceleration, and jerk of autonomous ground vehicles in the environment with obstacles using the quintic trigonometric Bézier curve with its two shape parameters and $C_{3}$ continuity in ref. [Reference Bulut28]. Also, we compared velocity, lateral acceleration and jerk, and longitudinal jerk of the predefined quintic and cubic Bézier, besides quintic trigonometric Bézier and cubic paths.

1.1. Contribution

Robotic arms are special, and the most utilized parts of robots, and they are widely used in manufacturing and production. This paper proposes a new method to find the optimal path for a robotic arm. We adopt geometric and hierarchical clustering approaches for path planning. Our main contributions are as follows:

  • The 3D cubic Bézier curve with three shape parameters is used for path planning. A novel path planning algorithm is called Optimal Path Planning with Hierarchical clustering (OPA-H) is presented.

  • The algorithm generates the optimal path based on the shape parameters of the Bézier path and the feature vector composed of the curvature, torsion, and the Bézier path length.

  • The hierarchical clustering method based on the feature vector is used to determine the optimal path pair candidates, since the bottom-up clustering method is needed.

  • The proposed method determines the most modifiable path curve among other path curves according to the multi-objective function.

  • Using the optimal 3D cubic Bézier path with three shape parameters, the optimal ruled and developable path surfaces are presented. Also, the relationship between the shape parameters and developability degree is presented.

The rest of the paper is arranged as follows. In Section 2, the Bézier curve with three shape parameters and its properties are given. The proposed method is expressed in Section 3, while Section 4 presents an experimental work. Ruled and developable path surfaces are generated in Section 5. Finally, Section 6 concludes this work.

2. Cubic Bézier curve with three shape parameters

In this section, the definition and properties of cubic Bézier curve with three shape parameters are expressed likewise in ref. [Reference Yang and Zeng26].

2.1. Cubic Bézier basis functions with three shape parameters

Definition 1. The Bernstein basis functions of $t,\:t\in\left[0,1\right]$ with degree three and three shape parameters are defined as:

(1) \begin{equation}\begin{cases}b_{0}(t)= & (1-t)^{3}\left(1-\lambda_{1}t\right)\\[8pt]b_{1}(t)= & 3(1-t)^{2}t\left[1+\dfrac{\lambda_{1}}{3}(1-t)-\dfrac{\lambda_{2}}{2}t\right]\\[18pt]b_{2}(t)= & 3(1-t)t^{2}\left[1+\dfrac{\lambda_{2}}{2}(1-t)-\dfrac{\lambda_{3}}{3}t\right]\\[12pt]b_{3}(t)= & t^{3}\left[1+\lambda_{3}(1-t)\right]\end{cases}\end{equation}

where $-2<\lambda_{1}<1$ , $-1<\lambda_{2}<2$ , and $-1<\lambda_{3}<3$ . Figure 1 shows the curves of the Bernstein basis functions with degree three for different values of $\lambda_{1}$ , $\lambda_{2}$ , and $\lambda_{3}$ .

Figure 1. The Bernstein basis functions with degree three for $\lambda_{1}=-1.5$ , $\lambda_{2}=1$ , $\lambda_{3}=-0.8$ (solid lines), for $\lambda_{1}=-1$ , $\lambda_{2}=-0.5$ , $\lambda_{3}=1.5$ (dashed lines) and for $\lambda_{1}=0.7$ , $\lambda_{2}=1.5$ , $\lambda_{3}=2.5$ (dotted lines).

Theorem 1. The basis functions in the Eq. (1) have the following properties:

  1. 1. Nonnegativity: $b_{i}(t)\geq0,\,i=0,1,2,3$ .

  2. 2. Partition of unity: $\sum\limits_{i=0}^{3} b_{i}(t)\equiv1$ .

  3. 3. Symmetry: $b_{i}(t)=b_{3-i}(1-t),\:\lambda_{i}=-\lambda_{3-i+1}$ .

  4. 4. For $\lambda_{i}=0$ , the basis functions in the Eq. (1) correspond to the original Bernstein basis functions.

Proof. For $t\in\left[0,1\right]$ , and $-2<\lambda_{1}<1$ , $-1<\lambda_{2}<2$ and $-1<\lambda_{3}<3$ , it is obvious from the Eq. (1) that the proofs of the Theorems 1.1, 1.3, and 1.4 can be seen in ref. [Reference Yang and Zeng26]. For the Theorem 1.2:

$\sum\limits_{i=0}^{3} b_{i}(t)=1+ \sum\limits_{i=1}^{3}\lambda_{i}\left(\frac{1}{3-i+1}(1-t)B_{i,3}(t)-\frac{1}{i}tB_{i-1,3}(t)\right)\equiv1$ , in which $B_{i,3}(t)$ and $B_{i-1,3}(t)$ are the original Bernstein basis functions.

2.2. Properties of cubic Bézier curve functions with three shape parameters

Definition 2. The cubic Bézier curve with three shape parameters is defined by:

(2) \begin{equation}\boldsymbol{r}(t)= \sum\limits_{i=0}^{3}\boldsymbol{P}_{i}b_{i}(t),\:t\in\left[0,1\right],\,\lambda_{1}\in\left(-2,1\right),\,\lambda_{2}\in\left(-1,2\right),\,\lambda_{3}\in\left(-1,3\right)\end{equation}

where $\boldsymbol{P}_{i}$ is control points in $R^{2}$ or $R^{3}$ .

Proposition 1. The cubic Bézier curve with three shape parameters have the following properties:

  1. 1. Interpolation at the end point and tangent at the end edge;

  2. 2. Convex hull property;

  3. 3. Geometric and affine invariance;

  4. 4. Symmetry;

  5. 5. For $\lambda_{i}=0$ , the cubic Bézier curve in (2) corresponds to the original cubic Bézier curve.

Proof. The proofs of all the above properties can be easily obtained in ref. [Reference Yang and Zeng26].

The shape parameters $\lambda_{1}$ , $\lambda_{2}$ , and $\lambda_{3}$ provide the local control on the cubic Bézier curve according to Proposition 3 in ref. [Reference Yang and Zeng26] as shown in Fig. 2.

Figure 2. Effect of the altered shape parameters on the shape of the cubic Bézier curve.

Proposition 2. A regular curve $\boldsymbol{r}(t)$ is given in $R^{3}$ . The curvature of this curve is defined by:

(3) \begin{equation}\kappa=\frac{\left\Vert \boldsymbol{r}^{\prime\prime}\times\boldsymbol{r}^{\prime}\right\Vert }{\left\Vert \boldsymbol{r}^{\prime}\right\Vert ^{3}}\end{equation}

where the $\times$ and denote the cross product and $\dfrac{d}{dt}$ , respectively.

Proof. The proof of this proposition can be obtained from ref. [Reference Pressley29].

Proposition 3. A regular curve $\boldsymbol{r}(t)$ is given with nowhere-vanishing in $R^{3}$ . The torsion of this curve is given by:

(4) \begin{equation}\tau=\frac{\left(\boldsymbol{r}^{\prime}\times\boldsymbol{r}^{\prime\prime}\right).\boldsymbol{r}^{\prime\prime\prime}}{\left\Vert \boldsymbol{r}^{\prime}\times\boldsymbol{r}^{\prime\prime}\right\Vert ^{2}}.\end{equation}

Proof. The proof of this proposition can be found from ref. [Reference Pressley29].

Definition 2. The arc length of a curve $\boldsymbol{r}(t)$ starting at the point $\boldsymbol{r}\left(t_{0}\right)$ is given by the function $L(t)$ as [Reference Pressley29]:

(5) \begin{equation}L(t)= \int\limits_{t_{0}}^{t} \left\Vert \boldsymbol{r}^{\prime}\left(u\right)\right\Vert du.\end{equation}

The curvature and the torsion of the cubic Bézier curve with three shape parameters can be calculated using the Eqs. (3) and (4). Since the Bézier curve has shape parameters, the curvature and the torsion of this curve will be affected. Figure 3 shows the influence of the three shape parameters on curvature and torsion of cubic Bézier curve.

Figure 3. The curvature and the torsion curves of the cubic Bézier curve for different values of shape parameters.

3. Optimal path planning based on cubic Bézier curve with three shape parameters and hierarchical clustering

The robotic arm trajectory can be planned using the cubic Bézier curve when the robotic arm is transformed from the starting point to the end point. The first and last control points of the Bézier curve can be considered the starting and the goal points, respectively, while the other control points can be considered obstacles. Cubic Bézier curve trajectories of the robotic arm will be affected due to shape parameters. Hence, we can control and modify the trajectories of the robotic arm to obtain the optimal path. If we have more than two obstacles, we can obtain more trajectories since we have various control points. Besides obstacles, altering shape parameters will allow us to form even more trajectories, as seen from Fig. 4.

Figure 4. Different trajectories according to various obstacles and shape parameter values.

3.1. Proposed method

Hierarchical clustering is a clustering method that finds successive clusters using a predetermined ordering from top to bottom. These successive clusters can be presented as a tree called a dendrogram. The divisive and the agglomerative hierarchical clustering are the clustering types, where the former constructs the dendrogram top-down and the latter constructs the dendrogram bottom-up. Agglomerative hierarchical clustering generates the dendrogram by taking each element as a separate cluster and then merging them iteratively. On the other hand, the divisive hierarchical clustering generates the dendrogram by taking the data as a single cluster and then separating this cluster into successively smaller clusters iteratively [Reference Ranka, Singh and Alsabti30].

The optimal path planning method can be carried out using a cubic Bézier curve with three shape parameters and hierarchical clustering. Different curve pairs with the same control points are generated with different shape parameters, since the main goal is to control the path.

Suppose that the robotic arm’s starting and goal points and obstacles placed in the workspace are known. Note that this study focuses on general cases, that is, extreme cases are not included, such as all obstacles placed through a line between starting and goal points. Next, several cubic Bézier curves are formed according to the obstacles in the workspace and altered by changing the shape parameters randomly within their range given as in the Eq. (2). The feature vector F, including the curvature, torsion, and path length of each curve, is obtained for each curve, using Eqs. (3), (4), and (5):

(6) \begin{equation} F = \left[\kappa, \tau, L \right] \end{equation}

Moreover, we need to check whether any obstacle collides to the optimal curve pair candidate and remove them if they collide with obstacles. To cluster the optimal path candidates, the hierarchical clustering method is used. The multi-objective function value $OP_{sum} = OP_{1} + OP_{2}$ for each curve pair is determined using the following equation for $i=1, 2$ :

(7) \begin{align} OP_{i} & = \alpha_{1}O_{Ji} + \alpha_{2}O_{\kappa i} + \alpha_{3}O_{di}+ \alpha_{4}O_{Li}\nonumber\\[3pt] & = \alpha_{1}\left(\int_{u_{s}}^{u_{f}}\left\Vert j\left(u\right)\right\Vert^{2} du \right) + \alpha_{2}\left( \int_{u_{s}}^{u_{f}}\left\Vert \kappa\left(u\right)\right\Vert^{2} du\right)\nonumber \\[3pt] & \quad + \alpha_{3} \left( mean\left(\sum_{i=1}^{4} d_{i} \right)\right) + \alpha_{4}\left( \int_{a}^{b}\left\Vert \boldsymbol{r}^{\prime}\left(u\right)\right\Vert du\right),\quad \left(i=1,2 \right) \end{align}

inwhich the coefficient values are denoted by $\alpha_{i}$ , $\left( i=1,2,3,4\right)$ and provide $\sum_{i=1}^{4}\alpha_{i} = 1 $ . Also, $O_{Ji}$ , $O_{\kappa i}$ , $O_{di}$ , and $O_{Li}$ , $\left(i=1,2 \right) $ are the objective functions according to the jerk, curvature, Euclidean distance to the original line path passes through the obstacles, and path length for the optimal path candidate pairs, respectively. The optimum curve is the one with the minimum OP value between two path candidate pairs as in Eq. (8):

(8) \begin{equation} OP_{\min} = \min \left\lbrace OP_{1},OP_{2}\right\rbrace \end{equation}

where OP1 and OP2 belongs to $OP_{sum}$ that has the minimum value. The steps of the proposed method are given in Algorithms 1, 2, and 3. Algorithm 1 computes the multi-objective function for the optimal path candidates.

If the optimal path can not be determined after the selected iteration number, the proposed Optimal Path Algorithm with Hierarchical Cluster (OPA-H) should be executed again with different shape parameters. The proposed OPA-H is shown in Algorithm 2:

To check whether any obstacle collides to the optimal curve pair candidate, the Algorithm 3 is utilized.

The original line path, which is the convex hull of the cubic Bézier path, passes through the waypoints, which are obstacles, and therefore this path collides with the obstacles. Hence, the cubic Bézier curve with three shape parameters is used to obtain the optimal path because this curve does not collide with other obstacles, since this curve does not pass through the control points except the starting and end points.

We need to obtain the optimal path candidate pairs among different path candidates. Therefore, this study utilizes hierarchical clustering, since it is the most appropriate method for using the bottom-up approach. The optimal path is selected during experiments regarding the multi-objective function among the path candidates. The optimal path provides efficiency and flexibility because it provides more options by altering shape parameters and controlling the optimal path besides minimizing the multi-objective function. Users can adjust path length, jerk, acceleration, which is related to the curvature of the path, and smoothness, which is related to the curvature and torsion, based on the shape parameters. The reason is that altering the shape parameters without changing the obstacles offers different options to the user to control the path, such as if the user desires to control the jerk increasing the $\alpha_{1}$ coefficient value, the user may determine the optimal path by altering the shape parameters as it is done in Tables II, 4, and 6.

4. Experimental results

In this section, three worked example applications are presented according to the OPA-H algorithm. For this purpose, the collision-free path candidates are obtained for the Kinova Gen3 robotic arm in Fig. 5.

Figure 5. Kinova Gen3 robotic arm.

We assume that the workspace and the positions of the obstacles for the Kinova Gen3 robotic arm are known in advance.

4.1. Example 1

Let the starting and the goal points be $\boldsymbol{P}_{0}=\left(27.25,\,9,\,14\right)$ and $\boldsymbol{P}_{19}=\left(37.25,\,29,\,29\right)$ , respectively. Also, the obstacles in the workspace are given in the matrix form by the following Eq. (9) as:

(9) \begin{equation}O=\left[\begin{array}{ccc}\boldsymbol{P}_{1}=\left(31,19,18\right); & & \boldsymbol{P}_{2}=\left(17,24,14\right)\\[3pt]\boldsymbol{P}_{3}=\left(17,24,21\right); & & \boldsymbol{P}_{4}=\left(27,20,18\right)\\[3pt]\boldsymbol{P}_{5}=\left(27,12,23\right); & & \boldsymbol{P}_{6}=\left(18,22,17\right)\\[3pt]\boldsymbol{P}_{7}=\left(22,15,12\right); & & \boldsymbol{P}_{8}=\left(22,14,22\right)\\[3pt]\boldsymbol{P}_{9}=\left(23,19,18\right); & & \boldsymbol{P}_{10}=\left(23,16,16\right)\\[3pt]\boldsymbol{P}_{9}=\left(15,18,25\right); & & \boldsymbol{P}_{10}=\left(9,13,12\right)\\[3pt]\boldsymbol{P}_{11}=\left(21,21,28\right); & & \boldsymbol{P}_{12}=\left(11,19,7\right)\\[3pt]\boldsymbol{P}_{13}=\left(20,24,11\right); & & \boldsymbol{P}_{14}=\left(14,14,26\right)\\[3pt]\boldsymbol{P}_{15}=\left(13,19,9\right); & & \boldsymbol{P}_{16}=\left(24,28,15\right)\\[3pt]\boldsymbol{P}_{17}=\left(10,13,4\right); & & \boldsymbol{P}_{18}=\left(13,29,24\right)\end{array}\right].\end{equation}

In this example, we generated 10 cubic Bézier path candidates where each path takes the points $\boldsymbol{P}_{0}$ and $\boldsymbol{P}_{19}$ as the starting and the goal points, and each row of the matrix in the Eq. (9), which corresponds to obstacles, like other control points of the path of the robotic arm. Next, we carried out the proposed method (OPA-H) given in the Algorithm 2 by changing the shape parameters randomly within their range. The results can be seen from the following Table I. Here, the curves in each row represent the curves that have the same control points with different shape parameters.

Table I. Test results.

The best values are shown in bold face.

As seen from Table I, the curve pair $\left\{r_{4},r_{14}\right\} $ in row 9 has the minimum multi-objective value, which is $1.2976$ . Note that this value is the sum of $OP_1$ and $OP_2$ . From this pair $r_{14}$ is selected as the optimal curve, since it has lower OP value than $r_{4}$ .

On the other hand, the optimal path between $r_{4}$ and $r_{14}$ can be obtained for the Kinova Gen3 robotic arm using its joints velocities and accelerations from the Fig. 6.

Figure 6. Trapezoidal position, velocity, and acceleration profiles of seven joints of the Kinova Gen3 robotic arm for the paths $r_{4}$ (straight) and $r_{14}$ (dashed).

Figure 7. The optimal path $r_{14}$ for different values of the shape parameters in Table I.

As seen from Fig. 6 and Table I, the path $r_{14}$ , which is obtained according to the multi-objective using the proposed algorithm, is the optimum one for the robotic arm. The optimal path $r_{14}$ can be controlled via three shape parameters as given in Table I and can be seen from different perspectives in Fig. 7.

If all shape parameters are accepted as zero, the curve transforms to the classical Bézier curve CBC. The proposed method provides flexibility to fine-tune the optimal path regarding user requirements, which are given by the multi-objective function in the Eq. (7), for the robotic arm in the workspace. This study compares the optimal curve for different shape parameters and the CBC in path length. Therefore, Fig. 8 presents the superiority of the optimal curve to the CBC due to its flexibility which means we can fine-tune the optimal curve according to the priorities of the user, such as velocity, acceleration, jerk, or path length. Because shape parameters are real numbers, they can have an infinite number of values in their range.

Figure 8. The path lengths of the optimal path $r_{14}$ for different values of the shape parameters and the CBC (black).

Also, the path lengths of the optimal path and CBC are given in Table II.

Table II. The comparision of optimal curve with different shape parameters and CBC.

As seen from Table II, we have different options to alter the path besides providing being more productive in terms of the multi-objective function in (7) than the CBC.

4.2. Example 2

In this example, let the initial and the end points $\boldsymbol{P}_{0}=\left(5,\,0.5,\,2\right)$ and $\boldsymbol{P}_{19}=\left(16,\,10,\,10\right)$ be given, respectively. Also, the obstacles placed in the workspace are given in the below Eq. (10):

(10) \begin{equation}O = \left[\begin{array}{ccc}\boldsymbol{P}_{1}=\left(12,5,5\right); & & \boldsymbol{P}_{2}=\left(3,8,8\right)\\[5pt]\boldsymbol{P}_{3}=\left(10,8,8\right); & & \boldsymbol{P}_{4}=\left(6,12,12\right)\\[5pt]\boldsymbol{P}_{5}=\left(-2,4,8\right); & & \boldsymbol{P}_{6}=\left(-4,5,12\right)\\[5pt]\boldsymbol{P}_{7}=\left(2,4,6\right); & & \boldsymbol{P}_{8}=\left(4,5,7\right)\\[5pt]\boldsymbol{P}_{9}=\left(13,4,6\right); & & \boldsymbol{P}_{10}=\left(14,5,7\right)\\[5pt]\boldsymbol{P}_{9}=\left(15,6,8\right); & & \boldsymbol{P}_{10}=\left(17,15,7\right)\\[5pt]\boldsymbol{P}_{11}=\left(16,3,3\right); & & \boldsymbol{P}_{12}=\left(18,10,5\right)\\[5pt]\boldsymbol{P}_{13}=\left(2,3,3\right); & & \boldsymbol{P}_{14}=\left(5,10,5\right)\\[5pt]\boldsymbol{P}_{15}=\left(26,26,6\right); & & \boldsymbol{P}_{16}=\left(28,28,8\right)\\[5pt]\boldsymbol{P}_{17}=\left(-6,-6,6\right); & & \boldsymbol{P}_{18}=\left(-8,-8,8\right)\end{array}\right].\end{equation}

We again generated ten cubic Bézier path candidates where each path takes the points $\boldsymbol{P}_{0}$ and $\boldsymbol{P}_{19}$ as the starting and the goal points, and each row in (10) as other control points for the robotic arm. Next, the proposed method OPA-H in the Algorithm 2 was carried out to determine optimal path curve pair in terms of feature vector by changing the shape parameters randomly within their range. The results are given in Table III.

Table III. Test Results.

The best values are shown in bold face.

The curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ will be the optimal curve as seen from Table III. Moreover, even the optimal path can be determined based on the multi-objective function between $r_{5}$ and $r_{15}$ , it can be supported using the robotic arm’s joints velocities and accelerations in Fig. 9.

Figure 9. Trapezoidal position, velocity, and acceleration profiles of seven joints of the Kinova Gen3 robotic arm for the paths $r_{5}$ (straight) and $r_{15}$ (dashed).

The path $r_{5}$ is the optimum path for the given robotic arm. The optimal path $r_{5}$ can be controlled via three shape parameters as given in Table III and can be seen from different perspectives in Fig. 10.

Figure 10. The optimal path $r_{5}$ for different values of the shape parameters in Table III.

Figure 11 presents the superiority of the optimal curve to the CBC based on flexibility.

Figure 11. The path lengths of the optimal path $r_{5}$ for different values of the shape parameters and the CBC (black).

Additionally, the path lengths of the optimal path and CBC are given in Table IV.

As seen from the Table IV, the shape parameters give opportunity to control the optimal path besides providing being more productive in terms of the multi-objective function in (7) than the CBC.

Table IV. The comparison of optimal curve with different shape parameters and CBC.

4.3. Example 3

Assume that the starting and the goal points are given as $\boldsymbol{P}_{0}=\left(10,\,0,\,0\right)$ and $\boldsymbol{P}_{19}=\left(40,\,40,\,0\right)$ , respectively. Also, the positions of obstacles in the environment are placed by the following equation:

(11) \begin{equation} O=\left[\begin{array}{ccc} \boldsymbol{P}_{1}=\left(40,0,15\right); & & \boldsymbol{P}_{2}=\left(0,40,8\right)\\[5pt] \boldsymbol{P}_{3}=\left(10,8,8\right); & & \boldsymbol{P}_{4}=\left(10,30,12\right)\\[5pt] \boldsymbol{P}_{5}=\left(-2,4,8\right); & & \boldsymbol{P}_{6}=\left(-4,5,12\right)\\[5pt] \boldsymbol{P}_{7}=\left(2,4,6\right); & & \boldsymbol{P}_{8}=\left(4,5,7\right)\\[5pt] \boldsymbol{P}_{9}=\left(13,4,6\right); & & \boldsymbol{P}_{10}=\left(14,5,7\right)\\[5pt] \boldsymbol{P}_{9}=\left(15,6,8\right); & & \boldsymbol{P}_{10}=\left(17,15,7\right)\\[5pt] \boldsymbol{P}_{11}=\left(16,3,3\right); & & \boldsymbol{P}_{12}=\left(18,10,5\right)\\[5pt] \boldsymbol{P}_{13}=\left(2,3,3\right); & & \boldsymbol{P}_{14}=\left(5,10,5\right)\\[5pt] \boldsymbol{P}_{15}=\left(26,26,6\right); & & \boldsymbol{P}_{16}=\left(28,28,8\right)\\[5pt] \boldsymbol{P}_{17}=\left(-6,-6,6\right); & & \boldsymbol{P}_{18}=\left(-8,-8,8\right) \end{array}\right]. \end{equation}

Some obstacles have the same positions as in Example 2. Our goal with this example is to present the case in which the starting and goal points, besides some obstacles, are farther away from each other than the other two examples. Similarly, 10 cubic Bézier path candidates are formed where each path takes the points $\boldsymbol{P}_{0}$ and $\boldsymbol{P}_{19}$ as the starting and the goal points, and each row in (11) indicates other control points for the robotic arm. Next, the proposed method OPA-H in the Algorithm 2 is applied to determine optimal path curve pair in terms of feature vector by changing the shape parameters randomly within their range. The results are given in Table V.

Table V. Test results.

The best values are shown in bold face.

The curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ will be the optimal curve as seen from Table V regarding to $OP_{sum}$ .

Additionally, the optimal path between $r_{5}$ and $r_{15}$ can be enforced by using the robotic arm’s joints velocities and accelerations in Fig. 12, although it can be reliazed using the multi-objective function.

Figure 12. Trapezoidal position, velocity, and acceleration profiles of seven joints of the Kinova Gen3 robotic arm for the paths $r_{5}$ (straight) and $r_{15}$ (dashed).

The path $r_{15}$ is the optimum path for the given robotic arm. The optimal path $r_{15}$ can be controlled via three shape parameters as given in Table V and can be seen from different perspectives inFig. 13.

Figure 13. The optimal path $r_{15}$ for different values of the shape parameters in Table V.

Figure 14 presents the superiority of the optimal curve to the CBC based on flexibility.

Figure 14. The path lengths of the optimal path $r_{15}$ for different values of the shape parameters and the CBC (black).

Moreover, the path lengths of the optimal path and CBC are given in Table VI.

Table VI. The comparision of optimal curve with different shape parameters and CBC.

As seen from Table VI, the shape parameters give opportunity to control the optimal path besides providing being more productive in terms of the multi-objective function in (7) than the CBC.

5. Construction of Bézier ruled and developable ruled surfaces

Since the robotic arm’s end effector’s tip traces a path during the motion, the end effector generates a robot pose ruled surface using this path. Therefore, this section will form optimal Bézier ruled and developable ruled surfaces for the optimal Bézier curve pairs obtained in Examples 1, 2, and 3. Before expressing the process, the definitions of ruled and developable ruled surfaces are given in Section 5.1.

5.1. Ruled and developable ruled surfaces

Definition 3. A union of straight lines is called a ruled surface. Straight lines are called rulings of the ruled surface [Reference Pressley29]. A ruled surface is defined by:

(12) \begin{equation}\boldsymbol{R}(v,t)=\boldsymbol{r}(t)+v\boldsymbol{d}(t)\end{equation}

in which $\boldsymbol{r}(t)$ is the directrix or base curve and $\boldsymbol{d}(t)$ is the direction vector of the ruling at each point on the directrix. Alternatively, the ruled surface can be represented as:

(13) \begin{equation}\boldsymbol{R}(v,t)=(1-t)\boldsymbol{r}_\boldsymbol{A}(t)+v\boldsymbol{r}_\boldsymbol{B}(t),\:v,t\in\left[0,1\right]\end{equation}

where $\boldsymbol{r}_\boldsymbol{A}$ and $\boldsymbol{r}_\boldsymbol{B}$ are directrices, and $\boldsymbol{r}(t)=\boldsymbol{r}_\boldsymbol{A}(t)$ and $\boldsymbol{d}(t)=\boldsymbol{r}_\boldsymbol{B}(t)-\boldsymbol{r}_\boldsymbol{A}(t)$ .

Definition 4. Developable surfaces are surfaces that unfolded onto a plane without stretching or tearing. For developable ruled surfaces, the tangent plane is constant along with each ruling. Cylinders, cones, and planes are the most known developable surfaces. A ruled surface is called developable ruled surface if and only if the vectors $\boldsymbol{r}^{\prime}(t)$ , $\boldsymbol{d}(t)$ , and $\boldsymbol{d}^{\prime}(t)$ are linearly independent, that is [Reference Chalfant31]

(14) \begin{equation}\left|\boldsymbol{r}^{\prime}(t)\:\boldsymbol{d}(t)\:\boldsymbol{d}^{\prime}(t)\right|=0\end{equation}

5.2. The optimal Bézier ruled and developable ruled surface path of robotic arm

The optimal curves in Examples 1 and 2 are determined using the proposed method OPA-H. Next, the optimal shortest robot pose ruled surface can be obtained using the Eq. in (13). If the only one shape parameter of the directrix curve $\boldsymbol{r}_\boldsymbol{A}(t)$ is altered to find the other directrix curve $\boldsymbol{r}_\boldsymbol{B}(t)$ , the condition in the Eq. (14) will be satisfied. Consequently, the optimal developable robot pose ruled surface will be obtained.

Figure 15 shows the robot pose ruled surface and developability degree for the curve pair $\left\{ \boldsymbol{r}_{4},\boldsymbol{r}_{14}\right\} $ in Example 1. Since the developability degree is different than zero (see Fig. 15(b)), the robot pose ruled surface (see Fig. 15(a)) is not a developable robot pose ruled surface.

Figure 15. The robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{4},\boldsymbol{r}_{14}\right\} $ with the shape parameters $\lambda_{1}=-1.2258$ , $\lambda_{2}=0.2262$ , $\lambda_{3}=0.3796$ and $\lambda_{1}^{*}=-1.2134$ , $\lambda_{2}^{*}=0.8085$ , $\lambda_{3}^{*}=0.8449$ .

If the shape parameters are changed such as $\lambda_{1}=-1.2258$ , $\lambda_{2}=0.2262$ , $\lambda_{3}=0.3796$ and $\lambda_{1}^{*}=-1.2258$ , $\lambda_{2}^{*}=0.2262$ , $\lambda_{3}^{*}=0.8449$ , then the formed robot pose ruled surface will be developable robot pose ruled surface as seen from Fig. 16.

Figure 16. The developable robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{4},\boldsymbol{r}_{14}\right\} $ .

Figure 17 shows the ruled surface and developability degree for the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ in Example 2. Since the developability degree is different than zero (see Fig. 17(b)), the robot pose ruled surface (see Fig. 17(a)) is not a developable robot pose ruled surface.

Figure 17. The robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ with the shape parameters $\lambda_{1}=-1.8709$ , $\lambda_{2}=-0.4930$ , $\lambda_{3}=0.5965$ and $\lambda_{1}^{*}=0.1952$ , $\lambda_{2}^{*}=0.9432$ , $\lambda_{3}^{*}=-0.1963$ .

If the shape parameters are changed such as $\lambda_{1}=-1.8709$ , $\lambda_{2}=-0.4930$ , $\lambda_{3}=0.5965$ and $\lambda_{1}^{*}=0.1952$ , $\lambda_{2}^{*}=-0.4930$ , $\lambda_{3}^{*}=0.5965$ , then the formed robot pose ruled surface will be developable robot pose ruled surface as seen from Fig. 18.

Figure 18. The developable robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ .

The ruled surface and developability degree for the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ in Example 3 are presented in Fig. 19. Since the developability degree is different than zero (see Fig. 19(b)), the robot pose surface (see Fig. 19(a)) is the robot pose ruled surface.

Figure 19. The robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ with the shape parameters $\lambda_{1}=-0.8945$ , $\lambda_{2}=0.8769$ , $\lambda_{3}=1.1209$ and $\lambda_{1}^{*}=-1.7566$ , $\lambda_{2}^{*}=1.7882$ , $\lambda_{3}^{*}=1.1029$ .

If the shape parameters is changed such as $\lambda_{1}=-0.8945$ , $\lambda_{2}=1.7882$ , $\lambda_{3}=1.1029$ and $\lambda_{1}^{*}=-1.7566$ , $\lambda_{2}^{*}=1.7882$ , $\lambda_{3}^{*}=1.1029$ , then the formed robot pose ruled surface will be developable robot pose ruled surface as seen from Fig. 20.

Figure 20. The developable robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ .

6. Conclusion

This article proposed a novel algorithm (OPA-H) to determine the optimal path for a robotic arm. We used the 3D cubic Bézier curve with three shape parameters for path planning. Assuming that the starting and the goal points are known for the Kinova Gen3 robotic arm, the obstacles are taken as the other control points. Since we can not change the location of obstacles, modifying the path curve when needed is very important for path planning. Altering shape parameters provides a modification of the Bézier path without changing any control points that correspond to the obstacles. Different Bézier paths are generated according to various obstacles and shape parameters. We extracted the feature vector consisting of the curvature, torsion, and path length of each Bézier path curve to apply hierarchical clustering. Then, hierarchical clustering is used to find curve pairs with the same control points but different shape parameters.

Experiments show that the proposed method finds the optimal path for the robotic arm concerning the curvature, torsion, jerk, distance to the line path, and path length. The optimal path provides different cases regarding the shape parameters while preserving the optimality compared to the classical Bézier curve.

Moreover, the optimal robot pose ruled and developable robot pose ruled surfaces are presented based on the optimal 3D cubic Bézier path. After obtaining the optimal curve pair using the algorithm OPA-H, the optimal shortest robot pose ruled surface can be generated via this curve pair. This article shows that if either two or three shape parameters are changed to obtain the optimal path pair, the optimal robot pose ruled surface will be formed. On the other hand, if only one shape parameter is changed, the optimal developable ruled surface will be formed.

Most path planning methods are proposed in 2D environments. However, our method works in a 3D environment with different obstacles. The algorithm presented in this article generates the optimal path by controlling the optimal path in terms of efficiency and flexibility in addition to the path length using three shape parameters, while other curve-based studies determine only one optimal path.

Conflict of Interest

The authors declare that they have no conflict of interest.

Financial Support

None.

Ethical Considerations

The submitted work is original and not have been published elsewhere in any form or language.

Authors’ Contributions

This article is completed all by Vahide Bulut.

References

Latombe, J. C., Robot Motion Planning (Springer, USA, 1991).CrossRefGoogle Scholar
Cai, Y., Chen, L., Qin, D., Xie, J. and Xu, X., “A path and velocity planning method for lane changing collision avoidance of intelligent vehicle based on cubic 3-d Bézier curve,” Adv. Eng. Software 132, 6573 (2019).Google Scholar
Li, H., Wu, J. and Luo, Y., “Collision-free path planning for intelligent vehicles based on bézier curve,” IEEE Access 7, 123334123340 (2019).CrossRefGoogle Scholar
Yulong, L., Chen, L., Xuewu, J., Yahui, L. and Xiangkun, H., “Emergency steering control of autonomous vehicle for collision avoidance and stabilisation,” Veh. Syst. Dyn. 57(8), 11631187 (2019).Google Scholar
Ma, Y., Perruquetti, W. and Zheng, G., “Cooperative Path Planning for Mobile Robots Based on Visibility Graph,” Proceedings of the 32nd Chinese Control Conference (2013).CrossRefGoogle Scholar
Achour, N., “Mobile Robots Path Planning Using Genetic Algorithms,” ICAS 2011. The Seventh International Conference on Autonomic and Autonomous Systems (2011).Google Scholar
Simba, K. R., Sano, S. and Uchiyama, N., “Real-Time Obstacle-Avoidance Motion Planning for Autonomous Mobile Robots,” 2014 4th Australian Control Conference (AUCC), Canberra, ACT (2014).CrossRefGoogle Scholar
Han, D. K., Park, J. H., Kim, J. S. and Kim, M., “Motion planning of robot manipulators for a smoother path using a twin delayed deep deterministic policy gradient with hindsight experience replay,” Appl. Sci. 10 (2020).CrossRefGoogle Scholar
Costa, P., Lima, J. and Silva, J. S., “Manipulator Path Planning for Pick-and- Place Operations with Obstacles Avoidance: An A* Algorithm Approach,” In: Robotics in Smart Manufacturing. WRSM 2013 (Neto, P. and Moreira, A. P., eds.) (2013).Google Scholar
AL-Taharwa, I., Sheta, A. and Al-Weshah, M., “A mobile robot path planning using genetic algorithm in static environment,” J. Comput. Sci. 4(4), 341344 (2008).CrossRefGoogle Scholar
Hayat, S. and Kausar, Z., “Mobile Robot Path Planning for Circular Shaped Obstacles Using Simulated Annealing,” 2015 International Conference on Control, Automation and Robotics, Singapore (2015) pp. 6973.Google Scholar
Wang, R., Wang, M., Guan, Y. and Li, X., “Modeling and analysis of the obstacle-avoidance strategies for a mobile robot in a dynamic environment,” Math. Probl. Eng. 2015, 1–11 (2015).Google Scholar
Sun, J., Liu, G., Tian, G. and Zhang, J., “Smart obstacle avoidance using a danger index for a dynamic environment,” Appl. Sci. 9(8), 1589 (2019).CrossRefGoogle Scholar
Sgorbissa, A., “Integrated robot planning, path following, and obstacle avoidance in two and three dimensions: Wheeled robots, underwater vehicles, and multicopters,” Int. J. Rob. Res. 38(7), 853876 (2019).CrossRefGoogle Scholar
Bulut, V., “Differential geometry of autonomous wheel-legged robots,” Eng. Comput. 37(2), 615637 (2019).CrossRefGoogle Scholar
Zhu, S., Zhu, W., Zhang, X. and Cao, T., “Path planning of lunar robot based on dynamic adaptive ant colony algorithm and obstacle avoidance,” Int. J. Adv. Rob. Syst. (2020).CrossRefGoogle Scholar
Xie, Y. et al., “Obstacle avoidance and path planning for multi-joint manipulator in a space robot,” IEEE Access 8, 35113526 (2020).CrossRefGoogle Scholar
Ryu, H., “Hierarchical path-planning for mobile robots using a skeletonization-informed rapidly exploring random tree*,” Appl. Sci. 10(21), 7846 (2020).CrossRefGoogle Scholar
Miura, J., “Support Vector Path Planning,” Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems, Beijing, China (2006) pp. 28942899.Google Scholar
Han, L., Yashiro, H., Nejad, H. T. N., Do, Q. H. and Mita, S., “Bézier Curve Based Path Planning for Autonomous Vehicle in Urban Environment,” Proceedings of the 2010 IEEE Intelligent Vehicles Symposium, San Diego, CA, USA (2010) pp. 10361042.Google Scholar
Elhoseny, M., Tharwat, A. and Hassanien, A. E., “Bezier curve based path planning in a dynamic field using modified genetic algorithm,” J. Comput. Sci. 25, 339350 (2018).CrossRefGoogle Scholar
Shimizu, M., Kobayashi, K. and Watanabe, K., “Clothoidal Curve-based Path Generation for an Autonomous Mobile Robot,” Proceedings of the SICE-ICASE International Joint Conference, Busan, Korea (2006) pp. 478481.Google Scholar
Hu, Y., Li, D., Han, J. and He, Y., “Path planning of UGV based on bézier curves,” Robotica 37(6), 969997 (2019).CrossRefGoogle Scholar
Cassany, L., Moze, M., Aioun, F., Guillemard, F., Moreau, J., Melchior, P. and Victor, S., “Reactive path planning in intersection for autonomous vehicle,” IFAC-PapersOnLine 52(5), 109114 (2019).Google Scholar
Wei, S., Wang, N., Zhang, X. and Xu, Z., “Trajectory Planning with Bezier Curve in Cartesian Space for Industrial Gluing Robot,” In: Intelligent Robotics and Applications. ICIRA 2014. Lecture Notes in Computer Science (Zhang, X., Liu, H., Chen, Z. and Wang, N., eds.), vol. 8918 (Springer, Cham, 2014).Google Scholar
Yang, L. and Zeng, X.-M., “Bézier curves and surfaces with shape parameters.Int. J. Comput. Math. 86(7), 12531263 (2009).CrossRefGoogle Scholar
Chen, Q. and Wang, G., “A class of Bezier-like curves,” Comput. Aided Geom. Des. 20(1), 2939 (2003).CrossRefGoogle Scholar
Bulut, V., “Path planning for autonomous ground vehicles based on quintic trigonometric Bézier curve,” J. Braz. Soc. Mech. Sci. Eng. 43(104) (2021).CrossRefGoogle Scholar
Pressley, A. N., Elementary Differential Geometry, 2nd ed. (Springer-Verlag, London, 2010).CrossRefGoogle Scholar
Ranka, S., Singh, V. and Alsabti, K., “An Efficient k-Means Clustering Algorithm,” Proceedings of the 1st Workshop on High-Performance Data Mining (1998).Google Scholar
Chalfant, J., Analysis and Design of Developable Surfaces for Shipbuilding Master’s Thesis (Massachusetts Institute of Technology, 1997).Google Scholar
Figure 0

Figure 1. The Bernstein basis functions with degree three for $\lambda_{1}=-1.5$, $\lambda_{2}=1$, $\lambda_{3}=-0.8$ (solid lines), for $\lambda_{1}=-1$, $\lambda_{2}=-0.5$, $\lambda_{3}=1.5$ (dashed lines) and for $\lambda_{1}=0.7$, $\lambda_{2}=1.5$, $\lambda_{3}=2.5$ (dotted lines).

Figure 1

Figure 2. Effect of the altered shape parameters on the shape of the cubic Bézier curve.

Figure 2

Figure 3. The curvature and the torsion curves of the cubic Bézier curve for different values of shape parameters.

Figure 3

Figure 4. Different trajectories according to various obstacles and shape parameter values.

Figure 4

Figure 5. Kinova Gen3 robotic arm.

Figure 5

Table I. Test results.

Figure 6

Figure 6. Trapezoidal position, velocity, and acceleration profiles of seven joints of the Kinova Gen3 robotic arm for the paths $r_{4}$ (straight) and $r_{14}$ (dashed).

Figure 7

Figure 7. The optimal path $r_{14}$ for different values of the shape parameters in Table I.

Figure 8

Figure 8. The path lengths of the optimal path $r_{14}$ for different values of the shape parameters and the CBC (black).

Figure 9

Table II. The comparision of optimal curve with different shape parameters and CBC.

Figure 10

Table III. Test Results.

Figure 11

Figure 9. Trapezoidal position, velocity, and acceleration profiles of seven joints of the Kinova Gen3 robotic arm for the paths $r_{5}$ (straight) and $r_{15}$ (dashed).

Figure 12

Figure 10. The optimal path $r_{5}$ for different values of the shape parameters in Table III.

Figure 13

Figure 11. The path lengths of the optimal path $r_{5}$ for different values of the shape parameters and the CBC (black).

Figure 14

Table IV. The comparison of optimal curve with different shape parameters and CBC.

Figure 15

Table V. Test results.

Figure 16

Figure 12. Trapezoidal position, velocity, and acceleration profiles of seven joints of the Kinova Gen3 robotic arm for the paths $r_{5}$ (straight) and $r_{15}$ (dashed).

Figure 17

Figure 13. The optimal path $r_{15}$ for different values of the shape parameters in Table V.

Figure 18

Figure 14. The path lengths of the optimal path $r_{15}$ for different values of the shape parameters and the CBC (black).

Figure 19

Table VI. The comparision of optimal curve with different shape parameters and CBC.

Figure 20

Figure 15. The robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{4},\boldsymbol{r}_{14}\right\} $ with the shape parameters $\lambda_{1}=-1.2258$, $\lambda_{2}=0.2262$, $\lambda_{3}=0.3796$ and $\lambda_{1}^{*}=-1.2134$, $\lambda_{2}^{*}=0.8085$, $\lambda_{3}^{*}=0.8449$.

Figure 21

Figure 16. The developable robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{4},\boldsymbol{r}_{14}\right\} $.

Figure 22

Figure 17. The robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ with the shape parameters $\lambda_{1}=-1.8709$, $\lambda_{2}=-0.4930$, $\lambda_{3}=0.5965$ and $\lambda_{1}^{*}=0.1952$, $\lambda_{2}^{*}=0.9432$, $\lambda_{3}^{*}=-0.1963$.

Figure 23

Figure 18. The developable robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $.

Figure 24

Figure 19. The robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $ with the shape parameters $\lambda_{1}=-0.8945$, $\lambda_{2}=0.8769$, $\lambda_{3}=1.1209$ and $\lambda_{1}^{*}=-1.7566$, $\lambda_{2}^{*}=1.7882$, $\lambda_{3}^{*}=1.1029$.

Figure 25

Figure 20. The developable robot pose ruled surface belong to the curve pair $\left\{ \boldsymbol{r}_{5},\boldsymbol{r}_{15}\right\} $.