CN106681135B - Cable wiring path searching method based on mixed water drop algorithm - Google Patents
Cable wiring path searching method based on mixed water drop algorithm Download PDFInfo
- Publication number
- CN106681135B CN106681135B CN201710035041.8A CN201710035041A CN106681135B CN 106681135 B CN106681135 B CN 106681135B CN 201710035041 A CN201710035041 A CN 201710035041A CN 106681135 B CN106681135 B CN 106681135B
- Authority
- CN
- China
- Prior art keywords
- soil
- path
- wiring
- algorithm
- formula
- 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.)
- Expired - Fee Related
Links
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 title claims abstract description 79
- 238000000034 method Methods 0.000 title claims abstract description 25
- 239000002245 particle Substances 0.000 claims abstract description 38
- 238000005457 optimization Methods 0.000 claims abstract description 14
- 230000004888 barrier function Effects 0.000 claims abstract description 10
- 239000002689 soil Substances 0.000 claims description 64
- 230000006870 function Effects 0.000 claims description 15
- 238000005452 bending Methods 0.000 claims description 7
- 230000001276 controlling effect Effects 0.000 claims 4
- 230000006978 adaptation Effects 0.000 claims 1
- 238000006073 displacement reaction Methods 0.000 claims 1
- 230000001105 regulatory effect Effects 0.000 claims 1
- 230000019771 cognition Effects 0.000 description 2
- 230000001149 cognitive effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 238000013473 artificial intelligence Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- 239000003016 pheromone Substances 0.000 description 1
- 230000002787 reinforcement Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0205—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system
- G05B13/024—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric not using a model or a simulator of the controlled system in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
The invention discloses a cable path automatic planning method based on an improved mixed water drop algorithm, which mainly solves the problems of low algorithm efficiency, unsmooth path and the like in the prior art. The planning steps are as follows: modeling a cable wiring environment; optimizing parameters in an intelligent water droplet algorithm by utilizing a particle swarm algorithm, and providing guidance for movement of water droplets; improving the moving mode of the water drops in the water drop algorithm and optimizing the path; outputting a cable path according to the optimization result; the method comprehensively considers the stability and robustness of the algorithm, improves the searching efficiency of the algorithm, avoids the interference phenomenon between the cable and the barrier, and reduces the length of the cable required by wiring.
Description
Technical Field
The invention relates to the field of automatic wiring, in particular to a cable wiring path searching method based on a mixed water drop algorithm.
Background
The searching of the cable wiring path is one of key technologies for realizing automatic wiring of cables, and the cable wiring path which is convenient, collision-free, smooth and attached to the wall surface can be found out quickly, so that the automatic wiring efficiency of the cables is improved, and the reliability of electromechanical products is also improved.
At present, commonly used path searching methods include a visual graph method, a heuristic graph searching algorithm, an artificial potential field method and the like, the algorithms have respective advantages and disadvantages, for example, the artificial potential field method has good real-time performance, but has the defects that a trap area exists, a path cannot be found between similar obstacles and the like, and the algorithm is more suitable for solving the single-target optimization problem. In recent decades, as the research of artificial intelligence algorithms has been advanced, many intelligent algorithms are also used in path planning of mobile robots, including fuzzy logic and reinforcement learning algorithms, neural networks, genetic algorithms, ant colony algorithms, and the like. These algorithms have their own advantages, but have many problems, such as too slow convergence speed, easy falling into local optimum, too large search space, etc.
Although many algorithms are improved at the present stage, a better cable wiring path can be found, the problems of more iteration times, overlong operation time and the like still exist, the problems cannot meet the requirement of automatic cable wiring, and in the obtained path, the cable path is in a suspended state, so that the stability of an electromechanical product is seriously influenced, and meanwhile, the working reliability of the electromechanical product is reduced.
Disclosure of Invention
Aiming at the defects of the prior art, the invention provides a cable wiring path searching algorithm based on a mixed water drop algorithm, the method has the advantages of less iteration times and short operation time, can meet the requirement of automatic wiring of cables, does not influence the stability of an electromechanical product, and improves the working reliability of the electromechanical product.
The technical scheme for realizing the purpose of the invention is as follows:
a cable wiring path searching method based on a mixed water drop algorithm comprises the following steps:
1) in the wiring space, selecting a wall surface for laying the cable, and simplifying the wiring space into a rectangular wiring plane in a plane expansion mode;
2) carrying out grid map modeling on a rectangular wiring plane;
3) taking a particle swarm algorithm as a coarse searching stage, carrying out rapid path optimization, and updating soil distribution through a plurality of groups of obtained suboptimal paths;
4) an improved intelligent water drop algorithm is adopted as a fine search stage to carry out path optimization;
5) taking the nodes and the bending points in the path as control points, and converting two-dimensional control point coordinates into three-dimensional control point coordinates in the wiring space according to the plane unfolding mode in the step 1);
6) optimizing a path by adopting a third-order B spline curve;
through the steps, parameters in the intelligent water droplet algorithm are optimized by utilizing the particle swarm algorithm, and guidance is provided for the movement of water droplets; improving the moving mode of the water drops in the water drop algorithm and optimizing the path; finally, a B-spline curve is adopted to optimize a path, the stability and robustness of the algorithm are comprehensively considered, and a wiring path which is convenient, collision-free, smooth and attached to a wall surface can be quickly found out. The cabling is completed by laying the cables on the path.
In the step 1), in the wiring space, selecting a wall surface for laying the cable, and simplifying the wiring space into a rectangular wiring plane in a plane expansion mode:
firstly, if a plane is a non-rectangular plane simplified after plane expansion, the plane is expanded into a rectangular plane;
secondly, the extension part is regarded as an obstacle;
finally, the plane is divided into two regions: barrier regions and non-barrier regions.
In step 2), performing grid map modeling on the rectangular wiring plane:
firstly, the grid map consists of obstacle grids and non-obstacle grids;
secondly, any grid containing obstacles is regarded as an obstacle grid;
and finally, if the starting point and the ending point of the wiring are positioned in the same row in the grid map, interchanging the rows and the columns of the grid map.
In step 3), the particle swarm algorithm is used as a coarse search stage and rapid path optimization is carried out, and soil distribution is updated through multiple sets of obtained suboptimal paths, and the method specifically comprises the following steps:
first, initial parameters (population size N, inertial weight w, learning factor c) are set1And c2Maximum number of iterations Ic, maximum speed VmaxAnd a minimum value of velocity Vmin);
Then, a position vector x of the particle is randomly generatedi=(xi1,xi2,…,xiD) And velocity vector vi=(vi1,vi2,…,viD) And initializing a locally optimal solution p of the particlepAnd a global optimal solution pg;
Entering iteration and updating the position information and the speed information of all particles according to the following two formulas:
wherein i is 1,2, …, N, D is 1,2, …, D, w is inertial weight, c1 and c2 are learning factors, r1 and r2 are [0,1]Are relatively independent and uniformly distributed random numbers pp=(pp1,pp2,…,ppD) For the local optimal solution of the particle, i.e. the optimal solution of the particle in the last iteration, pg=(pg1,pg2,…,pgD) Is the global optimal solution of the particle, i.e., the optimal solution of the particle before this iteration.
At the same time, the fitness f (x) of each particle is calculatedi) If f (x)i) Is the minimum value in this iteration, then pp=xiIf f (x) is presenti)<f(pg) Then p isg=xiWherein the fitness function f is:
in the formula (x)j,yj) Is the coordinate of the path node j, n is the number of path points, numjAnd pun is a penalty factor for the number of obstacle grids touched by the path between the node j and the node j-1, so that the path touching the obstacle is endowed with a poor evaluation value.
Finally, the next iteration is enteredThe local optimal solution p is updated according to the formulas (1), (2) and (3)pAnd global maximum solution pgAnd until the iteration times reach the maximum or meet the precision requirement.
In the step 4), an improved intelligent water drop algorithm is adopted as a fine searching stage to carry out path optimization,
firstly, setting the number W of water drops, the maximum iteration number Is and the initial soil amount Its, initializing the soil at each position in the grid map, and updating the soil by utilizing T groups of suboptimal solutions obtained by a PSO algorithm, wherein the T groups of suboptimal solutions are as follows:
in the formula of oiliThe amount of soil at a certain node i; posiIs the location of the node; pathsubThe position of each node in the path in the D group of paths; eup is the shortest distance between the central points of two adjacent grids; lambda [ alpha ]iIndicates λ in the T-set sub-optimal solutioniThe block solution contains node i, and the parameters δ, α and β are positive numbers.
Then, all the water droplets were placed at the wiring start point.
Using roulette method to select path point and recording path node information, the formula is as follows:
in the formula of oiliThe amount of soil at a certain node; posiIs the location of the node; eup is the shortest distance between the central points of two adjacent grids; p is the probability of selecting the next node; n is the set of next optional grids; function dis (pos)i,posj) Is composed ofEuclidean metrics between node i and node j; ρ is a positive number less than 1; a isf,,bfAnd cfAre all positive numbers.
When the water drop moves to another node j, the speed of the water drop is updated:
middle vel of the formulajIs the speed at which the drop moves to node j; soiljThe amount of soil at node j; a isvIs a positive number.
Meanwhile, the soil of the moved node and the soil carried by the water drop at the moment are updated, and the following two formulas are adopted:
middle posiIs the position of node i; function dis (pos)i,posj) Is the Euclidean metric between node i and node j; soiljThe amount of soil at node j; rho1And asAre all positive numbers.
Before all water drops move to the wiring end point, the formulas (6), (7), (8), (9) and (10) are repeated, the fitness of the formed path of each water drop is calculated, and the local optimal solution p is updatedpAnd a global optimal solution pg。
After all water drops moved to the wiring end point, the global soil volume was updated:
in the formula of oiliThe amount of soil at node i; posiIs the position of node i;the amount of soil carried by the water droplets to form a locally optimal solution; p is a radical ofpIs a locally optimal solution, and pgIs a global optimal solution; num number of grids in the grid map; local cognitive factor ρ2And global cognition factor ρ3Are all positive numbers, and ρ3≥ρ2。
After the total local soil quantity is updated according to the formula (11), the algorithm completes one iteration. Thereafter the algorithm will go to the next iteration and all drops will reset at the start of the wiring and move again in the above described way (equation (6) to equation (11)) until the number of iterations reaches the maximum or the accuracy requirement is met.
In the step 5), taking the nodes and the bending points in the path as control points, and converting two-dimensional control point coordinates into three-dimensional control point coordinates in the wiring space according to the plane unfolding mode in the step 1);
in step 6), a third-order B-spline is adopted to optimize a path:
obtaining the control point p in the step 5) first0(x0,y0,z0),...,pn(xn,yn,zn) Determining the order k of the B spline curve to be 3, and defining the support interval T of the spline curve to be T0,t1,...,tn+k]The following formula:
the basis function N of the spline curve is then calculatedi,k(t) the following two formulae:
wherein t is a variable in a spline curve equation; t ═ T0,t1,...,tn+k]Is the support interval of the spline curve.
Finally, the equation of the third-order B spline curve can be obtained as follows:
in the formula, t is a variable of a curve equation; n is a radical ofi,k(t) is a basis function in the B-spline curve;
k is the curve order of 3.
Has the advantages that:
the invention provides a cable wiring path searching method based on a mixed water drop algorithm, which comprises the following steps:
(1) the wiring space is simplified into a wiring plane by selecting a cable laying wall surface, and after a cable path is solved, two-dimensional coordinates of a cable control point on the plane are converted into three-dimensional coordinates of the wiring space, so that the wiring path is attached to the wall surface, and the condition that the cable is suspended is avoided;
(2) the grid map modeling mode is adopted, so that the method has the advantages of high precision, easiness in implementation and the like;
(3) and the particle swarm algorithm and the improved intelligent water drop algorithm are fused. The particle swarm algorithm has the advantages that the required time is short compared with that of an intelligent water drop algorithm, so that not only is too much time not consumed before the intelligent water drop algorithm, but also the whole running speed is not influenced, and pheromone feedback of initial soil distribution can be provided for the intelligent water drop algorithm, so that the running time of the intelligent water drop algorithm can be reduced, and the effects of reducing the searching time and obtaining the optimized path can be achieved;
(4) the Euclidean metric is used as a factor influencing the movement of the water drop selection node, so that the water drop moves towards a better-positioned area as far as possible, and the convergence rate of the algorithm is increased;
(5) a third-order B-spline curve is adopted, so that the cable path is smoother, and a large number of bending points with large bending angles in the cable path are avoided.
Drawings
FIG. 1 is a flow chart of grid map creation;
FIG. 2 is a flow chart of cable routing path search based on the mixed water droplet algorithm;
FIG. 3 is an automatic cabling of cables in a cabling space accomplished by the method of the present invention;
fig. 4 simplifies the routing space flow diagram.
Detailed Description
The invention will be further elucidated with reference to the drawings and examples, without however being limited thereto.
Examples
A cable wiring path searching method based on a mixed water drop algorithm comprises the following steps:
1) in the wiring space, selecting a wall surface for laying the cable, and simplifying the wiring space into a rectangular wiring plane in a plane expansion mode;
2) carrying out grid map modeling on a rectangular wiring plane;
3) taking a particle swarm algorithm as a coarse searching stage, carrying out rapid path optimization, and updating soil distribution through a plurality of groups of obtained suboptimal paths;
4) an improved intelligent water drop algorithm is adopted as a fine search stage to carry out path optimization;
5) taking the nodes and the bending points in the path as control points, and converting two-dimensional control point coordinates into three-dimensional control point coordinates in the wiring space according to the plane unfolding mode in the step 1);
6) optimizing a path by adopting a third-order B spline curve;
through the steps, parameters in the intelligent water droplet algorithm are optimized by utilizing the particle swarm algorithm, and guidance is provided for the movement of water droplets; improving the moving mode of the water drops in the water drop algorithm and optimizing the path; finally, a B-spline curve is adopted to optimize a path, the stability and robustness of the algorithm are comprehensively considered, and a wiring path which is convenient, collision-free, smooth and attached to a wall surface can be quickly found out. The cabling is completed by laying the cables on the path.
In the step 1), in the wiring space, selecting a wall surface for laying the cable, and simplifying the wiring space into a rectangular wiring plane in a plane expansion mode:
as shown in fig. 1, in a simplified manner of wiring space. Wherein P is1As a starting point of wiring, P2The key points of wiring are; so,S1And S2All are wall surfaces for laying cables; o is1Is an obstacle, and O2Is an extended area and is considered an obstacle; finally, the black area represents an obstacle, and the white area represents a non-obstacle area.
Firstly, if a plane is a non-rectangular plane simplified after plane expansion, the plane is expanded into a rectangular plane;
secondly, the extension part is regarded as an obstacle;
finally, the plane is divided into two regions: barrier regions and non-barrier regions.
In step 2), performing grid map modeling on the rectangular wiring plane:
as shown in fig. 2, a grid modeling approach is used. Wherein the circular ring represents a wiring starting point, and the rectangular ring represents a wiring end point; the middle black grid is a barrier grid; the white grid is a non-obstacle grid; the distance between any two grids is the line connecting their center points.
Firstly, the grid map consists of obstacle grids and non-obstacle grids;
secondly, any grid containing obstacles is regarded as an obstacle grid;
and finally, if the starting point and the ending point of the wiring are positioned in the same row in the grid map, interchanging the rows and the columns of the grid map.
In step 3), the particle swarm algorithm is used as a coarse search stage and rapid path optimization is carried out, and soil distribution is updated through multiple sets of obtained suboptimal paths, and the method specifically comprises the following steps:
first, initial parameters (population size N, inertial weight w, learning factor c) are set1And c2Maximum number of iterations Ic, maximum speed VmaxAnd a minimum value of velocity Vmin);
Then, a position vector x of the particle is randomly generatedi=(xi1,xi2,…,xiD) And velocity vector vi=(vi1,vi2,…,viD) And initializing a locally optimal solution p of the particlepAnd a global optimal solution pg;
Entering iteration and updating the position information and the speed information of all particles according to the following two formulas:
wherein i is 1,2, …, N, D is 1,2, …, D, w is inertial weight, c1 and c2 are learning factors, r1 and r2 are [0,1]Are relatively independent and uniformly distributed random numbers pp=(pp1,pp2,…,ppD) For the local optimal solution of the particle, i.e. the optimal solution of the particle in the last iteration, pg=(pg1,pg2,…,pgD) Is the global optimal solution of the particle, i.e., the optimal solution of the particle before this iteration.
At the same time, the fitness f (x) of each particle is calculatedi) If f (x)i) Is the minimum value in this iteration, then pp=xiIf f (x) is presenti)<f(pg) Then p isg=xiWherein the fitness function f is:
in the formula (x)j,yj) Is the coordinate of the path node j, n is the number of path points, numjAnd pun is a penalty factor for the number of obstacle grids touched by the path between the node j and the node j-1, so that the path touching the obstacle is endowed with a poor evaluation value.
Finally, entering next iteration and repeating the formulas (1), (2) and (3), and updating the local optimal solution ppAnd global maximum solution pgAnd until the iteration times reach the maximum or meet the precision requirement.
In the step 4), an improved intelligent water drop algorithm is adopted as a fine searching stage to carry out path optimization,
firstly, setting the number W of water drops, the maximum iteration number Is and the initial soil amount Its, initializing the soil at each position in the grid map, and updating the soil by utilizing T groups of suboptimal solutions obtained by a PSO algorithm, wherein the T groups of suboptimal solutions are as follows:
in the formula of oiliThe amount of soil at a certain node i; posiIs the location of the node; pathsubThe position of each node in the path in the D group of paths; eup is the shortest distance between the central points of two adjacent grids; lambda [ alpha ]iIndicates λ in the T-set sub-optimal solutioniThe block solution contains node i, and the parameters δ, α and β are positive numbers.
Then, all the water droplets were placed at the wiring start point.
Using roulette method to select path point and recording path node information, the formula is as follows:
in the formula of oiliThe amount of soil at a certain node; posiIs the location of the node; eup is the shortest distance between the central points of two adjacent grids; p is the probability of selecting the next node; n is the set of next optional grids; function dis (pos)i,posj) Is the Euclidean metric between node i and node j; ρ is a positive number less than 1; a isf,,bfAnd cfAre all positive numbers.
When the water drop moves to another node j, the speed of the water drop is updated:
middle vel of the formulajIs the speed at which the drop moves to node j; soiljThe amount of soil at node j; a isvIs a positive number.
Meanwhile, the soil of the moved node and the soil carried by the water drop at the moment are updated, and the following two formulas are adopted:
middle posiIs the position of node i; function dis (pos)i,posj) Is the Euclidean metric between node i and node j; soiljThe amount of soil at node j; rho1And asAre all positive numbers.
Before all water drops move to the wiring end point, the formulas (6), (7), (8), (9) and (10) are repeated, the fitness of the formed path of each water drop is calculated, and the local optimal solution p is updatedpAnd a global optimal solution pg。
After all water drops moved to the wiring end point, the global soil volume was updated:
in the formula of oiliThe amount of soil at node i; posiIs the position of node i;the amount of soil carried by the water droplets to form a locally optimal solution; p is a radical ofpIs a locally optimal solution, and pgIs a global optimal solution; num number of grids in the grid map; local cognitive factor ρ2And all ofLocal cognition factor rho3Are all positive numbers, and ρ3≥ρ2。
After the total local soil quantity is updated according to the formula (11), the algorithm completes one iteration. Thereafter, the algorithm will proceed to the next iteration, and all the water drops will be reset at the starting point of the wiring and will move again in the above equations (6) to (11) until the number of iterations reaches the maximum or the accuracy requirement is met.
In the step 5), taking the nodes and the bending points in the path as control points, and converting two-dimensional control point coordinates into three-dimensional control point coordinates in the wiring space according to the plane unfolding mode in the step 1);
in step 6), a third-order B-spline is adopted to optimize a path:
as shown in fig. 3, which is an example of the wiring path optimized by using the third-order B-spline. The wiring space is a box body of 10dm multiplied by 18dm multiplied by 20dm, the barrier is an object surrounded by a dotted line, the short cylinder surrounded by a solid line represents a connector, the starting and ending ends of the cable connecting wiring can be obviously seen, the barrier is avoided, and the cable connecting wiring is pasted on the wall surface;
obtaining the control point p in the step 5) first0(x0,y0,z0),...,pn(xn,yn,zn) Determining the order k of the B spline curve to be 3, and defining the support interval T of the spline curve to be T0,t1,...,tn+k]The following formula:
the basis function N of the spline curve is then calculatedi,k(t) the following two formulae:
wherein t is a variable in a spline curve equation; t ═ T0,t1,...,tn+k]Is the support interval of the spline curve.
Finally, the equation of the third-order B spline curve can be obtained as follows:
in the formula, t is a variable of a curve equation; n is a radical ofi,k(t) is a basis function in the B-spline curve;
k is the curve order of 3.
As shown in fig. 4: the flow of the mixed water drop algorithm for solving the wiring path is as follows:
s101 begins
S102 initialization parameters
S103, solving T-group suboptimal path by adopting particle swarm optimization
S104, updating the global soil quantity according to the T-group suboptimal path
S105 iteration number increase
S106 selecting the water drops which are not moved yet
S107 water drop selection node movement
S108, updating the soil at the node, the moving speed of water drops and the soil carried by the water drops
S109 judges whether or not the water droplet moves to the wiring end point
S110, judging whether all water drops move to the wiring end point
S111 updating local optimal solution and global optimal solution
S112 updating the global soil
S113 judges whether or not an iteration end condition is satisfied
S114 obtaining control point coordinates
S115 adopts a third-order B spline curve to optimize a path
S116 output cable routing path
And S117 ends.
Claims (4)
1. A cable wiring path searching method based on a mixed water drop algorithm is characterized by comprising the following steps:
1) in the wiring space, selecting a wall surface for laying the cable, and simplifying the wiring space into a rectangular wiring plane in a plane expansion mode;
2) carrying out grid map modeling on a rectangular wiring plane;
3) taking a particle swarm algorithm as a coarse searching stage, carrying out rapid path optimization, and updating soil distribution through a plurality of groups of obtained suboptimal paths;
4) the method comprises the steps of adopting a mixed water drop algorithm as a fine search stage to conduct path optimization, firstly, setting the quantity W of water drops, the maximum iteration times Is and the initial soil quantity Its, initializing soil at each position in a grid map, and utilizing T groups of suboptimal solutions obtained by a PSO algorithm to update the soil, wherein the T groups of suboptimal solutions are as follows:
in the formula: its is the initial soil mass; posiIs position i; soliThe displacement position is the soil amount at the position i; lambda [ alpha ]iPositive number for controlling soil change, T is number of fine searches, delta, α, β are real numbers for regulating initial soil quantity, eup is shortest distance between adjacent positions, pathsubA path set for fine search; initsoil is Its initial soil amount;
then, all the water drops are placed at the wiring starting point,
using roulette method to select path point and recording path node information, the formula is as follows:
in the formula: soilijIs the amount of soil at coordinate (i, j); posi、posjPositions i and j; dis (pos)i,posj) Is the Euclidean distance between location i and location j; rho is a coefficient; a isfPositive, affecting the probability of a drop moving from location i to the next location j; bfIs a positive number;
when the water drop moves to another node j, the speed of the water drop is updated:
in the formula: a isvFor controlling the rate of change of the speed of the water droplets; veli,veljThe speeds of water drops at the i and j nodes respectively; soiljThe amount of soil at point j;
at the same time, the soil of the moved node is updated, and the soil carried by the water drop at this time:
in the formula: a issFor controlling the rate of change of the speed of the water droplets; veljIs the velocity of the water droplet at the j node; posi、posjPositions i and j; soiljThe amount of soil at point j; dis (pos)i,posj) Is the Euclidean distance, ρ, between location i and location j1Is a coefficient;
in the formula: soilIWDIs the amount of soil, pos, carried by the water dropletsi、posjPositions i and j; veljThe velocity at point j; dis (pos)i,posj) Is the Euclidean distance between location i and location j; a issIs a positive number for controlling the rate of change of the soil;
before all water droplets move to the wiring end point, equations (6), (7), (8), (9) and (10) are repeated, and each is calculatedThe fitness of the path formed by the water drops is updated, and the local optimal solution p is updatedpAnd global maximum solution pg;
After all water drops moved to the wiring end point, the global soil volume was updated:
in the formula: soliRepresents the amount of soil at location i; p is a radical ofpRepresents a locally optimal solution; p is a radical ofgRepresents the global maximum solution;the optimal value of the soil quantity carried by water drops is obtained; rho2,ρ3,ρ4Is a coefficient; num is the number of water droplets; after the total local soil quantity is updated according to the formula (11), the algorithm finishes one iteration, then the algorithm enters the next iteration, all water drops are reset at the wiring starting point, and the movement is carried out again according to the formula (6) to the formula (11) until the iteration frequency reaches the maximum or the precision requirement is met;
5) taking the nodes and the bending points in the path as control points, and converting two-dimensional control point coordinates into three-dimensional control point coordinates in the wiring space according to the plane unfolding mode in the step 1);
6) optimizing a path by adopting a third-order B spline curve; acquiring the control point p in the step 5) firstly0(x0,y0,z0)…pn(xn,yn,zn) Determining the order k of the B spline curve to be 3, and defining the support interval T of the spline curve to be T0,t1,…,tn+k]The following formula:
in the formula: i represents the curve control point i, N represents the total number of control points, k is the order of the spline and then the basis function N of the spline is calculatedi,k(t) the following two formulae:
in the formula: basis function N of control point ii,1,tiAnd ti+1Respectively support zones i and i +1,
in the formula: t is ti、ti+1、ti+k-1、ti+kRespectively supporting intervals i, i +1, i + k, i + k-1; n is a radical ofi,k-1(t) and Ni+1,k-1(t) is the basis function of point i and point i + 1;
finally, the equation of the third-order B spline curve can be obtained as follows:
in the formula: i represents a curve control point i; basis function N of control point ii,k(t);PiIs the position vector of control point i.
2. The method for searching a cable wiring path based on the mixed water drop algorithm according to claim 1, wherein in the step 1), the wall surface for cable laying is selected in the wiring space, and the wiring space is simplified into a rectangular wiring plane in a planar spreading manner:
firstly, if a plane is a non-rectangular plane simplified after plane expansion, the plane is expanded into a rectangular plane;
secondly, the extension part is regarded as an obstacle;
finally, the plane is divided into two regions: barrier regions and non-barrier regions.
3. The cable wiring path searching method based on the mixed water drop algorithm according to claim 1, wherein in the step 2), the grid map modeling is performed on the rectangular wiring plane:
firstly, the grid map consists of obstacle grids and non-obstacle grids;
secondly, any grid containing obstacles is regarded as an obstacle grid;
and finally, if the starting point and the ending point of the wiring are positioned in the same row in the grid map, interchanging the rows and the columns of the grid map.
4. The cable wiring path searching method based on the mixed water drop algorithm according to claim 1, wherein in the step 3), the particle swarm algorithm is used as a coarse searching stage to perform fast path optimization, and the soil distribution is updated through the obtained multiple sets of suboptimal paths, which specifically comprises:
firstly, the population size N, the inertia weight w and the learning factor c are calculated1And c2Maximum number of iterations ICMaximum value of velocity VmaxAnd a minimum value of velocity VminSetting as initial parameters; then, a position vector x of the particle is randomly generatedi=(xi1,xi2,…,xiD) And velocity vector vi=(vi1,vi2,…,viD) And initializing a locally optimal solution p of the particlepAnd a global optimal solution pg;
Entering iteration and updating the position information and the speed information of all particles according to the following two formulas:
at the same time, the adaptation f (x) of each particle is calculatedi) If f (x)i) Is the minimum value in this iteration, then pp=xiIf f (x) is presenti)<f(pg) Then p isg=xiWherein the fitness function f is
In the formula:is the velocity of particle i in the (k + 1) th iteration,representing the position of particle i at the kth iteration,is the position of the particle i in the (k + 1) th iteration, w is the weight, r1,r2Is a random number, ppdIs the locally optimal solution, p, for the particle of this iterationgdRepresenting the global optimum of the particle for this iteration, (x)j,yj) Two-dimensional coordinates representing a jth point of a particle;
finally, entering next iteration and repeating the formulas (1), (2) and (3), and updating the local optimal solution ppAnd global maximum solution pgAnd until the iteration times reach the maximum or meet the precision requirement.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710035041.8A CN106681135B (en) | 2017-01-17 | 2017-01-17 | Cable wiring path searching method based on mixed water drop algorithm |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710035041.8A CN106681135B (en) | 2017-01-17 | 2017-01-17 | Cable wiring path searching method based on mixed water drop algorithm |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106681135A CN106681135A (en) | 2017-05-17 |
CN106681135B true CN106681135B (en) | 2020-05-05 |
Family
ID=58860078
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710035041.8A Expired - Fee Related CN106681135B (en) | 2017-01-17 | 2017-01-17 | Cable wiring path searching method based on mixed water drop algorithm |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106681135B (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109033611B (en) * | 2018-07-20 | 2023-04-07 | 福州大学 | Routing method for VLSI multi-end-point wire network around obstacles |
DE102018133319A1 (en) * | 2018-12-21 | 2020-06-25 | Rittal Gmbh & Co. Kg | Method for robot-assisted wiring of electrical components of an electrical switchgear arranged on a mounting plate |
CN110703767A (en) * | 2019-11-08 | 2020-01-17 | 江苏理工学院 | Unmanned vehicle obstacle avoidance path planning method based on improved intelligent water drop algorithm |
CN111985600A (en) * | 2020-08-21 | 2020-11-24 | 吴仉华 | Indoor wire path planning method and device based on improved particle swarm |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2428897A1 (en) * | 1978-06-15 | 1980-01-11 | Trt Telecom Radio Electr | Display assisted cable laying table - has displayed sequence instructions fed from punched tape |
CN101071450A (en) * | 2007-06-08 | 2007-11-14 | 桂林电子科技大学 | Electronic machine three-dimensional automatic routing system |
CN103902774A (en) * | 2014-03-31 | 2014-07-02 | 福州大学 | Overall wiring method for super-large-scale integrated circuit under X structure |
-
2017
- 2017-01-17 CN CN201710035041.8A patent/CN106681135B/en not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2428897A1 (en) * | 1978-06-15 | 1980-01-11 | Trt Telecom Radio Electr | Display assisted cable laying table - has displayed sequence instructions fed from punched tape |
CN101071450A (en) * | 2007-06-08 | 2007-11-14 | 桂林电子科技大学 | Electronic machine three-dimensional automatic routing system |
CN103902774A (en) * | 2014-03-31 | 2014-07-02 | 福州大学 | Overall wiring method for super-large-scale integrated circuit under X structure |
Non-Patent Citations (1)
Title |
---|
轮廓扩展方法下的电气线缆布线技术研究;李春泉 等;《机械设计与制造》;20150430(第4期);第266-269页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106681135A (en) | 2017-05-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109945881B (en) | Mobile robot path planning method based on ant colony algorithm | |
CN106681135B (en) | Cable wiring path searching method based on mixed water drop algorithm | |
CN107272679B (en) | Path planning method based on improved ant colony algorithm | |
WO2016045615A1 (en) | Robot static path planning method | |
CN108229719B (en) | Multi-objective optimization method and device for unmanned aerial vehicle formation task allocation and flight path planning | |
CN110160546B (en) | Mobile robot path planning method | |
CN107807665B (en) | Unmanned aerial vehicle formation detection task cooperative allocation method and device | |
CN109871021B (en) | Robot navigation method based on particle swarm optimization algorithm | |
CN110095122B (en) | Mobile robot path planning method based on improved ant colony algorithm | |
CN110883776B (en) | Robot path planning algorithm for improving DQN under quick search mechanism | |
CN112462803B (en) | Unmanned aerial vehicle path planning method based on improved NSGA-II | |
CN109357678B (en) | Multi-unmanned aerial vehicle path planning method based on heterogeneous pigeon swarm optimization algorithm | |
CN110609557A (en) | Unmanned vehicle mixed path planning algorithm | |
CN111323016A (en) | Mobile robot path planning method based on self-adaptive ant colony algorithm | |
CN110320930A (en) | The reliable transform method of multiple no-manned plane flight pattern based on Voronoi diagram | |
CN113467472A (en) | Robot path planning method in complex environment | |
CN111784079A (en) | Unmanned aerial vehicle path planning method based on artificial potential field and ant colony algorithm | |
CN111930121B (en) | Mixed path planning method for indoor mobile robot | |
CN103472828A (en) | Mobile robot path planning method based on improvement of ant colony algorithm and particle swarm optimization | |
CN113885536B (en) | Mobile robot path planning method based on global gull algorithm | |
CN113985888B (en) | Forklift path planning method and system based on improved ant colony algorithm | |
CN111273664A (en) | Multi-robot path collaborative planning method for on-orbit assembly of space truss structure | |
CN108413963A (en) | Bar-type machine people's paths planning method based on self study ant group algorithm | |
CN112230665A (en) | ROS robot global path optimization method based on ACO | |
CN112484732B (en) | IB-ABC algorithm-based unmanned aerial vehicle flight path planning method |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200505 |
|
CF01 | Termination of patent right due to non-payment of annual fee |