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 PDF

Info

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
Application number
CN201710035041.8A
Other languages
Chinese (zh)
Other versions
CN106681135A (en
Inventor
李春泉
胡宇威
尚玉玲
黄红艳
张明
蒋倩
周远畅
邵永安
童晓漫
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guilin University of Electronic Technology
Original Assignee
Guilin University of Electronic Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Guilin University of Electronic Technology filed Critical Guilin University of Electronic Technology
Priority to CN201710035041.8A priority Critical patent/CN106681135B/en
Publication of CN106681135A publication Critical patent/CN106681135A/en
Application granted granted Critical
Publication of CN106681135B publication Critical patent/CN106681135B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0205Adaptive 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/024Adaptive 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

Cable wiring path searching method based on mixed water drop algorithm
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:
Figure BDA0001211407060000031
Figure BDA0001211407060000032
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:
Figure BDA0001211407060000033
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:
Figure BDA0001211407060000041
Figure BDA0001211407060000042
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:
Figure BDA0001211407060000043
Figure BDA0001211407060000044
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:
Figure BDA0001211407060000051
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:
Figure BDA0001211407060000052
Figure BDA0001211407060000053
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:
Figure BDA0001211407060000054
in the formula of oiliThe amount of soil at node i; posiIs the position of node i;
Figure BDA0001211407060000055
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:
Figure BDA0001211407060000061
the basis function N of the spline curve is then calculatedi,k(t) the following two formulae:
Figure BDA0001211407060000062
Figure BDA0001211407060000063
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:
Figure BDA0001211407060000064
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:
Figure BDA0001211407060000091
Figure BDA0001211407060000092
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:
Figure BDA0001211407060000093
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:
Figure BDA0001211407060000101
Figure BDA0001211407060000102
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:
Figure BDA0001211407060000103
Figure BDA0001211407060000104
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:
Figure BDA0001211407060000105
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:
Figure BDA0001211407060000106
Figure BDA0001211407060000111
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:
Figure BDA0001211407060000112
in the formula of oiliThe amount of soil at node i; posiIs the position of node i;
Figure BDA0001211407060000113
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:
Figure BDA0001211407060000121
the basis function N of the spline curve is then calculatedi,k(t) the following two formulae:
Figure BDA0001211407060000122
Figure BDA0001211407060000123
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:
Figure BDA0001211407060000124
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:
Figure FDA0002269104020000011
Figure FDA0002269104020000012
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:
Figure FDA0002269104020000013
Figure FDA0002269104020000021
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:
Figure FDA0002269104020000022
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:
Figure FDA0002269104020000023
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;
Figure FDA0002269104020000024
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:
Figure FDA0002269104020000031
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;
Figure FDA0002269104020000032
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:
Figure FDA0002269104020000033
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:
Figure FDA0002269104020000034
in the formula: basis function N of control point ii,1,tiAnd ti+1Respectively support zones i and i +1,
Figure FDA0002269104020000041
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:
Figure FDA0002269104020000042
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:
Figure FDA0002269104020000051
Figure FDA0002269104020000052
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
Figure FDA0002269104020000053
In the formula:
Figure FDA0002269104020000054
is the velocity of particle i in the (k + 1) th iteration,
Figure FDA0002269104020000055
representing the position of particle i at the kth iteration,
Figure FDA0002269104020000056
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.
CN201710035041.8A 2017-01-17 2017-01-17 Cable wiring path searching method based on mixed water drop algorithm Expired - Fee Related CN106681135B (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (3)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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&#39;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