# A New Noise-Tolerant Obstacle Avoidance Scheme for Motion Planning of Redundant Robot Manipulators

- College of Information Science and Engineering, Huaqiao University, Xiamen, China

Avoiding obstacle(s) is a challenging issue in the research of redundant robot manipulators. In addition, noise from truncation, rounding, and model uncertainty is an important factor that affects greatly the obstacle avoidance scheme. In this paper, based on the neural dynamics design formula, a new scheme with the pseudoinverse-type formulation is proposed for obstacle avoidance of redundant robot manipulators in a noisy environment. Such a scheme has the capability of suppressing constant and bounded time-varying noises, and it is thus termed as the noise-tolerant obstacle avoidance (NTOA) scheme in this paper. Theoretical results are also given to show the excellent property of the proposed NTOA scheme (particularly in noise situation). Based on a PA10 robot manipulator with point and window-shaped obstacles, computer simulation results are presented to further substantiate the efficacy and superiority of the proposed NTOA scheme for motion planning of redundant robot manipulators.

## 1. Introduction

Recently, redundant robot manipulators have played an increasingly important part in many scientific and industrial fields. Motion planning is the fundamental issue, and has been extensively studied (Siciliano and Khatib, 2008; Siciliano et al., 2009; Flacco and De luca, 2015; Qiu et al., 2016; Zhang et al., 2016; Li M. et al., 2017; Jin and Li, 2018). A collision-free motion is necessary for a redundant robot manipulator because collision would lead to the failure of the motion planning task. Moreover, such collision(s) may cause considerable damage to the robot manipulator. Avoiding environmental obstacle(s) is an important issue in the motion planning of redundant robot manipulators. Many effective obstacle avoidance schemes have thus been developed for redundant robot manipulators (Maciekewski and Klein, 1985; Wang and Hamam, 1992; Chen et al., 2002; Lee and Buss, 2007; Guo and Zhang, 2012, 2014; Marcos et al., 2012; Chen and Zhang, 2016; Xiao and Zhang, 2016; Guo and Li, 2016). For example, Lee and Buss (2007) investigated obstacle avoidance by using the Jacobian transpose method. In Marcos et al. (2012), Machado et al. presented a multi-objective method for redundant robot manipulators to avoid obstacles. Note that most reported obstacle avoidance schemes are assumed to be free of noise in the simulations or experiments.

Given its practical application in the industry, another important issue for redundant robot manipulators that requires consideration is the simultaneous handling of environmental noise(s) during the end-effector task execution (Yildirim and Eski, 2010). Noise is inevitably encountered when implementing the scheme for obstacle avoidance of redundant robot manipulators; this noise comes in the form of truncation error, rounding error, model uncertainty, and external disturbance (Jin et al., 2017a; Li et al., 2018). The robustness against additive noise is an important factor in designing a reliable obstacle avoidance scheme. Many researchers have thus examined robot manipulators in the presence of noise (Gaudiano et al., 1996; Florchinger, 2000; Siu et al., 2010; Yildirim and Eski, 2010; Ting et al., 2011; Guo et al., 2017; Jin et al., 2017a; Li et al., 2018). For example, Yildirim and Eski (2010) presented a noise analysis of robot manipulators using neural networks. In Li et al. (2018) designed a new approach for redundant robot manipulators that was combined with the neural controller inherently tolerant to noise.

The aforementioned noise (e.g., realization error and/or external error) has significant effects on the efficacy of the obstacle avoidance schemes for redundant robot manipulators. Such noise may also cause scheme invalidation or the failure of the end-effector primary task. For time-critical end-effector tasks, denoising must be integrated with motion planning for redundant robot manipulators (Li et al., 2018). Time is precious for the obstacle avoidance of redundant robot manipulators in practice, and any noise-reduction preprocessing may consume additional time (which may be in breach of the real-time requirement) (Li et al., 2018). Thus, an effective obstacle avoidance scheme is worth investigating for redundant robot manipulators in a noisy environment. Such a scheme must be inherently tolerant to various types of noise and able to make the robot manipulator avoid obstacles simultaneously.

In recent years, neural dynamics (as an important branch of artificial intelligence) has attracted considerable attention (Zhang et al., 2002; Zhang and Yi, 2011; He et al., 2014a,b; Zhang and Guo, 2015; Li et al., 2016, 2017a,b). It has been studied for solving different mathematical problems arising in motion planning of redundant robot manipulators. In particular, an exponent-type design formula was proposed by Zhang et al. (Zhang et al., 2002; Zhang and Yi, 2011; Zhang and Guo, 2015), and different neural-dynamics models were further developed to solve various types of time-varying problem. Note that some of these models have been applied effectively to redundant robot manipulators, showing well the application prospect of the neural-dynamics approach. By following the aforementioned successful work, another neural-dynamics design formula, which has noise suppression capability, was proposed and investigated by Jin et al. (2016a,b, 2017b). In this paper, such a design formula is exploited to develop an effective obstacle avoidance scheme for motion planning of redundant robot manipulators in the presence of noise.

Specifically, by using the neural-dynamics design formula in Jin et al. (2016a,b, 2017b) to solve the system of time-varying nonlinear kinematic equations, the corresponding obstacle avoidance scheme with the pseudoinverse-type formulation is proposed for redundant robot manipulators in this paper. Such an obstacle avoidance scheme can suppress constant and bounded time-varying noises, and is thus termed as the noise-tolerant obstacle avoidance (NTOA) scheme. For the proposed NTOA scheme, theoretical results are presented to show its excellent property. Computer simulation results are illustrated based on the PA10 robot manipulator with point and window-shaped obstacles to further substantiate the efficacy and superiority of the proposed NTOA scheme for motion planning of redundant robot manipulators.

The rest of this paper is organized into five sections. In section 2, the formulations of the neural-dynamics design formula and the NTOA scheme are given. Section 3 presents the theoretical results of the proposed NTOA scheme. In section 4, simulation results that are synthesized by the proposed NTOA scheme are provided. Section 5 shows the discussion about the NTOA scheme. Section 6 concludes this paper with final remarks. The main contributions of this paper are as follows.

1) This paper proposes and investigates a new NTOA scheme for the motion planning of redundant robot manipulators in the presence of noise. This scheme has a noise-suppressing capability, which can make the robot manipulators achieve their obstacle-avoidance purpose. This paper marks an important advancement in obstacle avoidance research by proposing and providing a NTOA scheme.

2) In this paper, the Cartesian error synthesized by the proposed NTOA scheme is proven to possess the property of global and exponential convergence. Theoretical results also indicate that the proposed scheme has the capability of suppressing constant and bounded time-varying noises.

3) Computer simulations based on the PA10 robot manipulator are performed to substantiate the efficacy and superiority of the proposed NTOA scheme whether in the presence or absence of noise.

## 2. Design Formula and Scheme Formulation

In this section, the formulation of the neural-dynamics design formula is presented. Then, by exploiting this design formula to solve the system of time-varying nonlinear kinematic equations, the corresponding obstacle avoidance scheme is developed for motion planning of redundant robot manipulators in the presence of noise.

### 2.1. Neural-Dynamics Design Formula

Let us consider the following time-varying problem:

In the neural-dynamics design methodology (Zhang et al., 2002; Zhang and Yi, 2011; Zhang and Guo, 2015), to solve this problem, the following vector-valued error function is defined:

Then, the time derivative of the error function *e*(*t*), i.e., ė(*t*), is selected such that *e*(*t*) converges to zero. In Zhang et al. (2002), an exponent-type design formula was originally developed by Zhang et al. to determine ė(*t*). Such a design formula is written as follows:

where design parameter γ>0∈*R* is used to scale the convergence rate of the solution (Zhang et al., 2002; Zhang and Yi, 2011; Zhang and Guo, 2015). Corresponding to the specific time-varying problem to be solved, expanding (1) yields the related neural-dynamics model. Furthermore, based on (1), another neural-dynamics design formula with noise suppression capability was developed by Jin et al. (2016a,b, 2017b). This design formula is written as follows:

where *k*_{P}>0∈*R* and *k*_{I}>0∈*R* are the design parameters. Please refer to Jin et al. (2016a,b, 2017b) for details about the property of (2). Based on previous research, such a neural dynamics design formula (2) is applied to the obstacle avoidance of redundant robot manipulators in the ensuing section.

### 2.2. NTOA Scheme

The redundancy-resolution problem related to the motion planning of redundant robot manipulators is described as follows: given the desired end-effector path ${r}_{\mathrm{\text{d}}}(t)\in {R}^{m}$, the corresponding joint trajectory θ(*t*)∈*R*^{n} should be obtained in real time *t*. In mathematics, solving the redundancy-resolution problem can be equivalent to solving the following system of time-varying nonlinear kinematic equations:

where *f*(·) is a differentiable nonlinear mapping.

To solve (3), the error function *e*(*t*) is defined as follows:

Evidently, expanding (2) yields the following result:

where *J*∈*R*^{m×n} is the Jacobian matrix of the robot manipulator, $\stackrel{\xb0}{\theta}\in {R}^{n}$ is the joint-velocity vector, and ${\u1e59}_{\mathrm{\text{d}}}\in {R}^{m}$ is the time derivative of *r*_{d}. By generalizing the conventional pseudoinverse-type formulation (Siciliano and Khatib, 2008; Siciliano et al., 2009), the following redundancy-resolution scheme for the motion planning of redundant robot manipulators is obtained:

As mentioned previously, avoiding environmental obstacle(s) is an important issue in the motion planning of redundant robot manipulators. Thus, by choosing a suitable *z* in (5), the NTOA scheme proposed in this paper for redundant robot manipulators is formulated as follows:

where κ∈*R* is a real scalar (Li et al., 2001), ς = rank(*J*), and superscript^{T} denotes the transpose operator. In addition, ∇*H*(θ) is the gradient of a performance criterion *H*(θ) (being a scalar function of the joint-angle vector θ∈*R*^{n}), and *V*_{Ni} is the *i*th column vector of ${V}_{N}\in {R}^{n\times (n-\varsigma )}$ with *V*_{N} = [*V*_{ς+1}*V*_{ς+2} ⋯*V*_{n}]. *V*_{j} (with *j* = ς+1, ς+2, ⋯ , *n*) is the *j*th column vector of the orthogonal unitary matrix *V*∈*R*^{n×n}, which is obtained by using the singular value decomposition (SVD) of *J* (Lee and Buss, 2007). That is,

where *U*∈*R*^{m×m} is the orthogonal matrix and *S*∈*R*^{m×n} contains the singular values of *J* in its main diagonal. For obstacle avoidance, ∇*H*(θ) in (6) is replaced with the following escape velocity ${\stackrel{\xb0}{\theta}}_{C}$ in the joint space (Lee and Buss, 2007):

where *k* is the number of critical points and *J*_{Ci}(θ) is the Jacobian matrix of the *i*th critical point *C*_{i}. In addition, *v*_{Cij} is defined as a function of the minimum distance *d*_{ij} (between the *i*th link and the *j*th obstacle) along the direction away from the critical point *C*_{i} (Lee and Buss, 2007):

where *v*_{0} is the maximum escape velocity and *u*_{ij} is the unit vector from the critical point *C*_{i} on the *i*th link to the *j*th obstacle. In addition, the predefined thresholds *d*_{1} and *d*_{2} are the outer and inner safety thresholds, respectively. Descriptions of the outer and inner safety thresholds can be seen in Guo and Zhang (2014) and/or Guo and Li (2016).

Note that, for the proposed NTOA scheme (6), this paper limits the investigation that the two design parameters *k*_{P} and *k*_{I} satisfy ${k}_{\mathrm{\text{P}}}^{2}>4{k}_{\mathrm{\text{I}}}$ numerically. Furthermore, theoretical results of (6) are presented in the ensuing section to show its effectiveness on motion planning and noise suppression.

## 3. Theoretical Results

In this section, four theorems are provided to investigate the performance of the proposed NTOA scheme (6) in three situations, namely, the zero noise, constant noise, and bounded time-varying noise.

### 3.1. Obstacle Avoidance Without Considering Noise

In this subsection, the proposed NTOA scheme (6) is studied for redundant robot manipulators without considering the existence of noise (i.e., zero noise situation).

**Theorem 1:** *The trajectory of the Cartesian error* *e*(*t*) *for the proposed NTOA scheme (**6**) is asymptotically stable*.

**Proof:** See Appendix A in Supplementary Material.

**Theorem 2:** *In addition to Theorem 1, the Cartesian error* *e*(*t*) *synthesized by the proposed NTOA scheme (**6**) has the property of exponential convergence*.

**Proof:** See Appendix B in Supplementary Material.

For the proposed NTOA scheme (6), the results of Theorems 1 and 2 indicate that the corresponding Cartesian error *e*(*t*) has the property of global and exponential convergence. This means that the magnitude of *e*(*t*) synthesized by (6) can be kept within the region of a small value. By choosing the *k*_{P} and *k*_{I} values appropriately, the *e*(*t*) magnitude can be small enough during the motion task execution (whether noise exists or not), then the performance of (6) is considered satisfactory (De Luca et al., 1992). In summary, these results theoretically guarantee that the proposed NTOA scheme (6) is effective in the motion planning of redundant robot manipulators.

### 3.2. Obstacle Avoidance With Noise Considered

In this subsection, the proposed NTOA scheme (6) is investigated considering the existence of noise (i.e., the situations of constant noise and bounded time-varying noise). For further investigation, the proposed NTOA scheme (6) under the pollution of noise is formulated as follows:

where δ(*t*)∈*R*^{m} denotes the vector-form noise (e.g., constant realization errors, time-varying bias errors, and the superposition of these errors). Now, the performance of the noise-polluted NTOA scheme (7) is studied for redundant robot manipulators.

**Theorem 3:** *In the case of the vector-form constant noise* δ(*t*) = *c*∈*R*^{m}*, the Cartesian error* *e*(*t*) *synthesized by the noise-polluted NTOA scheme (**7**) has a convergence property*.

**Proof:** See Appendix C in Supplementary Material.

As mentioned before, the convergence property can guarantee a small magnitude of the Cartesian error *e*(*t*) during the motion task execution. Based on the proof in Appendix C in Supplementary Material, no matter how large the unknown vector-form constant noise δ(*t*) = *c*∈*R*^{m} is, the Cartesian error *e*(*t*) for the noise-polluted NTOA scheme (7) is convergent, with the steady-state error being zero. Thus, as synthesized by (7) with the appropriate values of *k*_{P} and *k*_{I}, the magnitude of *e*(*t*) can be small enough.

In many practical applications, the noise can be time-varying. For the fast time-varying noise, the low-pass filter could be exploited to tackle the problem of error compensation. However, the noise-reduction preprocessing may consume extra time and violate the real-time requirement. Thus, investigating the performance of the noise-polluted NTOA scheme (7) in the presence of bounded time-varying noise (or even random noise) is necessary.

**Theorem 4:** *In the case of the bounded vector-form time-varying noise* δ(*t*)∈*R*^{m}*, the Cartesian error* *e*(*t*) *synthesized by the noise-polluted NTOA scheme (**7**) is bounded, with the steady-state error being bounded by*

*where* δ_{i}(*t*) *denotes the* *i**th element of* δ(*t*) *and the symbol* |·| *denotes the absolute value of a scalar*.

**Proof:** See Appendix D in Supplementary Material.

From Theorem 4, the upper bound of the steady-state error is in inverse proportion to the *k*_{P} value. By choosing a large enough *k*_{P} value and an appropriate *k*_{I} value, the steady-state error can be arbitrarily small, which means that the magnitude of *e*(*t*) synthesized by (7) can also be small enough during the task execution. This result further shows that the noise-polluted NTOA scheme (7) is effective in the motion planning of redundant robot manipulators in the presence of bounded time-varying noise.

In summary, the results in this section (i.e., Theorems 1–4) theoretically substantiate the efficacy and superiority of the proposed NTOA scheme (6) for redundant robot manipulators whether noise exists or not.

## 4. Simulative Verifications

In this section, based on the PA10 robot manipulator with an equipped long tool (Zhang and Wang, 2004; Guo and Zhang, 2012, 2014), computer simulations with the existence of point and window-shaped obstacles are performed to verify the efficacy and superiority of the proposed NTOA scheme (6). For comparison, the obstacle avoidance method presented in Lee and Buss (2007) is simulated as well.

### 4.1. Point Obstacle Avoidance

In this example, the PA10 robot manipulator is simulated, in which there exists a point obstacle. The obstacle avoidance method in Lee and Buss (2007) and the proposed NTOA scheme (6) are both applied to such a robot manipulator for the end-effector tracking of a circular path considering three situations (i.e., the situations of zero, constant, and bounded time-varying noises).

#### 4.1.1. Zero Noise

The obstacle avoidance method in Lee and Buss (2007) and the proposed NTOA scheme (6) are both tested in the zero-noise situation, and the corresponding simulation results are presented in Figures 1–3 and Table 1.

**Figure 1**. Simulation results synthesized by the general MVN scheme [i.e., the proposed NTOA scheme (6) using *k*_{P} = *k*_{I} = κ = 0] for the PA10 end-effector tracking the circular path, where the existence of the point obstacle and noise is not considered.

**Table 1**. Maximal absolute value (MAV) of Cartesian error synthesized by the proposed NTOA scheme (6) with zero noise considered and with different *k*_{P} and *k*_{I} values used.

Figure 1 shows the simulation results synthesized by the general minimum velocity norm (MVN) scheme [i.e., the proposed NTOA scheme (6) using *k*_{P} = *k*_{I} = κ = 0], in which the existence of the point obstacle is not considered. As seen from Figure 1A, the desired motion is achieved successfully by the PA10 robot manipulator. However, Figure 1B indicates that the minimum link-obstacle distance *d*_{m} is smaller than 0.05 m during [4.91, 6.25] s. This can be viewed as a collision phenomenon (Guo and Zhang, 2014; Guo and Li, 2016) that may cause damage to the robot manipulator and the point obstacle. Thus, exploiting an effective obstacle avoidance method/scheme for PA10 robot manipulator is necessary.

Figure 2 illustrates the simulation results synthesized by the obstacle avoidance method in Lee and Buss (2007), where the existence of the point obstacle is considered. As shown in Figures 2A,B, during the motion task execution, the minimum link-obstacle distance *d*_{m} is always greater than 0.05 m. This substantiates that the presented point obstacle is successfully avoided by the obstacle avoidance method in Lee and Buss (2007). Figure 2C shows that the maximal Cartesian error is approximately 5.0 × 10^{−5} m. However, the detailed results in Figure 2C show that the divergence phenomenon in the Cartesian error is present. Thus, the obstacle avoidance method in Lee and Buss (2007), although effective, may be less desirable and less applicable in robotics.

**Figure 2**. Simulation results synthesized by the obstacle avoidance method in Lee and Buss (2007) for the PA10 end-effector tracking the circular path, where the zero noise is considered.

By contrast, Figure 3 presents the simulation results synthesized by the proposed NTOA scheme (6) with *k*_{P} = *k*_{I} = 10 and κ = 1. As seen from Figures 3A,B, the minimum link-obstacle distance *d*_{m} during the motion is always >0.05 m, which implies that obstacle avoidance is achieved successfully. In addition, as shown in Figure 3C, the maximal Cartesian error is < 5.0 × 10^{−6} m, indicating the efficacy of the proposed NTOA scheme (6) for the motion planning of PA10 robot manipulator. The comparison between Figure 2C and Figure 3C shows that the maximal Cartesian error via (6) is about 10 times smaller than the one via the obstacle avoidance method in Lee and Buss (2007). Furthermore, the divergence phenomenon does not exist for the Cartesian error presented in Figure 3C. Thus, a prominent advantage of the proposed NTOA scheme (6) is that it guarantees a Cartesian error with no divergence (which agrees with the convergence results in Theorems 1 and 2). These comparative results indicate that the proposed NTOA scheme (6) is superior to the obstacle avoidance method in Lee and Buss (2007).

For further investigation, the proposed NTOA scheme (6) is tested by using different *k*_{P} and *k*_{I} values, and the related simulation results are presented in Table 1. As seen from Table 1, the maximal absolute value (MAV) of the Cartesian error synthesized by (6) is small enough (i.e., of order 10^{−7}~10^{−6}), showing the efficacy on motion planning. In addition, it follows from Table 1 that the MAV of Cartesian error decreases when the *k*_{P} and *k*_{I} values increase. Thus, the design parameters *k*_{P} and *k*_{I} play an important role in (6), and should be set as large as the robotics systems would permit (or selected appropriately large for simulation/experiment purposes).

In summary, the above results (i.e., Figures 1–3 and Table 1) substantiate the efficacy and superiority of the proposed NTOA scheme (6), as compared with the obstacle avoidance method in Lee and Buss (2007).

**Figure 3**. Simulation results synthesized by the proposed NTOA scheme (6) using *k*_{P} = *k*_{I} = 10 and κ = 1 for the PA10 end-effector tracking the circular path, where the zero noise is considered.

#### 4.1.2. Constant Noise

The proposed NTOA scheme (6) is tested in the situation of the constant noise δ(*t*) = *c* = [0.10, 0.15, 0.20]^{T}. In this situation, the noise-polluted NTOA scheme (7) is actually used, and the corresponding simulation results are shown in Figure 4 and Table 2. Note that the obstacle avoidance method in Lee and Buss (2007) with constant noise considered is test as well. However, the computer simulation failed, which shows that such a method does not have a capability of suppressing noise and cannot handle this kind of noise (thereby leading to the failure of the task execution).

**Figure 4**. Simulation results synthesized by the proposed NTOA scheme (6) using ${k}_{\mathrm{\text{P}}}={k}_{\mathrm{\text{I}}}=1{0}^{3}$ and κ = 1 for the PA10 end-effector tracking the circular path, where the constant noise is considered.

**Table 2**. Maximal absolute value (MAV) of Cartesian error synthesized by the proposed NTOA scheme (6) with constant noise considered and with different *k*_{P} and *k*_{I} values used.

Figure 4 shows the simulation results synthesized by the noise-polluted NTOA scheme (7) with ${k}_{\mathrm{\text{P}}}={k}_{\mathrm{\text{I}}}=1{0}^{3}$ and κ = 1. As seen from Figure 4, the obstacle-avoidance purpose is achieved successfully via (7) in the sense that *d*_{m} is always >0.05 m. In addition, the simulated end-effector trajectory is close to the desired circular path with a small Cartesian error. The existence of constant noise leads to the significant increase of the Cartesian error (from the zero initial value) in the transient phase, as shown in Figure 4C. Owing to the noise suppressing capability, (7) can handle this kind of noise. The resultant Cartesian error is convergent (which agrees with the result of Theorem 3), and is kept within the region of a small value (i.e., of order 10^{−4}). These results indicate that the noise-polluted NTOA scheme (7) is effective for robotic practical applications.

The noise-polluted NTOA scheme (7) is tested as well using different *k*_{P} and *k*_{I} values, and the related simulation results are presented in Table 2. As shown in Table 2, the MAV of Cartesian error is small enough, meaning that the motion planning task is executed successfully via (7) (though constant noise exists). Table 2 also indicates that the performance of (7) is improved effectively by increasing the *k*_{P} and *k*_{I} values, showing again the important role of *k*_{P} and *k*_{I} in the noise-polluted NTOA scheme (7).

In summary, the above simulation results substantiate the efficacy and superiority of the proposed NTOA scheme (6) [i.e., the performance of the noise-polluted NTOA scheme (7)] for motion planning of redundant robot manipulators in the presence of constant noise.

#### 4.1.3. Bounded Time-Varying Noise

The proposed NTOA scheme (6) is tested in the situation of the bounded time-varying noise δ(*t*) = [0.2sin(*t*), 0.2sin(2*t*), 0.2sin(3*t*)]^{T}. Similarly, the noise-polluted NTOA scheme (7) is actually used in this situation, and the corresponding simulation results are presented in Figure 5.

**Figure 5**. Simulation results synthesized by the proposed NTOA scheme (6) using ${k}_{\mathrm{\text{P}}}={k}_{\mathrm{\text{I}}}=1{0}^{3}$ and κ = 1 for the PA10 end-effector tracking the circular path, where the bounded time-varying noise is considered.

As shown in Figure 5, the minimum link-obstacle distance *d*_{m} is always >0.05 m and the maximal Cartesian error is < 3.0 × 10^{−4} m. Thus, the purposes of obstacle avoidance and motion planning are both achieved successfully using the noise-polluted NTOA scheme (7). According to Figure 5C, the Cartesian error is bounded and is kept within (−3, 2) × 10^{−4} m during the task execution. This coincides with the result of Theorem 4. The noise-polluted NTOA scheme (7) is tested using different *k*_{P} and *k*_{I} values for further investigation. Owing to the similarity of results, the related simulation results are omitted here. This result indicates that the MAV of the Cartesian error via (7) decreases as the *k*_{P} and *k*_{I} values increase.

In summary, these simulation results substantiate the efficacy and superiority of the proposed NTOA scheme (6) [or the excellent performance of the noise-polluted NTOA scheme (7)] for redundant robot manipulators in the presence of bounded time-varying noise.

### 4.2. Window-Shaped Obstacle Avoidance

In this example, the PA10 robot manipulator is simulated, in which there exists a window-shaped obstacle (Guo and Zhang, 2014). The proposed NTOA scheme (6) is applied to such a robot manipulator for its end-effector tracking a circular path. Similarly, the following three situations of noise are considered in the investigation of the proposed NTOA scheme (6):

Without considering the existence of the window-shaped obstacle, Figure 6 shows the simulation results synthesized by the general MVN scheme. As seen from Figure 6, the desired motion for the PA10 robot manipulator is achieved successfully, but the minimum link-obstacle distance *d*_{m} is smaller than 0.05 m during [2.67, 3.96] s. This close distance (being < 0.05 m) means that there exists a collision that may cause considerable damage to the PA10 robot manipulator and the window-shaped obstacle.

**Figure 6**. Simulation results synthesized by the general MVN scheme for the PA10 end-effector tracking the circular path, where the existence of the window-shaped obstacle and noise is not considered.

To avoid the window-shaped obstacle, the proposed NTOA scheme (6) [as well as the noise-polluted NTOA scheme (7)] is applied to the PA10 robot manipulator under the aforementioned three situations, and the simulation results are shown in Figures 7, 8. Note that, for Figure 7, the left subfigures present the simulated motion trajectories of the robot manipulator, and the right subfigures present the corresponding profiles of the minimum link-obstacle distance *d*_{m}. Evidently, as shown in Figures 7, 8, all of the simulated end-effector trajectories are close to the desired circular path (with the Cartesian errors being small enough), and the minimum link-obstacle distance *d*_{m} during the motion is always greater than 0.05 m. This indicates that the obstacle-avoidance and motion-planning purposes are both achieved successfully via (6) [or (7)], no matter whether noise exists or not. Besides, as seen from Figure 8, in each situation of noise, the change of the Cartesian error is similar to the change presented in Figures 3C, 4C, 5C, showing that these results coincide with the results of Theorems 1–4. Thus, being one of its prominent advantages, the proposed NTOA scheme (6) guarantees that the Cartesian error occurs without divergence, as evidenced by both the theoretical and simulation results.

**Figure 7**. Simulation results synthesized by the proposed NTOA scheme (6) for the PA10 end-effector tracking the circular path, where the zero noise, constant noise, and bounded time-varying (TV) noise are considered.

**Figure 8**. Trajectories of Cartesian error *e*(*t*) synthesized by the proposed NTOA scheme (6) with three situations considered, which corresponds to Figure 7.

In summary, these simulation results have substantiated again the efficacy and superiority of the proposed NTOA scheme (6) for motion planning of redundant robot manipulators in the presence of different kinds of noise.

## 5. Discussion

For the proposed NTOA scheme (6), the feedback item *k*_{P}(*f*(θ)−*r*_{d}) and the integration item ${k}_{\text{I}}{{\int}^{\text{}}}_{t}^{0}(f(\theta )-{r}_{\text{d}})\text{d}\tau )$ are incorporated into the scheme formulation. Such a scheme thus contains the proportional, integral, and derivative information of the desired end-effector path *r*_{d}. In this sense, the proposed NTOA scheme (6) processes the characteristic of proportional-integral-derivative (PID), thereby showing that (6) can be considered as a nonlinear PID controller for the obstacle avoidance of redundant robot manipulators. Because of the special characteristic, the proposed scheme (6) is robust against constant noise and bounded time-varying noise, and enables the effective obstacle avoidance of redundant robot manipulators even in the presence of noise. The efficacy of (6) has been analyzed and verified via the theoretical and simulation results in sections 3 and 4.

By summarizing the simulation results in section 4, the superiority of the proposed NTOA scheme (6) over the obstacle avoidance method in Lee and Buss (2007) is presented as follows.

• In the situation of zero noise, the obstacle avoidance method in Lee and Buss (2007) would introduce undesirable divergence phenomenon in Cartesian error (see Figure 2). By contrast, the error *e(t)* via the proposed NTOA scheme (6) will not encounter the divergence problem owing to the feedback and integration items in (6). In addition, the motion precision of the proposed NTOA scheme (6) is better than that of the obstacle avoidance method in Lee and Buss (2007), as demonstrated in section 4.

• In the situation of nonzero noise, the obstacle avoidance method in Lee and Buss (2007) is intolerant to noise, which invalidates the method. By contrast, the proposed NTOA scheme (6) can suppress constant noise and bounded time-varying noise (see sections 3 and 4). Thus, the efficacy of the proposed NTOA scheme (6) is theoretically guaranteed even in the presence of noise.

In summary, the proposed NTOA scheme (6) is advantageous over the obstacle avoidance method in Lee and Buss (2007) because it guarantees nondivergence Cartesian error regardless of the absence or presence of noise. Given this characteristic, the proposed NTOA scheme (6) is superior to the obstacle avoidance method in Lee and Buss (2007) for redundant robot manipulators.

Besides, both the theoretical and simulation results in sections 3 and 4 have indicated that the design parameters *k*_{P} and *k*_{I} are important to ensure the precision of the Cartesian error for the proposed NTOA scheme (6). To a certain extent, such two parameters are similar to the PID parameters and can be used to enhance the noise suppression capability of the proposed NTOA scheme (6). In general, the values of *k*_{P} and *k*_{I} can be selected in accordance with the actual situations of noise and practical requirements of precision. Summarizing the theoretical analysis and simulation results shows that *k*_{P} and *k*_{I} should be set to sufficiently large values (e.g., ${k}_{\mathrm{\text{P}}}={k}_{\mathrm{\text{I}}}=1{0}^{3}$ or larger) to ensure the satisfactory performance of the proposed NTOA scheme (6), particularly in the presence of noise.

## 6. Conclusion

In this paper, based on the neural dynamics design formula in Jin et al. (2016a,b, 2017b), the new NTOA scheme (6) is proposed and investigated for the motion planning of redundant robot manipulators in the presence of noise. This scheme, which is capable of suppressing constant and bounded time-varying noises, enables the robot manipulator to avoid obstacles successfully. Theoretical results are presented for the proposed NTOA scheme (6) [as well as the noise-polluted NTOA scheme (7)] to show its excellent performance in motion planning and its remarkable noise suppression capability. On the basis of the PA10 robot manipulator with point and window-shaped obstacles and different kinds of noise, simulation results are provided to further substantiate the efficacy and superiority of the proposed NTOA scheme (6).

## Author Contributions

DG had the basic ideas and made lots of research on neural dynamics and its application to redundant robot manipulators. FX made detailed scheme simulations and summarized the research results in the manuscript. LY, ZN, and HS revised the manuscript duly and carefully. All of the authors discussed the results at length.

## Funding

This work is supported by the National Natural Science Foundation of China (with number 61603143 and 61572534), the Natural Science Foundation of Fujian Province (with number 2016J01307), the Promotion Program for Young and Middle-aged Teacher in Science and Technology Research of Huaqiao University (with number ZQN-YX402 and ZQN-PY408), and also the Scientific Research Funds of Huaqiao University (with number 15BS410).

## Conflict of Interest Statement

The authors declare that the research was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.

## Acknowledgments

The authors would also like to thank the editors and reviewers sincerely for their time and effort spent in handling the paper, as well as the constructive comments for further improving the presentation and quality of this paper.

## Supplementary Material

The Supplementary Material for this article can be found online at: https://www.frontiersin.org/articles/10.3389/fnbot.2018.00051/full#supplementary-material

## References

Chen, D., and Zhang, Y. (2016). Minimum jerk norm scheme applied to obstacle avoidance of redundant robot arm with jerk bounded and feedback control. *IET Control Theory Appl.* 10, 1896–1903. doi: 10.1049/iet-cta.2016.0220

Chen, J.-L., Liu, J.-S., Lee, W.-C., and Liang, T.-C. (2002). On-line multi-criteria based collision-free posture generation of redundant manipulator in constrained workspace. *Robotica* 20, 625–636. doi: 10.1017/S0263574702004204

De Luca, A., Lanari, L., and Oriolo, G. (1992). “Control of redundant robots on cyclic trajectories,” in *Proceedings 1992 IEEE International Conference on Robotics and Automation*, 500–506.

Flacco, F., and De Luca, A. (2015). Discrete-time redundancy resolution at the velocity level with acceleration/torque optimization properties. *Robot. Auton. Syst.* 70, 191–201. doi: 10.1016/j.robot.2015.02.008

Florchinger, P. (2000). Feedback stabilization of a torque controlled rigid robot corrupted by noise. *Dyn. Control* 10, 229–238. doi: 10.1023/A:1008362711093

Gaudiano, P., Zalama, E., and Coronado, J. L. (1996). An unsupervised neural network for low-level control of a wheeled mobile robot: noise resistance, stability, and hardware implementation. *IEEE Trans. Syst. Man Cybern. B Cybern.* 26, 485–496.

Guo, D., and Li, K. (2016). “Acceleration-level obstacle-avoidance scheme for motion planning of redundant robot manipulators,” in *2016 IEEE International Conference on Robotics and Biomimetics* (Qingdao), 1313–1318.

Guo, D., Nie, Z., and Yan, L. (2017). The application of noise-tolerant ZD design formula to robots' kinematic control via time-varying nonlinear equations solving. *IEEE Trans. Syst. Man Cybern.* 1–10. doi: 10.1109/TSMC.2017.2705160

Guo, D., and Zhang, Y. (2012). A new inequality-based obstacle-avoidance MVN scheme and its application to redundant robot manipulators. *IEEE Trans. Syst. Man Cybern.* 42, 1326–1340. doi: 10.1109/TSMCC.2012.2183868

Guo, D., and Zhang, Y. (2014). Acceleration-level inequality-based MAN scheme for obstacle avoidance of redundant robot manipulators. *IEEE Trans. Ind. Electron.* 61, 6903–6914. doi: 10.1109/TIE.2014.2331036

He, X., Li, C., Huang, T., and Li, C. (2014a). Neural network for solving convex quadratic bilevel programming. *Neural Netw.* 51, 17–25. doi: 10.1016/j.neunet.2013.11.015

He, X., Li, C., Huang, T., Li, C., and Huang, J. (2014b). A recurrent neural network for solving bilevel linear programming problem. *IEEE Trans. Neural Netw. Learn. Syst.* 25, 824–830. doi: 10.1109/TNNLS.2013.2280905

Jin, L., and Li, S. (2018). Distributed task allocation of multiple robots: a control perspective. *IEEE Trans. Syst. Man Cybern.* 48, 693–701. doi: 10.1109/TSMC.2016.2627579

Jin, L., Li, S., Xiao, L., Lu, R., and Liao, B. (2017a). Cooperative motion generation in a distributed network of redundant robot manipulators with noises. *IEEE Trans. Syst. Man Cybern.* 1–10. doi: 10.1109/TSMC.2017.2693400

Jin, L., Zhang, Y., and Li, S. (2016a). Integration-enhanced Zhang neural network for real-time-varying matrix inversion in the presence of various kinds of noises. *IEEE Trans. Neural Netw. Learn. Syst.* 27, 2615–2627.

Jin, L., Zhang, Y., Li, S., and Zhang, Y. (2016b). Modified ZNN for time-varying quadratic programming with inherent tolerance to noises and its application to kinematic redundancy resolution of robot manipulators. *IEEE Trans. Ind. Electron.* 63, 6978–6988. doi: 10.1109/TNNLS.2015.2497715

Jin, L., Zhang, Y., Li, S., and Zhang, Y. (2017b). Noise-tolerant ZNN models for solving time-varying zero-finding problems: a control-theoretic approach. *IEEE Trans. Autom. Control* 62, 992–997. doi: 10.1109/TAC.2016.2566880

Lee, K.-K., and Buss, M. (2007). “Obstacle avoidance for redundant robots using Jacobian transpose method,” in *IEEE/RSJ International Conference on Intelligent Robots and Systems* (San Diego, CA), 3509–3514.

Li, C., Yu, X., Huang, T., Chen, G., and He, X. (2016). A generalized Hopfield network for nonsmooth constrained convex optimization: lie derivative approach. *IEEE Trans. Neural Netw. Learn. Syst.* 27, 308–321. doi: 10.1109/TNNLS.2015.2496658

Li, L., Gruver, W. A., Zhang, Q., and Yang, Z. (2001). Kinematic control of redundant robots and the motion optimizability measure. *IEEE Trans. Syst. Man Cybern.* 31, 155–160. doi: 10.1109/3477.907575

Li, M., Li, Y., Ge, S. S., and Lee, T. H. (2017). Adaptive control of robotic manipulators with unified motion constraints. *IEEE Trans. Syst. Man Cybern.* 47, 184–194. doi: 10.1109/TSMC.2016.2608969

Li, S., He, J., Li, Y., and Rafique, M. U. (2017a). Distributed recurrent neural networks for cooperative control of manipulators: a game-theoretic perspective. *IEEE Trans. Neural Netw. Learn. Syst.* 28, 415–426. doi: 10.1109/TNNLS.2016.2516565

Li, S., Wang, H., and Rafique, M. U. (2018). A novel recurrent neural network for manipulator control with improved noise tolerance. *IEEE Trans. Neural Netw. Learn. Syst.* 29, 1908–1918. doi: 10.1109/TNNLS.2017.2672989

Li, S., Zhang, Y., and Jin, L. (2017b). Kinematic control of redundant manipulators using neural networks. *IEEE Trans. Neural Netw. Learn. Syst.* 28, 2243–2254. doi: 10.1109/TNNLS.2016.2574363

Lian, J., and Wang, J. (2015). Passivity of switched recurrent neural networks with time-varying delays. *IEEE Trans. Neural Netw. Learn. Syst.* 26, 357–366. doi: 10.1109/TNNLS.2014.2379920

Maciekewski, A. A., and Klein, C. A. (1985). Obstacle avoidance for kinematically redundant manipulators in dynamically varying environments. *Int. J. Robot. Res.* 4, 109–117.

Marcos, M. G., Machado, J. A. T., and Azevedo-Perdicoúlis, T.-P. (2012). A multi-objective approach for the motion planning of redundant manipulators. *Appl. Soft Comput.* 12, 589–599. doi: 10.1016/j.asoc.2011.11.006

Qiu, B., Zhang, Y., and Yang, Z. (2016). Revisit and compare Ma equivalence and Zhang equivalence of minimum velocity norm (MVN) type. *Adv. Robot.* 30, 416–430. doi: 10.1080/01691864.2015.1120243

Ren, B., Ge, S. S., Tee, K. P., and Lee, T. H. (2010). Adaptive neural control for output feedback nonlinear systems using a barrier Lyapunov function. *IEEE Trans. Neural Netw.* 21, 1339–1345. doi: 10.1109/TNN.2010.2047115

Siciliano, B., Sciavicco, L., Villani, L., and Oriolo, G. (2009). *Robotics: Modelling, Planning and Control*. London: Springer-Verlag.

Siu, K.-C., Suh, I. H., Mukherjee, M., Oleynikov, D., and Stergiou, N. (2010). The impact of environmental noise on robot-assisted laparoscopic surgical performance. *Surgery* 147, 107–113. doi: 10.1016/j.surg.2009.08.010

Ting, J.-A., Souza, A., and Schaal, S. (2011). Bayesian robot system identification with input and output noise. *Neural Netw.* 24, 99–108. doi: 10.1016/j.neunet.2010.08.011

Wang, D., and Hamam, Y. (1992). Optimal trajectory planning of manipulators with collision detection and avoidance. *Int. J. Robot. Res.* 11, 460–468.

Xiao, L., and Zhang, Y. (2016). Dynamic design, numerical solution and effective verification of acceleration-level obstacle avoidance scheme for robot manipulators. *Int. J. Syst. Sci.* 47, 932–945. doi: 10.1080/00207721.2014.909971

Yildirim, S., and Eski, I. (2010). Noise analysis of robot manipulator using neural networks. *Robot. Comput. Integr. Manuf.* 26, 282–290. doi: 10.1016/j.rcim.2009.10.001

Zhang, Y., Jiang, D., and Wang, J. (2002). A recurrent neural network for solving Sylvester equation with time-varying coefficients. *IEEE Trans. Neural Netw.* 13, 1053–1063. doi: 10.1109/TNN.2002.1031938

Zhang, Y., and Wang, J. (2004). Obstacle avoidance for kinematically redundant manipulators using a dual neural network. *IEEE Trans. Syst. Man Cybern. Part B* 34, 752–759. doi: 10.1109/TSMCB.2003.811519

Zhang, Y., Yan, X., Chen, D., Guo, D., and Li, W. (2016). QP-based refined manipulability-maximizing scheme for coordinated motion planning and control of physically constrained wheeled mobile redundant manipulators. *Nonlinear Dyn.* 85, 245–261. doi: 10.1007/s11071-016-2681-9

Keywords: obstacle avoidance, noise tolerant, pseudoinverse-type formulation, redundant robot manipulators, motion planning

Citation: Guo D, Xu F, Yan L, Nie Z and Shao H (2018) A New Noise-Tolerant Obstacle Avoidance Scheme for Motion Planning of Redundant Robot Manipulators. *Front. Neurorobot*. 12:51. doi: 10.3389/fnbot.2018.00051

Received: 15 May 2017; Accepted: 07 August 2018;

Published: 29 August 2018.

Edited by:

Florian Röhrbein, Technische Universität München, GermanyReviewed by:

Bolin Liao, Jishou University, ChinaZhijun Zhang, South China University of Technology, China

Dechao Chen, Sun Yat-sen University, China

Weibing Li, University of Leeds, United Kingdom

Xing He, Southwest University, China

Jörn Fischer, Mannheim University of Applied Sciences, Germany

Copyright © 2018 Guo, Xu, Yan, Nie and Shao. This is an open-access article distributed under the terms of the Creative Commons Attribution License (CC BY). The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.

*Correspondence: Dongsheng Guo, gdongsh@hqu.edu.cn