CN109782779A - AUV paths planning method under ocean current environment based on population meta-heuristic algorithms - Google Patents
AUV paths planning method under ocean current environment based on population meta-heuristic algorithms Download PDFInfo
- Publication number
- CN109782779A CN109782779A CN201910209731.XA CN201910209731A CN109782779A CN 109782779 A CN109782779 A CN 109782779A CN 201910209731 A CN201910209731 A CN 201910209731A CN 109782779 A CN109782779 A CN 109782779A
- Authority
- CN
- China
- Prior art keywords
- population
- individual
- auv
- cost
- solution
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 53
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 39
- 239000013598 vector Substances 0.000 claims abstract description 36
- 230000008569 process Effects 0.000 claims description 10
- 230000035772 mutation Effects 0.000 claims description 6
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 6
- 238000011156 evaluation Methods 0.000 claims description 3
- 238000010606 normalization Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 238000009827 uniform distribution Methods 0.000 claims description 3
- 238000005457 optimization Methods 0.000 description 11
- 238000005265 energy consumption Methods 0.000 description 9
- 230000009471 action Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000002159 abnormal effect Effects 0.000 description 2
- 239000002245 particle Substances 0.000 description 2
- 238000010845 search algorithm Methods 0.000 description 2
- 241000251468 Actinopterygii Species 0.000 description 1
- 206010063385 Intellectualisation Diseases 0.000 description 1
- 241000254158 Lampyridae Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
Landscapes
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
The invention discloses AUV paths planning methods under the ocean current environment based on population meta-heuristic algorithms, belong to underwater robot field.Initialization population first obtains the initial synthetic cost value of all individuals in entire population further according to cost function;Then population basic operation set and corresponding operation select probability vector are set;The corresponding population basic operation of maximum probability in an individual in selected population, and operation select probability vector, operates the individual, repeats the population basic operation until traversing entire population, completes an iteration;Operation select probability vector is adjusted again, next iteration is carried out, until the number of iterations reaches setting value;Finally after the completion of iteration, the smallest individual of cost value is selected, one group of control point is constituted in conjunction with the starting point of B-spline curves, terminal and fixed control point, regenerates optimal path.The present invention solve the problems, such as the path of existing AUV paths planning method planning is rough, be difficult to track and track consume energy it is high.
Description
Technical Field
The invention belongs to the field of underwater robots, and relates to an AUV path planning method in an ocean current environment based on a population hyperheuristic algorithm.
Background
AUV, Autonomous Underwater Vehicle, also called Autonomous Underwater robot, has the advantages of large range of motion, good maneuverability, safety, intellectualization and the like, and is an important tool for completing various Underwater tasks. The traditional path planning method for the mobile robot mainly represents the environment as a discretized grid map, and searches the absolute shortest path from a starting point to an end point by adopting search algorithms such as D and A. The path planning method based on search has two problems, on one hand, when the size of a map is increased, especially when the map is expanded to a three-dimensional space, the efficiency of a search algorithm is sharply reduced; on the other hand, the method results in a discrete, non-smooth path which is difficult for the robot to track, especially for under-driven robots.
Because the torpedo type AUV only depends on the propeller at the tail to generate power, the torpedo type AUV is a typical under-actuated system, and the mode that the existing mobile robot obtains a discrete path is difficult to apply to the torpedo type AUV of the under-actuated system. Therefore, the AUV path planning method puts higher requirements on the smoothness of the planned path, and the path not only needs to be smooth, but also cannot exceed the maximum turning radius.
In addition, the underwater movement of the AUV is greatly influenced by ocean current information, when the difference between the movement direction of the AUV and the flow direction of the ocean current is large, the movement precision of the AUV is greatly influenced, and the AUV consumes extra energy for keeping the original route. Therefore, the path planned by the path planning method of the AUV not only has a requirement on smoothness, but also needs to follow the direction of ocean current movement as much as possible, so that the AUV has higher movement precision and more energy-saving capability.
A B spline curve is used for representing an AUV motion path, the position of a control point of the AUV motion path is used as a parameter, and a path planning problem is modeled into a nonlinear optimization problem under a multi-constraint condition, so that the final path can meet various constraints. The population-based meta-heuristic algorithm has great advantages in solving the nonlinear optimization problem, such as a firefly algorithm, a particle swarm algorithm, a fish swarm algorithm and the like. Many similar algorithms have appeared in recent years, and scholars consider the algorithms to lack innovativeness but change similar ideas into a simulation scene. Therefore, a population meta-heuristic algorithm trying to synthesize a population meta-heuristic algorithm is generated, a meta-heuristic algorithm framework is designed by managing population operation, and a simulated scene replacement algorithm with low innovation is stopped.
The' 2018105195080 patent discloses a UUV energy consumption optimization-based remote marine path planning method that takes into account the effects of ocean circulation. Firstly, determining the actual ground navigation speed of a UUV and real-time updated ocean current information; initializing various parameters required by an optimization algorithm; randomly generating path control nodes through spatial decomposition modeling, and generating an initial path by using B-Spline fitting; then entering a QPSO algorithm iteration process, calculating the average optimal position of particles corresponding to the current path, and calculating the energy consumption of the UUV corresponding to the current path; and finally, determining a final optimal solution through a corresponding optimization process, outputting a final path control node, and fitting according to the final control node to generate a path track with optimal energy consumption. According to the method, a B spline curve represents a path, a QPSO algorithm is adopted for optimizing and selecting the position of a control point of the spline curve, but the optimization function takes the UUV dynamic model into consideration and is at the cost of actual energy consumption, the calculation is complex, and the method is difficult to extend to other types of UUV.
The' 2014107663462 patent discloses an underwater vehicle path planning method based on dynamic planning. Under the condition that the future condition of ocean current is known, firstly, rasterizing an area to be planned, then, calculating time values consumed between search points by using a speed synthesis model, and planning a reachable optimal path in a two-dimensional plane by using a dynamic planning algorithm by taking the time values as weights. The method searches for a path meeting ocean current information on a rasterized map, and the obtained path meets ocean current constraints but cannot meet smoothness constraints.
Therefore, aiming at the problems, the invention provides an AUV path planning method in an ocean current environment based on a population hyperheuristic algorithm.
Disclosure of Invention
The invention aims to: the AUV path planning method based on the population hyperheuristic algorithm in the ocean current environment is provided, and the problems that the path planned by the existing AUV path planning method is not smooth, is difficult to track and has high energy consumption are solved.
The technical scheme adopted by the invention is as follows:
an AUV path planning method in an ocean current environment based on a population hyperheuristic algorithm comprises the following steps:
step 1: initializing a population, and obtaining initial comprehensive cost values of all individuals in the whole population according to a cost function which integrates time efficiency, an environment map, an AUV body motion curvature radius and ocean current information constraint;
step 2: setting a population basic operation set and a corresponding operation selection probability vector; selecting an individual in the population, then selecting a population basic operation corresponding to the maximum probability in the probability vector by a selection operation, using the population basic operation for the individual, and updating the comprehensive cost value of the individual; repeating the process until the whole population is traversed, and finishing one iteration; then, adjusting operation selection probability vectors, and performing next iteration until the iteration times reach a set value;
and step 3: after iteration is finished, selecting an individual with the minimum cost value, namely an optimal individual, combining a starting point, an end point and a fixed control point of the B spline curve to form a group of control points, and generating an optimal path by the group of control points.
Further, the specific steps of step 1 are:
step 1.1: setting a starting point and an end point of the AUV path, connecting the starting point and the end point, generating M equally divided points on the connecting line, drawing a vertical line on each equally divided point according to the connecting line of the starting point and the end point to obtain M vertical lines, and generating i on each vertical linemaxA random point, thereby obtaining imaxThe set of random points, the ith set of random points being denoted as RPM,i(rp1,i,rp2,i,…rpk,i,…rpM,i,rpk,i∈R2),i∈(1,2,…,imax);
Step 1.2: from the starting pointStarting from a fixed control point p, which is added a short distance in the direction of the AUV start1Starting from the end point, a fixed control point p is added by a short distance in the opposite direction to the direction of termination of the AUV2For controlling the starting and ending directions of the curved path;
step 1.3: according to step 1.1 and step 1.2, with a start point, an end point, a set of random points RPM,i(rp1,i,rp2,i,…rpk,i,…rpM,i,rpk,i∈R2) Fixed control point p1And a fixed control point p2As the control points of one B-spline curve, the number of the control points is n, where n is M +4, and the positions of the control points areCombining the curve order K to obtain i consisting of discrete pointsmaxB spline curve, the curve equation is:
wherein, Bi,K(t) is the basis function of a K-th order B-spline curve;
step 1.4: from imaxB-spline curve to obtain imaxAn AUV path, represented as:
wherein the orientation ψ of the AUV is:
step 1.5: will imaxInitializing a group of random points to obtain a population, and initializing a group of random points RPM,i(rp1,i,rp2,i,…rpk,i,…rpM,i,rpk,i∈R2) Representing an individual, i.e. a solution xiWherein, the dimension of the individual is M, and the number of the individual is imaxThe population P is:
that is to say that the first and second electrodes,
step 1.6: calculating the initial cost value of each individual according to a cost function integrating time efficiency, an environment map, an AUV body motion curvature radius and ocean current information constraint, wherein the cost function combines time and a penalty function, and the expression is as follows:
wherein, TcostIs a time penalty, obtained by dividing the path distance by the average velocity,
ρcostis the curvature cost, obtained by accumulating the approximate curvature at each discrete point,
Mcostis the map cost, obtained by accumulating the values of each discrete point on the map (1 for obstacles, 0 for regions),
Ocostthe method is characterized in that ocean current information constraint is achieved by accumulating the product of the included angle of the path direction of each discrete point and the water flow direction and the water flow vector modulus, and h is the number of discrete points on a B spline curve;
step 1.7: respectively carrying out normalization processing on the four initial cost values, wherein different cost values have different dimensions and pass through the maximum cost valueAnd minimum cost valueTo obtain a normalized cost value
Step 1.8: and weighting and summing the four normalized cost values through different weights to obtain the initial comprehensive cost values of all individuals in the whole population P:
wherein, ω is1,ω2,ω3,ω4Are weights of different cost values.
Further, the specific steps of step 2 are:
step 2.1: setting a population basic operation set and a corresponding operation selection probability vector, wherein the population basic operation is o<·>Representing that for an input solution xt, a new solution x is output after one iterationt+1The expression is o<xt>=xt+1The population basic operation is randomly moved, randomly jumped for a long distance, an individual with a following cost value smaller than the population basic operation, an individual with a minimum following cost value, an individual with the best following history or mutation, and the population basic operation set combines and represents the population basic operation as O- { O-1,o2,…,okAnd (5) each group basic operation corresponds to an operation selection probability vector which is P- { P1,p2,...,pk};
Step 2.2: selecting one individual of the population P of step 1.5And the reselection operation selects the population basic operation o corresponding to the maximum probability in the probability vectori;
Step 2.3: basic operations on individuals selected in step 2.2 using populationiAnd updating the comprehensive cost value of the current individual according to the steps 1.6 to 1.8;
step 2.4: repeating steps 2.2 and 2.3 until the whole population is traversed, using the population basic operation o once for each individualiThen, completing one iteration;
step 2.5: and (4) evaluating the operation condition of the iteration in the step (2.4), adjusting the operation selection probability vector, and returning to the step (2.2) for the next iteration until the iteration number reaches a set value.
Further, in the population basic operation of step 2.1:
the random shift refers to a shift solution xiTo its neighborhood, the expression is: x is the number ofi:=xi+λminRand u, where λminIs the step size of the centralized search,is a random number subject to uniform distribution, u is a random unit direction vector;
the random long-distance jitter is a moving solution xiTo the remote location, the expression is: x is the number ofi:=xi+λmaxU, where λmaxIs the step size of the diversity search, u is the vector in the random unit direction;
the individuals with less follow-up cost value than themselves mean that x is solvediTo all cost values less than xiThe solution of (2) is shifted by the expression: x is the number ofi:=xi+λ·rand·(xj-xi) For all satisfy f (x)j)<f(xi) Solution x ofjX is solvediAll move towards it;
the following cost value is the mostSmall individuals mean that x will be solvediMoving to the solution with the minimum cost value, namely the optimal solution, the expression is: x is the number ofi:=xi+λ·rand·(xb-xi) Wherein x isbIs a solution of the optimal individual representation in the population;
the history following the best individual means that the solution x is to be solvediThe position of the individual with the minimum cost value, namely the individual with the best history, obtained after the individual is evolved for multiple times is moved, and the expression is as follows:wherein,represents the solution xiHistorical best position of;
the mutation refers to solving xiMutation to obtain a new solution xi′。
Furthermore, the evaluation of the iteration of step 2.4 in step 2.5 is performed to ensure that the centralized index, which is evaluated by the best cost value before and after the iteration, is balanced with the diversity indexAndthe size relationship of (a); the diversity index is evaluated by the sum of the distances of all solutions and the central solution, and the formula is as follows:wherein the central solutionI.e. according to dt-1And dtIs determined by the magnitude relationship of (a).
In summary, due to the adoption of the technical scheme, the invention has the beneficial effects that:
1. the AUV path planning method based on the population hyperheuristic algorithm in the ocean current environment adopts the B spline curve to represent the AUV path, optimizes and selects the control point position of the B spline curve by using the population hyperheuristic algorithm, and further obtains the optimal path meeting the time efficiency, the environment map, the AUV body motion curvature radius and the ocean current information constraint, the obtained path is continuous and smooth and meets the ocean current information constraint, and the AUV tracking difficulty and the tracking energy consumption are reduced.
2. The B spline curve adopted by the invention can obtain a complex and smooth path by using a small number of control points, and the ocean current information constraint is defined only through the geometric relationship between the path and the ocean current information, so that the complexity of the method is reduced.
3. The invention models the path planning problem into a nonlinear optimization problem by using a cost function, and solves the problem by using the population hyperheuristic algorithm to further obtain the B-spline curve control points.
Drawings
In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings that are required to be used in the embodiments will be briefly described below, it should be understood that the following drawings only illustrate some embodiments of the present invention and therefore should not be considered as limiting the scope, and that for those skilled in the art, other relevant drawings can be obtained according to the drawings without inventive effort, wherein:
FIG. 1 is a flow chart of an AUV path planning method in an ocean current environment based on a population hyperheuristic algorithm;
FIG. 2 is a schematic diagram of the fixed control points in step 1.2 of the present invention;
FIG. 3 is a diagram illustrating the path planning result in an environment containing only ocean current information according to the present invention;
FIG. 4 is a diagram illustrating the results of the path planning in an environment containing obstacle and ocean current information according to the present invention;
FIG. 5 is a graph of the time and cost stability analysis of the invention running 200 times.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the detailed description and specific examples, while indicating the preferred embodiment of the invention, are intended for purposes of illustration only and are not intended to limit the scope of the invention. The components of embodiments of the present invention generally described herein and illustrated in the figures may be arranged and designed in a wide variety of different configurations.
Thus, the following detailed description of the embodiments of the present invention, presented in the figures, is not intended to limit the scope of the invention, as claimed, but is merely representative of selected embodiments of the invention. All other embodiments, which can be derived by a person skilled in the art from the embodiments of the present invention without making any creative effort, shall fall within the protection scope of the present invention.
It is noted that relational terms such as "first" and "second," and the like, may be used solely to distinguish one entity or action from another entity or action without necessarily requiring or implying any actual such relationship or order between such entities or actions. Also, the terms "comprises," "comprising," or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or apparatus. Without further limitation, an element defined by the phrase "comprising an … …" does not exclude the presence of other identical elements in a process, method, article, or apparatus that comprises the element.
The AUV path planning method based on the population hyperheuristic algorithm in the ocean current environment solves the problems that the path planned by the existing AUV path planning method is not smooth, is difficult to track and has high energy consumption.
An AUV path planning method in an ocean current environment based on a population hyperheuristic algorithm comprises the following steps:
step 1: initializing a population, and obtaining initial comprehensive cost values of all individuals in the whole population according to a cost function which integrates time efficiency, an environment map, an AUV body motion curvature radius and ocean current information constraint;
step 2: setting a population basic operation set and a corresponding operation selection probability vector; selecting an individual in the population, then selecting a population basic operation corresponding to the maximum probability in the probability vector by a selection operation, using the population basic operation for the individual, and updating the comprehensive cost value of the individual; repeating the process until the whole population is traversed, and finishing one iteration; then, adjusting operation selection probability vectors, and performing next iteration until the iteration times reach a set value;
and step 3: after iteration is finished, selecting an individual with the minimum cost value, namely an optimal individual, combining a starting point, an end point and a fixed control point of the B spline curve to form a group of control points, and generating an optimal path by the group of control points.
According to the method, the AUV path is represented by the B spline curve, and a complex and smooth path can be obtained by using a small number of control points; modeling the path planning problem into a nonlinear optimization problem by using a cost function, and optimizing and selecting the control point position of the B spline by using a population hyperheuristic algorithm, wherein the population hyperheuristic algorithm integrates the advantages of various population element heuristic algorithms, has great advantages when solving the nonlinear optimization problem, and is simple in calculation and better in convergence; further, an optimal path satisfying time efficiency, an environment map, an AUV body motion curvature radius and ocean current information constraint is obtained, the ocean current information constraint is defined only through the geometric relation between the path and the ocean current information, and the complexity of the method is reduced; the finally obtained path is continuous and smooth and meets the ocean current information constraint, and the tracking difficulty and the tracking path energy consumption of the robot are reduced.
The features and properties of the present invention are described in further detail below with reference to examples.
Example one
The preferred embodiment of the present invention provides an AUV path planning method in an ocean current environment based on a population hyperheuristic algorithm, as shown in fig. 1, including the following steps:
step 1: initializing a population, and obtaining initial comprehensive cost values of all individuals in the whole population according to a cost function which integrates time efficiency, an environment map, an AUV body motion curvature radius and ocean current information constraint;
step 1.1: setting a starting point and an end point of the AUV path, connecting the starting point and the end point, generating M equally divided points on the connecting line, drawing a vertical line on each equally divided point according to the connecting line of the starting point and the end point to obtain M vertical lines, and generating i on each vertical linemaxA random point, thereby obtaining imaxThe set of random points, the ith set of random points being denoted as RPM,i(rp1,i,rp2,i,…rpk,i,…rpM,i,rpk,i∈R2),i∈(1,2,…,imax);
Step 1.2: starting from the starting point, a fixed control point p is added in a short distance along the starting direction of the AUV1Starting from the end point, a fixed control point p is added by a short distance in the opposite direction to the direction of termination of the AUV2For controlling the starting and ending directions of the curved path;
step 1.3: according to step 1.1 and step 1.2, with a start point, an end point, a set of random points RPM,i(rp1,i,rp2,i,…rpk,i,…rpM,i,rpk,i∈R2) Fixed control point p1And a fixed control point p2As the control points of one B-spline curve, the number of the control points is n, where n is M +4, and the positions of the control points areCombining the curve order K to obtain i consisting of discrete pointsmaxB spline curve, the curve equation is:
wherein, Bi,K(t) is the basis function of a K-th order B-spline curve;
step 1.4: from imaxB-spline curve to obtain imaxAn AUV path, represented as:
wherein the orientation ψ of AUV is
Step 1.5: will imaxInitializing a group of random points to obtain a population, and initializing a group of random points RPM,i(rp1,i,rp2,i,…rpk,i,…rpM,i,rpk,i∈R2) Representing an individual, i.e. a solution xiWherein, the dimension of the individual is M, and the number of the individual is imaxThe population P is:
that is to say that the first and second electrodes,
step 1.6: calculating the initial cost value of each individual according to a cost function integrating time efficiency, an environment map, an AUV body motion curvature radius and ocean current information constraint, wherein the cost function combines time and a penalty function, and the expression is as follows:
wherein, TcostIs a time penalty, obtained by dividing the path distance by the average velocity,
ρcostis the curvature cost, obtained by accumulating the approximate curvature at each discrete point,
Mcostis the map cost, obtained by accumulating the values of each discrete point on the map (1 for obstacles, 0 for regions),
Ocostthe method is characterized in that ocean current information constraint is achieved by accumulating the product of the included angle of the path direction of each discrete point and the water flow direction and the water flow vector modulus, and h is the number of discrete points on a B spline curve;
step 1.7: respectively carrying out normalization processing on the four initial cost values, wherein different cost values have different dimensions and pass through the maximum cost valueAnd minimum cost valueTo obtain a normalized cost value
Step 1.8: and weighting and summing the four normalized cost values through different weights to obtain the initial comprehensive cost values of all individuals in the whole population P:
wherein, ω is1,ω2,ω3,ω4The AUV path planning problem is modeled into a nonlinear cost function minimization problem, wherein the smaller the comprehensive cost value of the AUV path is, the better the AUV path is;
step 2: setting a population basic operation set and a corresponding operation selection probability vector; selecting an individual in the population, then selecting a population basic operation corresponding to the maximum probability in the probability vector by a selection operation, using the population basic operation for the individual, and updating the comprehensive cost value of the individual; repeating the process until the whole population is traversed, and finishing one iteration; then, adjusting operation selection probability vectors, and performing next iteration until the iteration times reach a set value;
step 2.1: setting a population basic operation set and a corresponding operation selection probability vector, wherein the population basic operation is o<·>Represents, solution x to inputtOutputting a new solution x after an iterationt+1The expression is o<xt>=xt+1The population basic operation is randomly moved, randomly jumped for a long distance, an individual with a following cost value smaller than the population basic operation, an individual with a minimum following cost value, an individual with the best following history or mutation, and the population basic operation set combines and represents the population basic operation as O- { O-1,o2,…,okAnd (5) each group basic operation corresponds to an operation selection probability vector which is P- { P1,p2,...,pk}, wherein:
the random shift refers to a shift solution xiTo its neighborhood, the expression is: x is the number ofi:=xi+λminRand u, where λminIs the step size of the centralized search,is a random number subject to uniform distribution, u is a random unit direction vector;
the random long-distance jitter is a moving solution xiTo the remote location, the expression is: x is the number ofi:=xi+λmaxU, where λmaxIs the step size of the diversity search, u is the vector in the random unit direction;
the individuals with less follow-up cost value than themselves mean that x is solvediTo all cost values less than xiThe solution of (2) is shifted by the expression: x is the number ofi:=xi+λ·rand·(xj-xi) For all satisfy f (x)j)<f(xi) Solution x ofjX is solvediAll move towards it;
the individual with the minimum following cost value means that the solution x is converted intoiMoving to the solution with the minimum cost value, namely the optimal solution, the expression is: x is the number ofi:=xi+λ·rand·(xb-xi) Wherein x isbIs a solution of the optimal individual representation in the population;
the history following the best individual means that the solution x is to be solvediThe position of the individual with the minimum cost value, namely the individual with the best history, obtained after the individual is evolved for multiple times is moved, and the expression is as follows:wherein,represents the solution xiHistorical best position of;
the mutation refers to solving xiMutation to obtain a new solution xi′;
Step 2.2: selecting one individual in the population P in the step 1.5, and then selecting the population basic operation o corresponding to the maximum probability in the probability vector by the selecting operationi;
Step 2.3: basic operations on individuals selected in step 2.2 using populationiAnd updating the comprehensive cost value of the current individual according to the steps 1.6 to 1.8;
step 2.4: repeating steps 2.2 and 2.3 until the whole population is traversed, using the population basic operation o once for each individualiThen, completing one iteration;
step 2.5: evaluating the iterative operation condition of the step 2.4, adjusting the operation selection probability vector, returning to the step 2.2 for next iteration until the iteration frequency reaches a set value, wherein the evaluation of the iterative operation condition of the step 2.4 means that the centralized index and the diversified index are balanced; the centralized index is evaluated by the best cost value before and after iteration, i.e. in terms ofAndthe size relationship of (a); the diversity index is evaluated by the sum of the distances of all solutions and the central solution, and the formula is as follows:wherein the central solutionI.e. according to dt-1And dtThe size relationship of (a); the centralized index and diversityThe incremental relationship of the conversion indices is shown in table 1,
TABLE 1
As can be seen from the above table, when evaluating the iterative operation condition, ifThen the centralization index is higher in this iteration, if d is the same timet-1>dtIf so, it means that there is a small diversity index in the iteration, and therefore, it is necessary to reduce the centralized index, increase the diversity index, correspondingly adjust the selection probability, and then return to step 2.2 to continue the iteration; otherwise, after adjusting the selection probability corresponding to table 1, the iteration is continued by returning to step 2.2.
And step 3: after iteration is finished, selecting an individual with the minimum cost value, namely an optimal individual, combining a starting point, an end point and a fixed control point of the B spline curve to form a group of control points, and generating an optimal path by the group of control points.
The method is applied to an environment only containing ocean current information, and the planned path is shown in FIG. 3; the method is applied to an environment containing obstacles and ocean current information, and the planned path is shown in FIG. 4; it can be seen that the obtained path is continuous and smooth, and the tracking difficulty of the AUV can be reduced.
During the experiment, the stability of the invention over time and the stability of the cost are recorded for 200 times, and an analysis chart as shown in fig. 5 is made, so that the operation time is concentrated between 0.6s and 0.64s, and two abnormal values appear above the range of the maximum value and the minimum value, but are both within 0.66 s; the final cost value is concentrated between 610 and 635, and three abnormal values appear above the maximum value 635 but are all within 655, so that the method has better stability and can be applied to the path planning process of the actual AUV.
In summary, the invention adopts the B-spline curve to represent the AUV path, and a complex and smooth path can be obtained by using a small number of control points; modeling the path planning problem into a nonlinear optimization problem by using a cost function, and optimizing and selecting the control point position of the B spline by using a population hyperheuristic algorithm, wherein the population hyperheuristic algorithm integrates the advantages of various population element heuristic algorithms, has great advantages when solving the nonlinear optimization problem, and is simple in calculation and better in convergence; further, an optimal path satisfying time efficiency, an environment map, an AUV body motion curvature radius and ocean current information constraint is obtained, the ocean current information constraint is defined only through the geometric relation between the path and the ocean current information, and the complexity of the method is reduced; the finally obtained path is continuous and smooth and meets the ocean current information constraint, and the tracking difficulty and the tracking path energy consumption of the robot are reduced.
The above description is only for the purpose of illustrating the preferred embodiments of the present invention and should not be taken as limiting the scope of the present invention, and any modifications, equivalents and improvements made by those skilled in the art within the spirit and principle of the present invention should be included in the scope of the present invention.
Claims (5)
1. An AUV path planning method in an ocean current environment based on a population hyperheuristic algorithm is characterized by comprising the following steps:
step 1: initializing a population, and obtaining initial comprehensive cost values of all individuals in the whole population according to a cost function which integrates time efficiency, an environment map, an AUV body motion curvature radius and ocean current information constraint;
step 2: setting a population basic operation set and a corresponding operation selection probability vector; selecting an individual in the population, then selecting a population basic operation corresponding to the maximum probability in the probability vector by a selection operation, using the population basic operation for the individual, and updating the comprehensive cost value of the individual; repeating the process until the whole population is traversed, and finishing one iteration; then, adjusting operation selection probability vectors, and performing next iteration until the iteration times reach a set value;
and step 3: after iteration is finished, selecting an individual with the minimum cost value, namely an optimal individual, combining a starting point, an end point and a fixed control point of the B spline curve to form a group of control points, and generating an optimal path by the group of control points.
2. The AUV path planning method based on the population hyperheuristic algorithm under the ocean current environment according to claim 1, wherein the specific steps of step 1 are as follows:
step 1.1: setting a starting point and an end point of the AUV path, connecting the starting point and the end point, generating M equally divided points on the connecting line, drawing a vertical line on each equally divided point according to the connecting line of the starting point and the end point to obtain M vertical lines, and generating i on each vertical linemaxA random point, thereby obtaining imaxThe set of random points, the ith set of random points being denoted as RPM,i(rp1,i,rp2,i,…rpk,i,…rpM,i,rpk,i∈R2),i∈(1,2,…,imax);
Step 1.2: starting from the starting point, a fixed control point p is added in a short distance along the starting direction of the AUV1Starting from the end point, a fixed control point p is added by a short distance in the opposite direction to the direction of termination of the AUV2For controlling the starting and ending directions of the curved path;
step 1.3: according to step 1.1 and step 1.2, with a start point, an end point, a set of random points RPM,i(rp1,i,rp2,i,…rpk,i,…rpM,i,rpk,i∈R2) Fixed control point p1And a fixed control point p2As the control points of one B-spline curve, the number of the control points is n, where n is M +4, and the positions of the control points areCombining the curve order K to obtain i consisting of discrete pointsmaxB spline curve, the curve equation is:
wherein, Bi,K(t) is the basis function of a K-th order B-spline curve;
step 1.4: from imaxB-spline curve to obtain imaxAn AUV path, represented as:
wherein the orientation ψ of the AUV is:
step 1.5: will imaxInitializing a group of random points to obtain a population, and initializing a group of random points RPM,i(rp1,i,rp2,i,…rpk,i,…rpM,i,rpk,i∈R2) Representing an individual, i.e. a solution xiWherein, the dimension of the individual is M, and the number of the individual is imaxThe population P is:
that is to say that the first and second electrodes,
step 1.6: calculating the initial cost value of each individual according to a cost function integrating time efficiency, an environment map, an AUV body motion curvature radius and ocean current information constraint, wherein the cost function combines time and a penalty function, and the expression is as follows:
wherein, TcostIs a time penalty, obtained by dividing the path distance by the average velocity,
ρcostis the curvature cost, obtained by accumulating the approximate curvature at each discrete point,
Mcostis the map cost, obtained by accumulating the values of each discrete point on the map (1 for obstacles, 0 for regions),
Ocostthe method is characterized in that ocean current information constraint is achieved by accumulating the product of the included angle of the path direction of each discrete point and the water flow direction and the water flow vector modulus, and h is the number of discrete points on a B spline curve;
step 1.7: respectively carrying out normalization processing on the four initial cost values, wherein different cost values have different dimensions and pass through the maximum cost valueAnd minimum cost valueTo obtain a normalized cost value
Step 1.8: and weighting and summing the four normalized cost values through different weights to obtain the initial comprehensive cost values of all individuals in the whole population P:
wherein, ω is1,ω2,ω3,ω4Are weights of different cost values.
3. The AUV path planning method based on the population hyperheuristic algorithm under the ocean current environment according to claim 1, wherein the specific steps of the step 2 are as follows:
step 2.1: setting a population basic operation set and a corresponding operation selection probability vector, wherein the population basic operation is o<·>Represents, solution x to inputtOutputting a new solution x after an iterationt+1The expression is o<xt>=xt+1The population basic operation is randomly moved, randomly jumped for a long distance, an individual with a following cost value smaller than the population basic operation, an individual with a minimum following cost value, an individual with the best following history or mutation, and the population basic operation set combines and represents the population basic operation as O- { O-1,o2,…,okAnd (5) each group basic operation corresponds to an operation selection probability vector which is P- { P1,p2,...,pk};
Step 2.2: selecting one individual in the population P in the step 1.5, and then selecting the population basic operation o corresponding to the maximum probability in the probability vector by the selecting operationi;
Step 2.3: basic operations on individuals selected in step 2.2 using populationiAnd updating the comprehensive cost value of the current individual according to the steps 1.6 to 1.8;
step 2.4: repeating steps 2.2 and 2.3 until the whole population is traversed, using the population basic operation o once for each individualiThen, completing one iteration;
step 2.5: and (4) evaluating the operation condition of the iteration in the step (2.4), adjusting the operation selection probability vector, and returning to the step (2.2) for the next iteration until the iteration number reaches a set value.
4. The AUV path planning method in ocean current environment based on population hyperheuristic algorithm of claim 3, wherein in step 2.1:
the random shift refers to a shift solution xiTo its neighborhood, the expression is: x is the number ofi:=xi+λminRand u, where λminIs the step size of the centralized search,is a random number subject to uniform distribution, u is a random unit direction vector;
the random long-distance jitter is a moving solution xiTo the remote location, the expression is: x is the number ofi:=xi+λmaxU, where λmaxIs the step size of the diversified search, u is the random unit direction vector;
the individuals with less follow-up cost value than themselves mean that x is solvediTo all cost values less than xiThe solution of (2) is shifted by the expression: x is the number ofi:=xi+λ·rand·(xj-xi) For all satisfy f (x)j)<f(xi) Solution x ofjX is solvediAll move towards it;
the individual with the minimum following cost value means that the solution x is converted intoiMoving to the solution with the minimum cost value, namely the optimal solution, the expression is: x is the number ofi:=xi+λ·rand·(xb-xi) Wherein x isbIs a solution of the optimal individual representation in the population;
the history following the best individual means that the solution x is to be solvediThe position of the individual with the minimum cost value, namely the individual with the best history, obtained after the individual is evolved for multiple times is moved, and the expression is as follows:wherein,represents the solution xiHistorical best position of;
the mutation refers to solving xiMutation to obtain a new solution xi′。
5. According to claimThe method for AUV path planning in an ocean current environment based on population hyperheuristic algorithm of claim 3, wherein the evaluation step 2.4 in step 2.5 is performed in an iterative manner to ensure that a centralized index and a diversified index are balanced, wherein the centralized index is evaluated according to an optimal cost value before and after iteration, that is, according to an optimal cost value before and after iterationAndthe size relationship of (a); the diversity index is evaluated by the sum of the distances of all solutions and the central solution, and the formula is as follows:wherein the central solutionI.e. according to dt-1And dtIs determined by the magnitude relationship of (a).
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910209731.XA CN109782779B (en) | 2019-03-19 | 2019-03-19 | AUV path planning method in ocean current environment based on population hyperheuristic algorithm |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910209731.XA CN109782779B (en) | 2019-03-19 | 2019-03-19 | AUV path planning method in ocean current environment based on population hyperheuristic algorithm |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109782779A true CN109782779A (en) | 2019-05-21 |
CN109782779B CN109782779B (en) | 2020-11-06 |
Family
ID=66488419
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910209731.XA Active CN109782779B (en) | 2019-03-19 | 2019-03-19 | AUV path planning method in ocean current environment based on population hyperheuristic algorithm |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109782779B (en) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110187707A (en) * | 2019-05-30 | 2019-08-30 | 北京三快在线科技有限公司 | Planing method, device and the unmanned equipment of unmanned equipment running track |
CN110347357A (en) * | 2019-07-15 | 2019-10-18 | 北大方正集团有限公司 | Print processing method and device |
CN110658833A (en) * | 2019-09-18 | 2020-01-07 | 沈阳航空航天大学 | Multi-AUV real-time rescue task allocation algorithm in underwater environment |
CN110779526A (en) * | 2019-09-29 | 2020-02-11 | 宁波海上鲜信息技术有限公司 | Path planning method, device and storage medium |
CN111174790A (en) * | 2019-12-03 | 2020-05-19 | 河海大学 | Method for forming topographic profile tracking path |
CN111259526A (en) * | 2020-01-09 | 2020-06-09 | 鹏城实验室 | Cluster recovery path planning method, device and equipment and readable storage medium |
CN111307158A (en) * | 2020-03-19 | 2020-06-19 | 哈尔滨工程大学 | AUV three-dimensional route planning method |
CN112068577A (en) * | 2020-09-24 | 2020-12-11 | 哈尔滨工程大学 | Green dynamic position control method for UUV individuals in UUV cluster |
CN112612290A (en) * | 2020-12-06 | 2021-04-06 | 西北工业大学 | Underwater vehicle three-dimensional multi-task path planning method considering ocean currents |
CN112925317A (en) * | 2021-01-25 | 2021-06-08 | 中国人民解放军海军工程大学 | AUV path planning method based on improved brainstorming optimization algorithm |
CN113110530A (en) * | 2021-04-16 | 2021-07-13 | 大连海事大学 | Underwater robot path planning method for three-dimensional environment |
CN115077534A (en) * | 2022-08-11 | 2022-09-20 | 合肥井松智能科技股份有限公司 | AGV path planning method based on B spline curve |
CN115357032A (en) * | 2022-10-20 | 2022-11-18 | 上海仙工智能科技有限公司 | NURBS-based mobile robot path generation method, system and storage medium |
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
UST941005I4 (en) * | 1974-08-20 | 1975-12-02 | Examine all blocks in column | |
EP0526969A2 (en) * | 1991-06-12 | 1993-02-10 | Hughes Aircraft Company | Tactical route planning method for use in simulated tactical engagements |
US20080313113A1 (en) * | 2005-12-13 | 2008-12-18 | Singapore Technologies Dynamics Pte Ltd | Method and Apparatus for an Algorithm Development Environment for Solving a Class of Real-Life Combinatorial Optimization Problems |
GB2458077A (en) * | 2006-12-22 | 2009-09-09 | Singapore Tech Dynamics Pte | Method and apparatus for automatic configuration of meta-heuristic algorithms in a problem solving environment |
CN101604166A (en) * | 2009-07-10 | 2009-12-16 | 杭州电子科技大学 | A kind of method for planning path for mobile robot based on particle swarm optimization algorithm |
CN101837591A (en) * | 2010-03-12 | 2010-09-22 | 西安电子科技大学 | Robot path planning method based on two cooperative competition particle swarms and Ferguson spline |
CN103077425A (en) * | 2012-11-23 | 2013-05-01 | 中国科学院沈阳自动化研究所 | Immune genetic algorithm for AUV (Autonomous Underwater Vehicle) real-time path planning |
CN103464344A (en) * | 2013-09-23 | 2013-12-25 | 电子科技大学中山学院 | Economical spraying robot spray gun track planning method |
US20140105372A1 (en) * | 2012-10-15 | 2014-04-17 | Twilio, Inc. | System and method for routing communications |
CN103823466A (en) * | 2013-05-23 | 2014-05-28 | 电子科技大学 | Path planning method for mobile robot in dynamic environment |
CN103968841A (en) * | 2014-06-03 | 2014-08-06 | 哈尔滨工程大学 | Improved fireflyalgorithm based AUV (autonomous underwater vehicle) three-dimensional track planning method |
CN104133476A (en) * | 2014-07-31 | 2014-11-05 | 四川阿泰因机器人智能装备有限公司 | Self-adaption path tracking method of inspection robot |
CN104809523A (en) * | 2015-05-07 | 2015-07-29 | 北京理工大学 | Workpiece production path searching method based on decision blocks and swarm algorithm |
CN107229287A (en) * | 2017-06-28 | 2017-10-03 | 中国人民解放军海军工程大学 | A kind of unmanned plane global path planning method based on Genetic Ant algorithm |
CN107368086A (en) * | 2017-07-04 | 2017-11-21 | 哈尔滨工程大学 | The autonomous underwater vehicle path planning apparatus and method in domain are threatened based on detection |
CN108508893A (en) * | 2018-03-23 | 2018-09-07 | 西安电子科技大学 | A kind of robot efficiency optimum path planning method based on improvement A algorithm |
CN109062227A (en) * | 2018-09-25 | 2018-12-21 | 电子科技大学 | A kind of more curve local paths planning methods based on dynamic window |
CN109471446A (en) * | 2018-11-08 | 2019-03-15 | 淮阴师范学院 | A kind of complete coverage path planning method neural network based |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US941005A (en) * | 1906-03-24 | 1909-11-23 | Brandt Company | Designating, recording, and registering mechanism. |
-
2019
- 2019-03-19 CN CN201910209731.XA patent/CN109782779B/en active Active
Patent Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
UST941005I4 (en) * | 1974-08-20 | 1975-12-02 | Examine all blocks in column | |
EP0526969A2 (en) * | 1991-06-12 | 1993-02-10 | Hughes Aircraft Company | Tactical route planning method for use in simulated tactical engagements |
US20080313113A1 (en) * | 2005-12-13 | 2008-12-18 | Singapore Technologies Dynamics Pte Ltd | Method and Apparatus for an Algorithm Development Environment for Solving a Class of Real-Life Combinatorial Optimization Problems |
GB2458077A (en) * | 2006-12-22 | 2009-09-09 | Singapore Tech Dynamics Pte | Method and apparatus for automatic configuration of meta-heuristic algorithms in a problem solving environment |
CN101604166A (en) * | 2009-07-10 | 2009-12-16 | 杭州电子科技大学 | A kind of method for planning path for mobile robot based on particle swarm optimization algorithm |
CN101837591A (en) * | 2010-03-12 | 2010-09-22 | 西安电子科技大学 | Robot path planning method based on two cooperative competition particle swarms and Ferguson spline |
US20140105372A1 (en) * | 2012-10-15 | 2014-04-17 | Twilio, Inc. | System and method for routing communications |
CN103077425A (en) * | 2012-11-23 | 2013-05-01 | 中国科学院沈阳自动化研究所 | Immune genetic algorithm for AUV (Autonomous Underwater Vehicle) real-time path planning |
CN103823466A (en) * | 2013-05-23 | 2014-05-28 | 电子科技大学 | Path planning method for mobile robot in dynamic environment |
CN103464344A (en) * | 2013-09-23 | 2013-12-25 | 电子科技大学中山学院 | Economical spraying robot spray gun track planning method |
CN103968841A (en) * | 2014-06-03 | 2014-08-06 | 哈尔滨工程大学 | Improved fireflyalgorithm based AUV (autonomous underwater vehicle) three-dimensional track planning method |
CN104133476A (en) * | 2014-07-31 | 2014-11-05 | 四川阿泰因机器人智能装备有限公司 | Self-adaption path tracking method of inspection robot |
CN104809523A (en) * | 2015-05-07 | 2015-07-29 | 北京理工大学 | Workpiece production path searching method based on decision blocks and swarm algorithm |
CN107229287A (en) * | 2017-06-28 | 2017-10-03 | 中国人民解放军海军工程大学 | A kind of unmanned plane global path planning method based on Genetic Ant algorithm |
CN107368086A (en) * | 2017-07-04 | 2017-11-21 | 哈尔滨工程大学 | The autonomous underwater vehicle path planning apparatus and method in domain are threatened based on detection |
CN108508893A (en) * | 2018-03-23 | 2018-09-07 | 西安电子科技大学 | A kind of robot efficiency optimum path planning method based on improvement A algorithm |
CN109062227A (en) * | 2018-09-25 | 2018-12-21 | 电子科技大学 | A kind of more curve local paths planning methods based on dynamic window |
CN109471446A (en) * | 2018-11-08 | 2019-03-15 | 淮阴师范学院 | A kind of complete coverage path planning method neural network based |
Non-Patent Citations (6)
Title |
---|
BURKE, EDMUND K; GENDREAU, MICHEL; HYDE, MATTHEW; KENDALL, GRAHA: "Hyper-heuristics: a survey of the state of the art", 《THE JOURNAL OF THE OPERATIONAL RESEARCH SOCIETY》 * |
SHENG LIANG,QIU ZHI-MING, LI HENG: "A Survey on Route Planning Methods of AUV Considering Influence of Ocean Current", 《2018 IEEE 4TH INTERNATIONAL CONFERENCE ON CONTROL SCIENCE AND SYSTEMS ENGINEERING》 * |
孙海涛等: "基于启发式算法障碍环境中AUV路径规划方法研究", 《水雷战与船舰防护》 * |
李晔等: "考虑几何约束的AUV回收路径规划", 《机器人》 * |
李红等: "洋流影响下的AUV地磁仿生导航方法研究", 《地球物理学进展》 * |
杨俊成等: "路径规划算法的研究与发展", 《控制工程》 * |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110187707A (en) * | 2019-05-30 | 2019-08-30 | 北京三快在线科技有限公司 | Planing method, device and the unmanned equipment of unmanned equipment running track |
CN110187707B (en) * | 2019-05-30 | 2022-05-10 | 北京三快在线科技有限公司 | Unmanned equipment running track planning method and device and unmanned equipment |
CN110347357A (en) * | 2019-07-15 | 2019-10-18 | 北大方正集团有限公司 | Print processing method and device |
CN110658833A (en) * | 2019-09-18 | 2020-01-07 | 沈阳航空航天大学 | Multi-AUV real-time rescue task allocation algorithm in underwater environment |
CN110658833B (en) * | 2019-09-18 | 2022-06-14 | 沈阳航空航天大学 | Multi-AUV real-time rescue task allocation algorithm in underwater environment |
CN110779526A (en) * | 2019-09-29 | 2020-02-11 | 宁波海上鲜信息技术有限公司 | Path planning method, device and storage medium |
CN111174790A (en) * | 2019-12-03 | 2020-05-19 | 河海大学 | Method for forming topographic profile tracking path |
CN111259526A (en) * | 2020-01-09 | 2020-06-09 | 鹏城实验室 | Cluster recovery path planning method, device and equipment and readable storage medium |
CN111259526B (en) * | 2020-01-09 | 2023-08-18 | 鹏城实验室 | Cluster recovery path planning method, device, equipment and readable storage medium |
CN111307158A (en) * | 2020-03-19 | 2020-06-19 | 哈尔滨工程大学 | AUV three-dimensional route planning method |
CN112068577A (en) * | 2020-09-24 | 2020-12-11 | 哈尔滨工程大学 | Green dynamic position control method for UUV individuals in UUV cluster |
CN112612290A (en) * | 2020-12-06 | 2021-04-06 | 西北工业大学 | Underwater vehicle three-dimensional multi-task path planning method considering ocean currents |
CN112612290B (en) * | 2020-12-06 | 2023-03-07 | 西北工业大学 | Underwater vehicle three-dimensional multi-task path planning method considering ocean currents |
CN112925317A (en) * | 2021-01-25 | 2021-06-08 | 中国人民解放军海军工程大学 | AUV path planning method based on improved brainstorming optimization algorithm |
CN112925317B (en) * | 2021-01-25 | 2022-05-17 | 中国人民解放军海军工程大学 | AUV path planning method based on improved brainstorming optimization algorithm |
CN113110530A (en) * | 2021-04-16 | 2021-07-13 | 大连海事大学 | Underwater robot path planning method for three-dimensional environment |
CN113110530B (en) * | 2021-04-16 | 2023-11-21 | 大连海事大学 | Underwater robot path planning method for three-dimensional environment |
CN115077534B (en) * | 2022-08-11 | 2022-11-15 | 合肥井松智能科技股份有限公司 | AGV path planning method based on B spline curve |
CN115077534A (en) * | 2022-08-11 | 2022-09-20 | 合肥井松智能科技股份有限公司 | AGV path planning method based on B spline curve |
CN115357032A (en) * | 2022-10-20 | 2022-11-18 | 上海仙工智能科技有限公司 | NURBS-based mobile robot path generation method, system and storage medium |
CN115357032B (en) * | 2022-10-20 | 2023-01-31 | 上海仙工智能科技有限公司 | NURBS-based mobile robot path generation method, system and storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN109782779B (en) | 2020-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109782779B (en) | AUV path planning method in ocean current environment based on population hyperheuristic algorithm | |
CN111780777B (en) | Unmanned vehicle route planning method based on improved A-star algorithm and deep reinforcement learning | |
CN109241552B (en) | Underwater robot motion planning method based on multiple constraint targets | |
CN101837591B (en) | Robot path planning method based on two cooperative competition particle swarms and Ferguson spline | |
Li et al. | Three-dimensional path planning for AUVs in ocean currents environment based on an improved compression factor particle swarm optimization algorithm | |
CN111240319A (en) | Outdoor multi-robot cooperative operation system and method thereof | |
CN110083165A (en) | A kind of robot paths planning method under complicated narrow environment | |
CN103968841B (en) | Improved fireflyalgorithm based AUV (autonomous underwater vehicle) three-dimensional track planning method | |
CN111307153B (en) | Multi-AUV task allocation and path planning method based on hexagonal grid map | |
Yu et al. | Path planning of unmanned surface vessel in an unknown environment based on improved D* Lite algorithm | |
CN109917817B (en) | Multi-underwater robot collaborative path planning method | |
Cai et al. | Cooperative Artificial Intelligence for underwater robotic swarm | |
CN112612290B (en) | Underwater vehicle three-dimensional multi-task path planning method considering ocean currents | |
Huang et al. | Motion planning of robot manipulator based on improved NSGA-II | |
CN114089754A (en) | Autonomous path planning method and system based on artificial intelligence | |
Wu et al. | Real-time three-dimensional smooth path planning for unmanned aerial vehicles in completely unknown cluttered environments | |
Meng et al. | Research on unmanned ship route planning based on the smoothed DGWW algorithm | |
CN115202356B (en) | Three-dimensional underwater underactuated AUV recovery path planning method | |
CN117369467A (en) | Spline curve optimization-based robot track optimization method and device | |
Guo et al. | Path planning for autonomous underwater vehicles based on an improved artificial jellyfish search algorithm in multi-obstacle ocean current environment | |
CN116009558A (en) | Mobile robot path planning method combined with kinematic constraint | |
CN115951682A (en) | Constraint four-target AUV global path planning method under condition of considering ocean current existence | |
CN113917929A (en) | Unmanned ship path optimization method and system based on hybrid particle swarm algorithm | |
Yu et al. | A path planning algorithm for unmanned surface vessel with pose constraints in an unknown environment | |
Chen et al. | Real-time efficient trajectory planning for quadrotor based on hard constraints |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |