Journal of Robotics

Volume 2018, Article ID 1520981, 7 pages

https://doi.org/10.1155/2018/1520981

## A Novel Path Control Algorithm for Networked Underwater Robot

^{1}School of Automation, Chongqing University, Chongqing, China^{2}Computer College, Chongqing College of Electronic Engineering, Chongqing, China

Correspondence should be addressed to Minghong She; moc.621@ehs_hm

Received 13 December 2017; Accepted 20 May 2018; Published 2 July 2018

Academic Editor: Keigo Watanabe

Copyright © 2018 Minghong She and Liyu Tian. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

#### Abstract

Under the network environment, the traditional control method of underwater Robot path has the disadvantages of low control accuracy, large error, and inefficiency. This paper proposes a novel path control method for underwater Robots based on the NURBS (nonuniform rational B-spline, NURBS) curve fitting method, which utilizes a sensor or camera to detect the static and dynamic obstacles, establishes the kinematics model of underwater Robots, gets the target function of rob shortest path, and analyzes underwater Robot constraints. According to the basic fluid mechanics, the resistance of the underwater Robot is determined. The filter function is used to smooth the process, and the NURBS curve fitting method is applied to control the path of the underwater Robot. Experimental results show that the improved method that proved to be practical is superior to the traditional one in the aspect of control time and accuracy.

#### 1. Introduction

With the depletion of land resources, money, time, and manpower are invested to develop underwater resources [1]. Therefore, underwater Robots are a concern for people of many countries [2]. In order to complete an underwater task for one time, a variety of underwater Robots complex operation and safe navigation are to be carried out in accordance with the corresponding navigation path [3, 4].

To achieve the best navigation plan and keep the underwater Robot running on the scheduled course [5], it is necessary to ensure the maneuverability of the underwater Robot [6, 7]. When the underwater Robot has good handling performance, it cannot only maintain stable driving course, depth, and speed but also quickly change the heading, depth, and speed and correctly perform all kinds of operations [8]. The path control of underwater Robot affects the performance of underwater Robot [9]. The method of networking can effectively control the running path of underwater Robots and shorten the control time [10, 11]. Therefore, the underwater Robot path control under the networked environment has become the focus of research in this field and has attracted the attention of many scholars.

Mahmoodabadi, Mohammad Javad et al. [12] mainly aims at controlling the path of underwater Robot when the underwater Robot is avoiding the obstacle and the direction of movement is not corrected. Based on the establishment of integrated navigation model and the detection based dynamic obstacle avoidance strategy, the discrete time multithread concurrent simulation framework and model are used to design the effective control of underwater Robot path. However, the method wastes much time. Zanoli, Silvia M., and Giuseppe Conte [13] aim at resolving the problem of low control speed or zero speed state in traditional control method, and the frame control moment gyroscope is introduced as the path control executive mechanism to realize the path control of the underwater Robot. This method can effectively shorten the control time of the path, but with a problem of low control accuracy [14].

To solve the above problems, a path control method of underwater Robot based on NURBS curve fitting method is proposed. The experimental results show that the control accuracy and efficiency are improved by adopting the presented control method.

#### 2. Construction of Kinematics Model of Underwater Robot

When the underwater Robot is effectively controlled under the condition of network, it is necessary to have a good understanding of the underwater Robot. The use of sensors or cameras to detect static and dynamic obstacles and the establishment of underwater Robot kinematics model can improve the path control method to provide the basis.

When the kinematic model of the underwater Robot is established, the head adjustment of the target underwater Robot can be obtained by adjusting the amount of integration processing [15]. The kinematic model is given bywhere is output value and is weighted coefficient.

For the existence of the interference of underwater Robots, the use of arithmetic mean filtering method for filtering to eliminate the Gaussian noise has a positive effect [16]. When using the most single arithmetic mean filter, the data received at each time is replaced by the average of the received data in the neighborhood of the length of time. The expression iswhere is constant, is the number of filters, and is the wavelength of filter.

In the filter, the high frequency of interference removal effect will not achieve the best results. In this case, it is necessary to suppress a higher frequency of interference by adding a virtual damping force [17, 18]. This makes the response of the underwater Robot relatively slow, increasing its stability. The expression iswhere is the sampling period, is the inertia constant, is the time deviation of , and is the response time of time .

In the case of satisfying the absolute stability of the underwater Robot, the positive moment is used as the stability storage device [18] and then the balance coefficient can be changed as follows:

During the operation of the underwater Robot, the obstacle in the underwater environment will form a certain potential field and the repulsion force of is generated for the underwater Robot. The closer the distance is, the larger will; that is to say, the closer the underwater Robot and the obstacle, the greater the potential energy of the underwater Robot and vice versa [19]. This potential field is similar to the potential field, inversely proportional to the distance, so the repulsive potential function can be expressed aswhere is the repulsive potential field constant, is the position vector of the underwater Robot, is the obstacle position vector in the water, is the shortest distance between the underwater Robot and the obstacle, and is the range of the repulsive potential field. When the distance between the underwater Robot and the obstacle is greater than , the repulsive potential field does not interfere with the operation of the underwater Robot.

To avoid the collision between the underwater Robot and the obstacle, it is required to set a minimum safe distance , when and , and to ensure that is continuous, the expression of is

Based on the above, sensors or cameras are used to monitor static and dynamic underwater obstacles and to obtain the position, speed, and acceleration information of obstacles in real time. These messages can fuse into moving obstacles. A number of navigation paths represented by time can be used in the obstacle motion constraints of underwater Robots. Suppose that is a rigid body with a center of and is a continuous real vector valued function, also the path of motion obstacles. Suppose that the underwater Robot and obstacle can be represented by and , respectively, . When the constraint of the underwater Robot is without lateral collision and the general coordinate system is , the kinematic model of the underwater Robot is expressed as follows:where and are, respectively, tangential velocity and angular velocity. In the navigation process, the speed of underwater Robot should be regulated within the maximum allowable speed to prevent the underwater Robot from colliding; meanwhile the underwater Robot must follow the rules of acceleration.

#### 3. Improvement of Path Control Method for Underwater Robot

##### 3.1. Constraint Analysis

According to the kinematic model of the underwater Robot, the objective function of minimizing the path length is obtained:

On this basis, various constraints are introduced into the objective function as the penalty term and the expression of the self-adaptation function is obtained:where is a larger value that is penalized for breaking the constraint, ; is the boundary area of its activity. Their constraint types are as follows:

*(i) Boundary Constraint. *Assuming that is the boundary of the selected area, the underwater Robot should be subject to the following motion boundary constraints during the moving process:

*(ii) Movement Restriction. *In the process of underwater Robot navigation, there is a certain motion constraint. When the ship is sailing along the planning path, its acceleration and speed are prevented from colliding in the prescribed area. In literature [20], its motion constraint is expressed as follows:

*(iii) Obstacle Avoidance Constraint. *To ensure that underwater Robots maintain a minimum safe distance from other static or moving underwater obstacles during navigation, and are setting as the given safety distance and actual distance of and , respectively; therefore, is expressed as

where . Thus, in , should satisfy the following barrier constraints:

##### 3.2. Implementation of the Proposed Method

Based on the analysis of constraints for underwater Robot and the basic fluid mechanics, the resistance of underwate**r** Robot is determined, the filter functions are smoothed, and underwater Robot path is controlled by using NURBS curve fitting method

In view of the basic fluid dynamics, the total resistance of the underwater Robot can be divided into frictional resistance and residual resistance . When the underwater Robot is in water for a long period of time, the wave resistance is negligible and the resistance is as follows:where is the density of water, is the speed of underwater Robot, is wet surface area, is friction resistance coefficient, is friction resistance subsidy coefficient, and is viscosity resistance coefficient.

Supposing that the running path of an underwater Robot can be represented by a weighted directed graph , in which the set is a set of fixed points, is the fixed-point number of the fixed-point set, is the arc set of the arc, is the arc from to in , and is the nonnegative weight of the arc . Assuming that and are the paths from vertex to in , the expression is as follows:

For a path sequence consisting of path points, the length of the path iswhere is the straight-line distance of the and path segments. The evaluation function is , including the fact that is the linear length of and . When , the path length is the shortest; that is, the underwater Robot can sail straight from to . Considering the operating state of underwater Robot as a discrete process, the position of some obstacles will change, causing it to be controlled in the wrong direction. So the filtering function is used to smooth the filtering function:where is the density of obstacles after smoothing and is the filter length.

It is assumed that the entire underwater Robot path using the algorithm is , including the fact that is the obstacle node on the path, and the Euclidean distance between all two adjacent obstacles is defined aswhere is the coordinates of the grid node .

The minimum turning radius is the limit condition which cannot be ignored in underwater Robot path planning. Path control adopts the NURBS curve fitting method to determine the minimum turning radius of the underwater Robot, so as to realize the rapid and safe navigation of the underwater Robot in water. Expression is as follows:In (19), is the turning radius of the path point. When , the path control caused by the turning is infinite, not worth the candle.

In order to satisfy the minimum turning radius of an underwater Robot, the maximum curvature of the optimal path generated must satisfy the following constraints:

For the underwater Robots with different running paths, it is possible to satisfy the minimum turning radius requirement of the underwater Robot by selecting the appropriate parameter to set up the upper model. The path control method obtained from the previous analysis is in accord with the control characteristics and motion characteristics of the underwater Robot.

#### 4. Simulation Results

In order to verify the effectiveness and feasibility of the improved control method, it is necessary to make a comparative analysis of the improved methods. The experiment is simulated by MATLAB, and the result is compared by NURBS curve fitting method. The simulated cable detection underwater Robot is shown in Figure 1. The hardware test platform is under the condition of single-phase inverter unit and controlled rectifier of model PM201CL1A061. Platform identification algorithm is DSP27334 main control chip. The production company is TI.