CN114077255B - Intelligent vehicle road-finding method based on elliptical model artificial potential field method - Google Patents
Intelligent vehicle road-finding method based on elliptical model artificial potential field method Download PDFInfo
- Publication number
- CN114077255B CN114077255B CN202111388075.8A CN202111388075A CN114077255B CN 114077255 B CN114077255 B CN 114077255B CN 202111388075 A CN202111388075 A CN 202111388075A CN 114077255 B CN114077255 B CN 114077255B
- Authority
- CN
- China
- Prior art keywords
- intelligent vehicle
- target point
- obstacle
- potential field
- path
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 80
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 6
- 238000005457 optimization Methods 0.000 claims description 3
- 230000008569 process Effects 0.000 claims description 3
- 238000013519 translation Methods 0.000 claims description 3
- 230000009191 jumping Effects 0.000 claims description 2
- 230000006870 function Effects 0.000 description 16
- 238000011160 research Methods 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000005381 potential energy Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 230000006386 memory function Effects 0.000 description 1
- 239000011664 nicotinic acid Substances 0.000 description 1
- 238000003909 pattern recognition Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses an intelligent vehicle path finding method based on an ellipse model artificial potential field method, which comprises the steps of constructing a corresponding map, establishing a coordinate system, determining obstacle position coordinates and target point positions, judging whether the intelligent vehicle currently reaches an end point position, and if the intelligent vehicle reaches the end point position, completing path planning to generate a final path; if the current position of the intelligent vehicle does not reach the final position, path planning is carried out by using an artificial potential field method, the magnitude and the direction of the attraction force, the repulsive force and the resultant force applied to the current position of the intelligent vehicle are calculated, and whether the problem of local minimum is solved is judged. The advantages are that: in a complex environment, an elliptical model is adopted to add a virtual target point, the attractive force generated by the virtual target point changes the state of the robot at a local minimum value, and the position of the virtual target point is continuously corrected on the elliptical model, so that the intelligent vehicle jumps out of a local balance area, and meanwhile, the time cost of an algorithm is greatly reduced.
Description
Technical Field
The invention relates to the technical field of automatic road searching, in particular to an intelligent vehicle road searching method based on an elliptic model artificial potential field method.
Background
The intelligent vehicle senses the road environment through a vehicle-mounted sensor, automatically plans a driving route and controls the vehicle to reach a preset target. Integrates a plurality of technologies such as automatic control, architecture, artificial intelligence, visual computing and the like, is a highly developed product of computer science, pattern recognition and intelligent control technology, is an important mark for measuring national scientific research strength and industrial level, and has wide application prospect in the fields of national defense and national economy. In recent years, mobile robots and various unmanned aerial vehicles are widely developed and applied in various industries, and become another research hotspot, and a path planning technology is one of the most basic and important technologies in robot related research. Path planning refers to that a robot searches a working space for an obstacle avoidance path from a starting point to an end point according to specific indexes (such as least time, shortest walking path and the like). Path planning research begins in the 70 s of the 20 th century, after which the research on the path planning research by the robot research and development major nations is not interrupted, and the path planning research is achieved as soon as possible. At present, the commonly used path planning method is divided into a traditional algorithm and an intelligent bionic algorithm. Among them, the conventional artificial potential field method is widely used because of its simple and convenient calculation.
The traditional artificial potential field method assumes that the target point generates attractive force to the intelligent vehicle, and the obstacle generates repulsive force to the intelligent vehicle, so that the intelligent vehicle walks along the direction of potential decline, and the intelligent vehicle just like water flows to the lower part. The algorithm has the advantages of simple structure, contribution to the real-time performance of bottom control, capability of greatly reducing the calculated amount and the calculated time, generation of a relatively smooth path and contribution to maintaining the stability of an automatic driving vehicle. The problems of the algorithm are obvious, firstly, the problem that the target is unreachable, if the distance between the intelligent vehicle and the target point is far, the attractive force becomes extremely large, the repulsive force is smaller than the attractive force and even can be ignored, at the moment, the intelligent vehicle is likely to collide with the obstacle on the advancing path to cause the failure of the intelligent vehicle to seek paths, and when a large obstacle exists near the target point, the intelligent vehicle is subjected to the action of the extremely large repulsive force of the obstacle when approaching the target point, so that the end point cannot be reached. The problem of local minimum value and the problem of zero potential energy field are the bottleneck problems of an artificial potential field method, the reason for generating zero potential energy points is that the intelligent vehicle has a plurality of obstacle points in a working area, the position distribution is special, the attraction and the repulsion can be just equal in size at a certain point of the working area, the directions are opposite, the stress of the intelligent vehicle is zero, and the intelligent vehicle can swing back and forth near the point and can not reach a destination, so that the operation efficiency of the intelligent vehicle is seriously affected. Lee, J et al control obstacle avoidance planning of a mobile robot by using an arbitrary force algorithm to establish a new artificial potential field method function, and meanwhile, the problem of symmetrical ordering of the robot, obstacles and target points is solved. The li.chunshu et al proposes a "extended walk" method with memory function that determines whether the target point is surrounded by an obstacle by walking along the edge of the obstacle to jump out of the local minimum point of the artificial potential field method and recording and analyzing the local minimum point that the robot walks through, so as to avoid the robot from oscillating back and forth all the time or the position target point from turning around. Although the method solves the defects of the artificial potential field method to a certain extent, the intelligent vehicle cannot obtain a good obstacle avoidance effect under the condition that the environment of the intelligent vehicle is complex, and an optimal path cannot be obtained or a path curve is tortuous.
The invention solves the problem that the potential field method can not reach the target point and sink into local minimum value in the process of planning the path by improving the repulsive force function and establishing an elliptic model to set the virtual target point on the basis of the traditional artificial potential field.
Disclosure of Invention
The invention aims to solve the problems in the prior art, and provides an intelligent vehicle road-finding method based on an elliptic model artificial potential field method.
In order to achieve the above purpose, the present invention adopts the following technical scheme: an intelligent vehicle road-finding method based on an ellipse model artificial potential field method comprises the following steps:
step 1, constructing a corresponding map according to an area where an intelligent vehicle is located, gridding the map, establishing a coordinate system, and determining coordinates of the position of an obstacle and the position of a target point in the map;
step 2, judging whether the intelligent vehicle reaches the end position currently;
step 3, if the final position is reached, path planning is completed, and a final path is generated; if the terminal position is not reached, path planning is carried out by using an artificial potential field method;
step 4, calculating the magnitude and direction of attractive force, repulsive force and resultant force of the current position of the intelligent vehicle;
step 5, judging whether the problem of local minimum value is solved;
step 6, if the local minimum is not trapped, returning to the step 2 to continue judging and path planning, if the local minimum is trapped, constructing an elliptical model according to the problem point of the local minimum, adding a virtual target point, and increasing the attractive force of the end position direction to the intelligent vehicle so as to jump out the problem of the local minimum;
step 7, calculating again by using an elliptic model artificial potential field method until the vehicle runs to the end position;
step 8, carrying out secondary optimization on the planned path, sequentially detecting path nodes backwards from the starting point, judging whether the path nodes can reach straight lines, and deleting the path from the starting point to the nodes if the path nodes can reach straight lines; if the straight line can not be reached, the node position is used as the starting point position to continuously judge whether the straight line can be reached, so that the path is simplified.
In the above-mentioned intelligent vehicle road-finding method based on elliptic model artificial potential field method, adopting artificial potential field method to avoid the phenomenon that the intelligent vehicle is unreachable to the target in the course of movement, planning a safe path from the starting point to the target point for the intelligent vehicle in the working environment containing the obstacle, and judging whether the intelligent vehicle falls into the local minimum problem, comprising:
an X-O-Y coordinate system is established by a map, and the coordinate of the robot sinking into local balance is assumed to be P min (x min ,y min ) The end position coordinate is P goal (x goal ,y goal ) The midpoint coordinate position P of the two points b The method comprises the following steps:
with P min And P goal The connection line of the two points is taken as a new axis X', and P b As an origin, an axis Y 'which passes through the origin and is perpendicular to X' is established, and a new coordinate system is obtained by rotating and translating an original coordinate system, wherein the formula is as follows:
wherein the method comprises the steps ofIs a rotation matrix +.>Is a translation matrix;
the ellipse equation is established under the new coordinate system as follows:
focal length 2c= |p min -P goal I, a=ψc, ψ is the long axis factor, a 2 ＝b 2 +c 2 。
And taking the orthogonal point of the ellipse and the X' axis as an initial virtual target point, increasing the attraction of the end point position to the intelligent vehicle, breaking the local minimum state, enabling the intelligent vehicle to walk according to the virtual target point, and if the intelligent vehicle is detected to sink into local balance again, constructing a new ellipse model, and searching for a new virtual target point.
In the intelligent vehicle road-finding method based on the elliptic model artificial potential field method, the gravitation function of the artificial potential field method is as follows:
wherein X is g Representing the position (x g ,y g )；λ 1 Representing the gravitational constant; ρ (X, X) g ) The geometric distance between the current position and the final position of the intelligent vehicle;
the first order derivative of the distance in the gravitational potential function is the gravitational force:
similarly, the repulsive potential function is as follows:
wherein X is 0 ＝(x 0 ,y 0 ) Representing the obstacle position; lambda (lambda) 2 Representing a repulsive force field constant; ρ 0 Representing the obstacle influencing radius; ρ (X, X) 0 ) Is an intelligent vehicle and an obstacleThe spacing between them;
the repulsive force function is used for solving the first derivative of the distance, namely repulsive force:
so the resultant force F applied by the intelligent vehicle in space total (X) is:
F total (X)＝F att (X)+F rep (X)
the problem that the position of the target point cannot be reached is that the repulsive force generated by the obstacle around the target point of the intelligent vehicle is larger than the attractive force of the target point;
therefore, based on the traditional repulsive force function, a distance factor rho (X, X g ) The repulsive force value is reduced according to different situations; the improved repulsive force function is shown below:
when the distance ρ (X, X) between the intelligent vehicle and the end position g ) When the obstacle is less than 1 and the obstacle is close to the robot,and ρ (X, X) g ) 2 The values are all smaller than 1, so that the repulsive force value can be reduced, and the phenomenon that the target point cannot be reached due to overlarge repulsive force around the target point is prevented.
In the above-mentioned intelligent vehicle road-finding method based on elliptic model artificial potential field method, in step 3, the artificial potential field algorithm improves its repulsive force function, and according to the distance factor ρ (X, X) between the current position of the intelligent vehicle and the target point g ) Setting three different conditions, when the position of the intelligent vehicle appears within half of the radius value affected by the obstacle, the intelligent vehicle is very close to the obstacle, and considering the factors of safety obstacle avoidance, the repulsive force cannot be reduced too much, the square coefficient of the distance factor is taken here, and the other is takenIn this respect, when the robot is located between the half position of the obstacle influence radius value and the maximum value, the intelligent vehicle is just started to approach the obstacle, and in order to prevent the attraction force from being smaller than the repulsive force and thus the target point from being inaccessible, when the distance factor is larger than the obstacle influence radius, the intelligent vehicle is not affected.
In the above-mentioned intelligent vehicle road-finding method based on the artificial potential field method of the elliptic model, in step 6, an elliptic model is constructed by using the position of the local minimum point and the position of the target point, an X 'axis is established by using the direction pointing to the target point as the positive direction, a Y' axis perpendicular to the X 'axis is made at the midpoint position of the two points, thereby establishing a new coordinate system X' -O-Y ', setting the virtual target point as the intersection point of the positive direction of the X' axis and the elliptic model, thereby increasing the force of the target point on the intelligent vehicle in the gravitational direction, thereby breaking the local minimum state, and jumping out the local balance.
Compared with the prior art, the invention has the advantages that:
1. in a complex environment, an elliptical model is adopted to add a virtual target point, the attractive force generated by the virtual target point changes the state of the robot at a local minimum value, and the position of the virtual target point is continuously corrected on the elliptical model, so that the intelligent vehicle jumps out of a local balance area, and meanwhile, the time cost of an algorithm is greatly reduced;
2. according to the distance between the current position and the end position of the intelligent vehicle and according to three different conditions of setting distance influence factors, the safety of the intelligent vehicle planning path is better ensured.
Drawings
FIG. 1 is a basic schematic diagram of an artificial potential field method in an intelligent vehicle road-finding method based on an elliptical model artificial potential field method;
FIG. 2 is a diagram of a method for establishing virtual target points by an ellipse model in an intelligent vehicle road-finding method based on an ellipse model artificial potential field method;
FIG. 3 is a specific flowchart of an elliptical model artificial potential field method in an intelligent vehicle road-finding method based on the elliptical model artificial potential field method;
fig. 4 is an effect diagram of an ellipse model artificial potential field method planning path in an intelligent vehicle road-finding method based on an ellipse model artificial potential field method.
Detailed Description
The following examples are for illustrative purposes only and are not intended to limit the scope of the invention.
Examples
Referring to fig. 1-4, an intelligent vehicle road-finding method based on an elliptical model artificial potential field method comprises the following steps:
step 1, constructing a corresponding map according to an area where an intelligent vehicle is located, gridding the map, establishing a coordinate system, and determining coordinates of the position of an obstacle and the position of a target point in the map;
step 2, judging whether the intelligent vehicle reaches the end position currently;
step 3, if the final position is reached, path planning is completed, and a final path is generated; if the terminal position is not reached, path planning is carried out by using an artificial potential field method;
step 4, calculating the magnitude and direction of attractive force, repulsive force and resultant force of the current position of the intelligent vehicle;
step 5, judging whether the problem of local minimum value is solved;
step 6, if the local minimum is not trapped, returning to the step 2 to continue judging and path planning, if the local minimum is trapped, constructing an elliptical model according to the problem point of the local minimum, adding a virtual target point, and increasing the attractive force of the end position direction to the intelligent vehicle so as to jump out the problem of the local minimum;
step 7, calculating again by using an elliptic model artificial potential field method until the vehicle runs to the end position;
step 8, carrying out secondary optimization on the planned path, sequentially detecting path nodes backwards from the starting point, judging whether the path nodes can reach straight lines, and deleting the path from the starting point to the nodes if the path nodes can reach straight lines; if the straight line can not be reached, the node position is used as the starting point position to continuously judge whether the straight line can be reached, so that the path is simplified.
The artificial potential field method is adopted to avoid the phenomenon that an intelligent vehicle cannot reach a target in the moving process, a safe path from a starting point to a target point is planned for the intelligent vehicle in a working environment containing barriers, and whether the intelligent vehicle falls into a local minimum point is judged, and the method comprises the following steps:
an X-O-Y coordinate system is established by a map, and the coordinate of the robot sinking into local balance is assumed to be P min (x min ,y min ) The end position coordinate is P goal (x goal ,y goal ) The midpoint coordinate position P of the two points b The method comprises the following steps:
with P min And P goal The connection line of the two points is taken as a new axis X', and P b As an origin, an axis Y 'which passes through the origin and is perpendicular to X' is established, and a new coordinate system is obtained by rotating and translating an original coordinate system, wherein the formula is as follows:
wherein the method comprises the steps ofIs a rotation matrix +.>Is a translation matrix;
the ellipse equation is established under the new coordinate system as follows:
focal length 2c= |p min -P goal I, a=ψc, ψ is the long axis factor, a 2 ＝b 2 +c 2 ；
And taking the orthogonal point of the ellipse and the X' axis as an initial virtual target point, increasing the attraction of the end point position to the intelligent vehicle, breaking the local minimum state, enabling the intelligent vehicle to walk according to the virtual target point, and if the intelligent vehicle is detected to sink into local balance again, constructing a new ellipse model, and searching for a new virtual target point.
The gravitation function of the artificial potential field method is as follows:
wherein X is g Representing the position (x g ,y g )；λ 1 Representing the gravitational constant; ρ (X, X) g ) The geometric distance between the current position and the final position of the intelligent vehicle;
the first order derivative of the distance in the gravitational potential function is the gravitational force:
similarly, the repulsive potential function is as follows:
wherein X is 0 ＝(x 0 ,y 0 ) Representing the obstacle position; lambda (lambda) 2 Representing a repulsive force field constant; ρ 0 Representing the obstacle influencing radius; ρ (X, X) 0 ) Is the distance between the intelligent vehicle and the obstacle;
the repulsive force function is used for solving the first derivative of the distance, namely repulsive force:
so the resultant force F applied by the intelligent vehicle in space total (X) is:
F total (X)＝F att (X)+F rep (X)
the problem that the position of the target point cannot be reached is that the repulsive force generated by the obstacle around the target point of the intelligent vehicle is larger than the attractive force of the target point;
therefore, based on the traditional repulsive force function, a distance factor rho (X, X g ) The repulsive force value is reduced according to different situations; the improved repulsive force function is shown below:
when the distance ρ (X, X) between the intelligent vehicle and the end position g ) When the obstacle is less than 1 and the obstacle is close to the robot,and ρ (X, X) g ) 2 The values are all smaller than 1, so that the repulsive force value can be reduced, and the phenomenon that the target point cannot be reached due to overlarge repulsive force around the target point is prevented.
On the one hand, when the position of the robot appears within half of the radius value affected by the obstacle, the intelligent vehicle is very close to the obstacle, and the factors of safety obstacle avoidance are considered, so that the repulsive force cannot be reduced too much, and the square-open coefficient of the distance factor is taken. On the other hand, when the robot is located between the half position of the obstacle influence radius value and the maximum value, the intelligent vehicle just starts to approach the obstacle, and in order to prevent the attractive force from being smaller than the repulsive force and not approaching the target point, the repulsive force should be reduced as much as possible, so that the square coefficient of the distance factor is taken here.
In a more complex environment, the situation that the attractive force and the repulsive force applied by the intelligent vehicle are the same in magnitude and opposite in direction when the intelligent vehicle does not reach the target point position and the resultant force is zero may occur, which causes the intelligent vehicle to oscillate back and forth at the current position.
The invention provides a method for setting a virtual target point by establishing an elliptical model, wherein the attractive force generated by the virtual target point changes the state of a robot at a local minimum value, and the position of the virtual target point is continuously corrected on the elliptical model, so that an intelligent vehicle jumps out of a local balance area.
In step 3, the artificial potential field algorithm improves the repulsive force function thereof, and according to the distance factor ρ (X, X) between the current position of the intelligent vehicle and the target point g ) Setting up three kinds of different circumstances, when the position of intelligent car appears in the obstacle influences the half of radius value, the intelligent car has very near the obstacle, consider the factor of safe obstacle avoidance, can not cut down the repulsion too much, get the square coefficient of opening of distance factor here, on the other hand, the position of robot is in the obstacle when influencing the half position of radius value to the maximum value, the intelligent car just begins to be close to the obstacle, thereby in order to prevent that gravitation is less than repulsion and can't be close to the target point, when distance factor is greater than the obstacle and influences the radius, the intelligent car is not influenced.
In step 6, an elliptical model is constructed by taking the position of the local minimum point and the position of the target point, an X 'axis is established by taking the direction pointing to the target point as the positive direction, a Y' axis perpendicular to the X 'axis is made at the midpoint position of the two points, so that a new coordinate system X' -O-Y 'is established, the virtual target point is set as the intersection point of the positive direction of the X' axis and the elliptical model, the force of the target point on the intelligent vehicle in the attractive force direction is increased, the local minimum state is broken, and the local balance is jumped out.
Claims (5)
1. An intelligent vehicle road finding method based on an elliptic model artificial potential field method is characterized by comprising the following steps of:
step 1, constructing a corresponding map according to an area where an intelligent vehicle is located, gridding the map, establishing a coordinate system, and determining coordinates of the position of an obstacle and the position of a target point in the map;
step 2, judging whether the intelligent vehicle reaches the end position currently;
step 3, if the final position is reached, path planning is completed, and a final path is generated; if the terminal position is not reached, path planning is carried out by using an artificial potential field method;
step 4, calculating the magnitude and direction of attractive force, repulsive force and resultant force of the current position of the intelligent vehicle;
step 5, judging whether the problem of local minimum value is solved;
step 6, if the local minimum is not trapped, returning to the step 2 to continue judging and path planning, if the local minimum is trapped, constructing an elliptical model according to the problem point of the local minimum, adding a virtual target point, and increasing the attractive force of the end position direction to the intelligent vehicle so as to jump out the problem of the local minimum;
step 7, calculating again by using an elliptic model artificial potential field method until the vehicle runs to the end position;
step 8, carrying out secondary optimization on the planned path, sequentially detecting path nodes backwards from the starting point, judging whether the path nodes can reach straight lines, and deleting the path from the starting point to the nodes if the path nodes can reach straight lines; if the straight line can not be reached, the node position is used as the starting point position to continuously judge whether the straight line can be reached, so that the path is simplified.
2. The intelligent vehicle road-finding method based on the elliptical model artificial potential field method of claim 1, wherein the artificial potential field method is adopted to avoid the phenomenon that the intelligent vehicle cannot reach the target in the moving process, a safe path from a starting point to a target point is planned for the intelligent vehicle in a working environment containing obstacles, and whether the intelligent vehicle falls into a local minimum point is judged, and the method comprises the following steps:
an X-O-Y coordinate system is established by a map, and the coordinate of the robot sinking into local balance is assumed to be P min (x min ,y min ) The end position coordinate is P goal (x goal ,y goal ) The midpoint coordinate position P of the two points b The method comprises the following steps:
with P min And P goal The connection line of the two points is taken as a new axis X', and P b As an origin, an axis Y 'which passes through the origin and is perpendicular to X' is established, and a new coordinate system is obtained by rotating and translating an original coordinate system, wherein the formula is as follows:
wherein the method comprises the steps ofIs a rotation matrix +.>Is a translation matrix;
the ellipse equation is established under the new coordinate system as follows:
focal length 2c= |p min -P goal I, a=ψc, ψ is the long axis factor, a 2 ＝b 2 +c 2 ；
And taking the orthogonal point of the ellipse and the X' axis as an initial virtual target point, increasing the attraction of the end point position to the intelligent vehicle, breaking the local minimum state, enabling the intelligent vehicle to walk according to the virtual target point, and if the intelligent vehicle is detected to sink into local balance again, constructing a new ellipse model, and searching for a new virtual target point.
3. The intelligent vehicle road-finding method based on the elliptic model artificial potential field method according to claim 2, wherein the gravitation function of the artificial potential field method is as follows:
wherein X is g Representing the position (x g ,y g )；λ 1 Representing the gravitational constant; ρ (X, X) g ) The geometric distance between the current position and the final position of the intelligent vehicle;
the first order derivative of the distance in the gravitational potential function is the gravitational force:
similarly, the repulsive potential function is as follows:
wherein X is 0 ＝(x 0 ,y 0 ) Representing the obstacle position; lambda (lambda) 2 Representing a repulsive force field constant; ρ 0 Representing the obstacle influencing radius; ρ (X, X) 0 ) Is the distance between the intelligent vehicle and the obstacle;
the repulsive force function is used for solving the first derivative of the distance, namely repulsive force:
so the resultant force F applied by the intelligent vehicle in space total (X) is:
F total (X)＝F att (X)+F rep (X)
the problem that the position of the target point cannot be reached is that the repulsive force generated by the obstacle around the target point of the intelligent vehicle is larger than the attractive force of the target point;
therefore, based on the traditional repulsive force function, a distance factor rho (X, X g ) The repulsive force value is reduced according to different situations; the improved repulsive force function is shown below:
when the distance ρ (X, X) between the intelligent vehicle and the end position g ) When the obstacle is less than 1 and the obstacle is close to the robot,and ρ (X, X) g ) 2 The values are all smaller than 1, so that the repulsive force value can be reduced, and the phenomenon that the target point cannot be reached due to overlarge repulsive force around the target point is prevented.
4. The intelligent vehicle road-finding method based on the elliptic model artificial potential field method according to claim 1, wherein in step 3, the artificial potential field method algorithm improves the repulsive force function thereof according to the distance factor ρ (X, X g ) Setting up three kinds of different circumstances, when the position of intelligent car appears in the obstacle influences the half of radius value, the intelligent car has very near the obstacle, consider the factor of safe obstacle avoidance, can not cut down the repulsion too much, get the square coefficient of opening of distance factor here, on the other hand, the position of robot is in the obstacle when influencing the half position of radius value to the maximum value, the intelligent car just begins to be close to the obstacle, thereby in order to prevent that gravitation is less than repulsion and can't be close to the target point, when distance factor is greater than the obstacle and influences the radius, the intelligent car is not influenced.
5. The intelligent vehicle road-finding method based on the elliptic model artificial potential field method according to claim 1, wherein in step 6, an elliptic model is constructed by taking the position of a local minimum point and the position of a target point, an X 'axis is established by taking the direction pointing to the target point as a positive direction, a Y' axis perpendicular to the X 'axis is established at the midpoint position of the two points, thereby establishing a new coordinate system X' -O-Y ', setting a virtual target point as the intersection point of the positive direction of the X' axis and the elliptic model, thereby increasing the force of the target point on the intelligent vehicle in the attractive force direction, thereby breaking the local minimum state and jumping out of local balance.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111388075.8A CN114077255B (en) | 2021-11-22 | 2021-11-22 | Intelligent vehicle road-finding method based on elliptical model artificial potential field method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111388075.8A CN114077255B (en) | 2021-11-22 | 2021-11-22 | Intelligent vehicle road-finding method based on elliptical model artificial potential field method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114077255A CN114077255A (en) | 2022-02-22 |
| CN114077255B true CN114077255B (en) | 2023-07-18 |
Family
ID=80284215
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111388075.8A Active CN114077255B (en) | 2021-11-22 | 2021-11-22 | Intelligent vehicle road-finding method based on elliptical model artificial potential field method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114077255B (en) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114924559A (en) * | 2022-04-08 | 2022-08-19 | 南京航空航天大学 | Intelligent vehicle path planning method for controlling virtual force direction |
| CN115562291B (en) * | 2022-10-19 | 2023-12-12 | 哈尔滨理工大学 | Path planning method for improving potential field dynamic coefficient based on artificial potential field method |
Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113359762A (en) * | 2021-07-02 | 2021-09-07 | 哈尔滨理工大学 | Dynamic planning method for unmanned surface vehicle |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9555589B1 (en) * | 2015-09-03 | 2017-01-31 | 3M Innovative Properties Company | Method of making optical films and stacks |
| CN106843235B (en) * | 2017-03-31 | 2019-04-12 | 深圳市靖洲科技有限公司 | A kind of Artificial Potential Field path planning towards no person bicycle |
| CN107608346A (en) * | 2017-08-30 | 2018-01-19 | 武汉理工大学 | Ship intelligent barrier avoiding method and system based on Artificial Potential Field |
| CN110244713B (en) * | 2019-05-22 | 2023-05-12 | 江苏大学 | Intelligent vehicle lane change track planning system and method based on artificial potential field method |
| CN110567478B (en) * | 2019-09-30 | 2023-06-30 | 广西科技大学 | Unmanned vehicle path planning method based on artificial potential field method |
| CN110703767A (en) * | 2019-11-08 | 2020-01-17 | 江苏理工学院 | Unmanned vehicle obstacle avoidance path planning method based on improved intelligent water drop algorithm |
| CN111546343B (en) * | 2020-05-13 | 2021-08-03 | 浙江工业大学 | Method and system for planning route of defense mobile robot based on improved artificial potential field method |
| CN111844007B (en) * | 2020-06-02 | 2023-04-28 | 江苏理工学院 | Obstacle avoidance path planning method and device for mechanical arm of pollination robot |
-
2021
- 2021-11-22 CN CN202111388075.8A patent/CN114077255B/en active Active
Patent Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113359762A (en) * | 2021-07-02 | 2021-09-07 | 哈尔滨理工大学 | Dynamic planning method for unmanned surface vehicle |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114077255A (en) | 2022-02-22 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| WO2021175313A1 (en) | Automatic driving control method and device, vehicle, and storage medium | |
| CN115079705B (en) | Routing inspection robot path planning method based on improved A star fusion DWA optimization algorithm | |
| CN114077255B (en) | Intelligent vehicle road-finding method based on elliptical model artificial potential field method | |
| CN105549597B (en) | A kind of unmanned vehicle dynamic path planning method based on environmental uncertainty | |
| WO2018176594A1 (en) | Artificial potential field path planning method for unmanned bicycle | |
| CN114675649A (en) | Indoor mobile robot path planning method fusing improved A and DWA algorithm | |
| CN113359718A (en) | Method and equipment for fusing global path planning and local path planning of mobile robot | |
| CN110908386A (en) | Layered path planning method for unmanned vehicle | |
| Yang et al. | Mobile robot path planning based on enhanced dynamic window approach and improved A∗ algorithm | |
| CN116360457A (en) | Path planning method based on self-adaptive grid and improved A-DWA fusion algorithm | |
| CN114428499A (en) | Astar and DWA algorithm fused mobile trolley path planning method | |
| CN113467476B (en) | Collision-free detection rapid random tree global path planning method considering corner constraint | |
| CN115167398A (en) | Unmanned ship path planning method based on improved A star algorithm | |
| CN112539750A (en) | Intelligent transportation vehicle path planning method | |
| CN115903816A (en) | Low-energy-consumption mobile robot path planning method | |
| Zhang et al. | An obstacle avoidance strategy for complex obstacles based on artificial potential field method | |
| Zhang et al. | Multi-UUV path planning based on improved artificial potential field method | |
| Yan et al. | A dynamic path planning algorithm based on the improved DWA algorithm | |
| JP5074153B2 (en) | Route generation device and method, and mobile device including route generation device | |
| Yan et al. | Obstacle avoidance for unmanned undersea vehicle in unknown unstructured environment | |
| Guan et al. | Robot dynamic path planning based on improved A* and DWA algorithms | |
| CN114995391A (en) | 4-order B spline curve path planning method for improving A-star algorithm | |
| Zhao et al. | A compound path planning algorithm for mobile robots | |
| Shi et al. | Local path planning of unmanned vehicles based on improved RRT algorithm | |
| CN116880473B (en) | Unmanned ship path planning method and system based on artificial potential field and A-star fusion |
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 |