CN116202550B - Automobile path planning method integrating improved potential field and dynamic window - Google Patents

Automobile path planning method integrating improved potential field and dynamic window Download PDF

Info

Publication number
CN116202550B
CN116202550B CN202310498150.9A CN202310498150A CN116202550B CN 116202550 B CN116202550 B CN 116202550B CN 202310498150 A CN202310498150 A CN 202310498150A CN 116202550 B CN116202550 B CN 116202550B
Authority
CN
China
Prior art keywords
automobile
function
obstacle
road
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
Application number
CN202310498150.9A
Other languages
Chinese (zh)
Other versions
CN116202550A (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.)
Jiangling Motors Corp Ltd
East China Jiaotong University
Original Assignee
Jiangling Motors Corp Ltd
East China Jiaotong University
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 Jiangling Motors Corp Ltd, East China Jiaotong University filed Critical Jiangling Motors Corp Ltd
Priority to CN202310498150.9A priority Critical patent/CN116202550B/en
Publication of CN116202550A publication Critical patent/CN116202550A/en
Application granted granted Critical
Publication of CN116202550B publication Critical patent/CN116202550B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/3446Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/3407Route searching; Route guidance specially adapted for specific applications
    • G01C21/3415Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Window Of Vehicle (AREA)

Abstract

The invention provides an automobile path planning method for fusing an improved potential field and a dynamic window, which is characterized in that a relative speed repulsive force function and a road longitudinal force function are added on the basis of a traditional potential field function, so that the problems of local optimum and unreachable targets in the traditional algorithm can be effectively solved; the longitudinal force of the road added in the traditional potential field function can ensure that the automobile runs towards the center of the road, and the safety and stability of the running process of the automobile are improved; in addition, the invention samples the relative speed, the pose, the track and the obstacle distance of the automobile and the obstacle in each critical path node through the improved dynamic window, can dynamically update the preliminary planning path in real time, and can better meet the requirements in the actual driving environment.

Description

Automobile path planning method integrating improved potential field and dynamic window
Technical Field
The invention relates to the technical field of intelligent automobiles, in particular to an automobile path planning method integrating an improved potential field and a dynamic window.
Background
The intelligent automobile path planning, namely, the intelligent automobile is used for planning a running path, the planned path must meet the basic conditions of running time, collision avoidance effect, smooth and stable route and the like used from the beginning to the end of the automobile, so that the optimal planning path is obtained, and the intelligent automobile can be well helped to complete the running task. Because the intelligent automobile has complex and diverse environments, not only structured urban roads but also unstructured rural roads, the planned path can be well adapted to complex real environments, has good collision avoidance capability, and improves efficiency and safety and reliability as much as possible.
The path planning method can be divided into global planning and local planning according to different use conditions of the planning method. The global path planning method with wider application comprises Dijkstra algorithm, A-algorithm, ant colony algorithm, RRT algorithm and the like, and the local path planning method with wider application comprises artificial potential field method, genetic algorithm, dynamic window method and the like. The artificial potential field method is convenient and efficient, has high calculation speed, is easy to understand and can be developed rapidly.
But local optimization and target unrealizable are the biggest problems of the current artificial potential field method. In addition, some unpredictable complex change conditions exist in the actual path planning, but the existing artificial potential field method cannot dynamically update the planned path in real time, so that the requirements in the actual driving environment are difficult to meet.
Disclosure of Invention
The invention aims to provide an automobile path planning method integrating an improved potential field and a dynamic window, which is used for solving the problems of local optimum and unreachable targets in the prior art, and realizing real-time dynamic updating of a planned path so as to better meet the requirements in an actual driving environment.
A car path planning method integrating an improved potential field and a dynamic window comprises the following steps:
step 1, modeling a driving environment by adopting a potential field method to obtain a driving environment model;
step 2, in a driving environment model, coordinate positions of an automobile, a target point, an obstacle and a road boundary are obtained, and then a plurality of potential field functions are established according to the position relation between the automobile and the target point, between the automobile and the obstacle and between the automobile and the road boundary, wherein the plurality of potential field functions specifically comprise a target gravitation function, an obstacle repulsive force function, a relative speed repulsive force function and a road longitudinal force function;
step 3, obtaining a preliminary planning path based on a driving environment model and a plurality of potential field functions;
step 4, acquiring key path nodes from the automobile to each obstacle based on the preliminary planning path;
step 5, improving the evaluation function and the weighting coefficient of the dynamic window to obtain an improved dynamic window;
and 6, inputting the critical path nodes from the automobile to each obstacle into an improved dynamic window, sampling the relative speed of the automobile and the obstacle on the critical path nodes, the pose of the automobile, the distance between the automobile track and the obstacle and the minimum safety distance of the automobile running through an evaluation function of the improved dynamic window, and carrying out real-time optimization and updating on the preliminary planning path through the improved dynamic window to obtain the optimized planning path.
The automobile path planning method for fusing the improved potential field and the dynamic window has the following beneficial effects:
(1) On the basis of the traditional potential field function, a relative speed repulsive force function and a road longitudinal force function are added, so that the problems of local optimum and unreachable targets in the traditional algorithm can be effectively solved;
(2) The longitudinal force of the road added in the traditional potential field function can ensure that the automobile runs towards the center of the road, and the safety and stability of the running process of the automobile are improved;
(3) The relative speed, the pose, the track and the obstacle distance of the automobile and the obstacle in each critical path node are sampled through the improved dynamic window, so that the preliminary planning path can be dynamically updated in real time, and the requirements in the actual driving environment can be better met.
In addition, the automobile path planning method for fusing the improved potential field and the dynamic window has the following technical characteristics:
further, in step 2, the expressions of the target attraction function, the obstacle repulsive function, and the relative velocity repulsive function are respectively:
Figure SMS_1
Figure SMS_2
Figure SMS_3
wherein,,
Figure SMS_6
for target attraction->
Figure SMS_9
For obstacle repulsive force, < >>
Figure SMS_10
For the repulsive force of the relative velocity, d 1 D is the distance between the automobile and the target point 2 For the distance between the car and the obstacle +.>
Figure SMS_5
Figure SMS_8
X and y are the position coordinates of the automobile, x rep And y rep Is the obstacle position coordinates, < >>
Figure SMS_11
Figure SMS_12
、/>
Figure SMS_4
The gravity gain coefficient, the repulsion gain coefficient and the relative speed repulsion gain coefficient, v rel For the relative speed of the car and the obstacle, +.>
Figure SMS_7
Is the angle between the attractive and repulsive forces.
Further, in step 2, the expression of the road longitudinal force function is:
Figure SMS_13
wherein,,
Figure SMS_14
represents the longitudinal force of the road, d is the longitudinal distance between the automobile and the road, d 0 For the road longitudinal force effective distance, < > and->
Figure SMS_15
Is the longitudinal force gain coefficient of the road.
Further, the step 3 specifically includes:
step 301, establishing a coordinate system by using a road boundary in a driving environment model;
step 302, selecting position coordinates of an automobile, a target point and an obstacle based on the established coordinate system, and setting automobile parameters;
step 303, controlling the vehicle to advance according to the set vehicle parameters, detecting whether the road longitudinal force effective distance is reached in real time in the vehicle advancing process, if the road longitudinal force effective distance is reached, entering step 304, and if the road longitudinal force effective distance is not reached, entering step 305;
step 304, the road longitudinal force takes effect, and the automobile moves forward under the combined action of the target gravitation function, the obstacle repulsive force function, the relative speed repulsive force function and the road longitudinal force function to obtain a preliminary planning path;
step 305, the car goes forward under the combined action of the target gravitation function, the obstacle repulsive force function and the relative speed repulsive force function, and a preliminary planning path is obtained.
Further, in step 5, the evaluation function and the weighting coefficient of the dynamic window are modified as follows:
Figure SMS_16
Figure SMS_17
wherein,,
Figure SMS_20
evaluation function representing improved dynamic window, < ->
Figure SMS_22
Representing the improved weighting coefficients of the model,
Figure SMS_25
for pose function, add->
Figure SMS_19
For the distance function of the driving track and the target point, +.>
Figure SMS_23
As a function of the linear speed of the driving track, +.>
Figure SMS_26
As a function of the distance between the driving trajectory and the obstacle, < > and the distance between the obstacle and the driving trajectory>
Figure SMS_27
Weighting coefficients for pose functions, +.>
Figure SMS_18
Weighting coefficient for the distance function of the driving track and the target point, < ->
Figure SMS_21
Weighting coefficient for the linear speed function of the driving trajectory, < ->
Figure SMS_24
The min represents the weighting coefficient of the function of the distance between the driving track and the obstacleMinimum, max represents the maximum value.
Drawings
FIG. 1 is a flow chart of a method for planning a vehicle path by fusing an improved potential field with a dynamic window according to an embodiment of the present invention;
FIG. 2 is a schematic diagram of the potential field stress of an automobile according to the present invention;
FIG. 3 is a diagram showing the comparison between the method of the present embodiment and the conventional potential field algorithm in solving the problem of target unreachability;
fig. 4 is a schematic diagram showing the comparison between the method of the present embodiment and the result of the conventional potential field algorithm in solving the local optimum problem.
Detailed Description
For the purpose of making the objects, technical solutions and advantages of the embodiments of the present invention more apparent, the technical solutions of the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention, and it is apparent that the described embodiments are some embodiments of the present invention, but not all embodiments of the present invention. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to be within the scope of the invention.
Referring to fig. 1, an embodiment of the present invention provides a method for planning an automobile path by fusing an improved potential field and a dynamic window, comprising the following steps:
and step 1, modeling a driving environment by adopting a potential field method to obtain a driving environment model.
And 2, obtaining coordinate positions of the automobile, the target point, the obstacle and the road boundary in the driving environment model, and establishing a plurality of potential field functions according to the position relation between the automobile and the target point, between the automobile and the obstacle and between the automobile and the road boundary, wherein the plurality of potential field functions specifically comprise a target gravitation function, an obstacle repulsive force function, a relative speed repulsive force function and a road longitudinal force function.
The expressions of the target gravitation function, the obstacle repulsive force function and the relative speed repulsive force function are respectively as follows:
Figure SMS_28
Figure SMS_29
Figure SMS_30
wherein,,
Figure SMS_32
for target attraction->
Figure SMS_35
For obstacle repulsive force, < >>
Figure SMS_37
For the repulsive force of the relative velocity, d 1 D is the distance between the automobile and the target point 2 For the distance between the car and the obstacle +.>
Figure SMS_33
Figure SMS_36
X and y are the position coordinates of the automobile, x rep And y rep Is the obstacle position coordinates, < >>
Figure SMS_38
Figure SMS_39
、/>
Figure SMS_31
The gravity gain coefficient, the repulsion gain coefficient and the relative speed repulsion gain coefficient, v rel For the relative speed of the car and the obstacle, +.>
Figure SMS_34
Is the angle between the attractive and repulsive forces.
The expression of the road longitudinal force function is:
Figure SMS_40
wherein,,
Figure SMS_41
represents the longitudinal force of the road, d is the longitudinal distance between the automobile and the road, d 0 For the road longitudinal force effective distance, < > and->
Figure SMS_42
Is the longitudinal force gain coefficient of the road.
The problem of local optimum is typically trapped in conventional potential fields because the repulsive and attractive forces are in a straight line and equal, and the problem of target unreachable may be due to excessive repulsive forces. In this embodiment, referring to fig. 2, the longitudinal force and the repulsive force of the relative speed are added to effectively solve the two problems. When the vertical distance between the automobile and the road is within the effective distance range of the longitudinal force of the road, the current planned path of the automobile is indicated to possibly run out of the preset road, the newly added longitudinal force of the road can ensure that the automobile runs towards the center of the road, and the safety and stability of the running process of the automobile are improved.
And step 3, obtaining a preliminary planning path based on the driving environment model and a plurality of potential field functions.
The step 3 specifically includes:
step 301, establishing a coordinate system by using a road boundary in a driving environment model;
step 302, selecting position coordinates of an automobile, a target point and an obstacle based on the established coordinate system, and setting automobile parameters;
step 303, controlling the vehicle to advance according to the set vehicle parameters, detecting whether the road longitudinal force effective distance is reached in real time in the vehicle advancing process, if the road longitudinal force effective distance is reached, entering step 304, and if the road longitudinal force effective distance is not reached, entering step 305;
step 304, the road longitudinal force takes effect, the automobile moves forward under the combined action of the target gravitation function, the obstacle repulsive force function, the relative speed repulsive force function and the road longitudinal force function, and a preliminary planning path is obtained, wherein the direction of the road longitudinal force is vertical to the center of the road, and the automobile is prevented from moving away from the road;
step 305, the car goes forward under the combined action of the target gravitation function, the obstacle repulsive force function and the relative speed repulsive force function, and a preliminary planning path is obtained.
And 4, acquiring a key path node from the automobile to each obstacle based on the preliminary planning path.
And 5, improving the evaluation function and the weighting coefficient of the dynamic window to obtain an improved dynamic window.
Wherein, the evaluation function and the weighting coefficient of the dynamic window are improved as follows:
Figure SMS_43
Figure SMS_44
wherein,,
Figure SMS_46
evaluation function representing improved dynamic window, < ->
Figure SMS_50
Representing the improved weighting coefficients of the model,
Figure SMS_53
a pose function for enabling the advancing direction of the automobile to always face the target point; />
Figure SMS_47
The method comprises the steps of estimating the distance between the end point of a planned path and a target point for a distance function of a driving track and the target point; />
Figure SMS_49
As a function of the linear velocity of the travel path,for detecting the relative speed of the vehicle to the obstacle; />
Figure SMS_52
The obstacle avoidance system is a function of the distance between a driving track and an obstacle and is used for enabling the automobile to avoid the obstacle accurately; />
Figure SMS_54
Weighting coefficients for pose functions, +.>
Figure SMS_45
Weighting coefficient for the distance function of the driving track and the target point, < ->
Figure SMS_48
Weighting coefficient for the linear speed function of the driving trajectory, < ->
Figure SMS_51
The weighting coefficient of the function of the distance between the driving track and the obstacle is min, min and max.
And 6, inputting the critical path nodes from the automobile to each obstacle into an improved dynamic window, sampling the relative speed of the automobile and the obstacle on the critical path nodes, the pose of the automobile, the distance between the automobile track and the obstacle and the minimum safety distance of the automobile running through an evaluation function of the improved dynamic window, and carrying out real-time optimization and updating on the preliminary planning path through the improved dynamic window to obtain the optimized planning path.
In the process of optimizing and updating the preliminary planning path in real time by utilizing the improved dynamic window, judging whether the automobile reaches a target point in real time, and if so, inputting the optimized planning path; if not, returning to the step of inputting the critical path nodes from the automobile to each obstacle into the improved dynamic window, and continuing to optimize and update until the automobile reaches the target point.
The method of this embodiment is compared with the planned path of a conventional potential field algorithm as follows.
As shown in fig. 3, fig. 3 is a schematic diagram showing the comparison of the results of the method of the present embodiment and the conventional potential field algorithm when solving the problem of target unreachability.
The MatlabR2022a version is used in the simulation experiment, and compared with the method of the embodiment and the traditional potential field algorithm, the method solves the problem that the target is unreachable. In the simulation, the black solid squares represent cars, coordinates (1,0.25); the circles are obstacles, and the coordinates of partial obstacles are (2,2.58), (3.9,3.5), (4.8,5.6), (7.5,7); the white hollow square represents the target point, and the coordinates are (9.5,9); through simulation verification, compared with the traditional potential field algorithm, the method of the embodiment can effectively solve the problem that the target is unreachable.
Further, as shown in fig. 4, fig. 4 is a schematic diagram showing the comparison between the method of the present embodiment and the result of the conventional potential field algorithm when solving the local optimum problem.
The simulation experiment uses MatlabR2022a version, and the method of the embodiment is compared with the traditional potential field algorithm to solve the problem of local optimum. In the simulation, the black solid squares represent cars, coordinates (1,0.25); the circle is an obstacle, and the coordinates of partial obstacles are (2, 2), (4.6,2), (3.9,4), (6.2,4.7); the white hollow square represents the target point, and the coordinates are (8.5,9.5); through simulation verification, compared with the traditional potential field algorithm, the method of the embodiment can effectively solve the problem of local optimum.
Therefore, the path planned by the method can smoothly avoid the obstacle to reach the target point, and the planned path is shorter, smoother and more stable, and meets the requirements in the actual driving environment.
In summary, the automobile path planning method for fusing the improved potential field and the dynamic window has the following beneficial effects:
(1) On the basis of the traditional potential field function, a relative speed repulsive force function and a road longitudinal force function are added, so that the problems of local optimum and unreachable targets in the traditional algorithm can be effectively solved;
(2) The longitudinal force of the road added in the traditional potential field function can ensure that the automobile runs towards the center of the road, and the safety and stability of the running process of the automobile are improved;
(3) The relative speed, the pose, the track and the obstacle distance of the automobile and the obstacle in each critical path node are sampled through the improved dynamic window, so that the preliminary planning path can be dynamically updated in real time, and the requirements in the actual driving environment can be better met.
In the description of the present specification, a description referring to terms "one embodiment," "some embodiments," "examples," "specific examples," or "some examples," etc., means that a particular feature, structure, material, or characteristic described in connection with the embodiment or example is included in at least one embodiment or example of the present invention. In this specification, schematic representations of the above terms do not necessarily refer to the same embodiments or examples. Furthermore, the particular features, structures, materials, or characteristics described may be combined in any suitable manner in any one or more embodiments or examples.
While embodiments of the present invention have been shown and described, it will be understood by those of ordinary skill in the art that: many changes, modifications, substitutions and variations may be made to the embodiments without departing from the spirit and principles of the invention, the scope of which is defined by the claims and their equivalents.

Claims (5)

1. The automobile path planning method integrating the improved potential field and the dynamic window is characterized by comprising the following steps of:
step 1, modeling a driving environment by adopting a potential field method to obtain a driving environment model;
step 2, in a driving environment model, coordinate positions of an automobile, a target point, an obstacle and a road boundary are obtained, and then a plurality of potential field functions are established according to the position relation between the automobile and the target point, between the automobile and the obstacle and between the automobile and the road boundary, wherein the plurality of potential field functions specifically comprise a target gravitation function, an obstacle repulsive force function, a relative speed repulsive force function and a road longitudinal force function;
step 3, obtaining a preliminary planning path based on a driving environment model and a plurality of potential field functions;
step 4, acquiring key path nodes from the automobile to each obstacle based on the preliminary planning path;
step 5, improving the evaluation function and the weighting coefficient of the dynamic window to obtain an improved dynamic window;
and 6, inputting the critical path nodes from the automobile to each obstacle into an improved dynamic window, sampling the relative speed of the automobile and the obstacle on the critical path nodes, the pose of the automobile, the distance between the automobile track and the obstacle and the minimum safety distance of the automobile running through an evaluation function of the improved dynamic window, and carrying out real-time optimization and updating on the preliminary planning path through the improved dynamic window to obtain the optimized planning path.
2. The method for planning an automobile path by fusing an improved potential field and a dynamic window according to claim 1, wherein in step 2, expressions of a target attraction function, an obstacle repulsive force function, and a relative speed repulsive force function are respectively:
Figure QLYQS_1
Figure QLYQS_2
Figure QLYQS_3
wherein,,
Figure QLYQS_5
for target attraction->
Figure QLYQS_9
For obstacle repulsive force, < >>
Figure QLYQS_10
For the repulsive force of the relative velocity, d 1 D is the distance between the automobile and the target point 2 For the distance between the car and the obstacle +.>
Figure QLYQS_6
Figure QLYQS_8
X and y are the position coordinates of the automobile, x rep And y rep Is the obstacle position coordinates, < >>
Figure QLYQS_11
Figure QLYQS_12
、/>
Figure QLYQS_4
The gravity gain coefficient, the repulsion gain coefficient and the relative speed repulsion gain coefficient, v rel For the relative speed of the car and the obstacle, +.>
Figure QLYQS_7
D is the angle between the attractive force and the repulsive force 0 Is the effective distance of the longitudinal force of the road.
3. The method for planning a vehicle path by fusing an improved potential field and a dynamic window according to claim 2, wherein in step 2, the expression of the road longitudinal force function is:
Figure QLYQS_13
wherein,,
Figure QLYQS_14
represents the longitudinal force of the road, d is the longitudinal distance of the car from the road, < >>
Figure QLYQS_15
Is the longitudinal force gain coefficient of the road.
4. The method for planning a path of an automobile by fusing an improved potential field with a dynamic window according to claim 3, wherein step 3 specifically comprises:
step 301, establishing a coordinate system by using a road boundary in a driving environment model;
step 302, selecting position coordinates of an automobile, a target point and an obstacle based on the established coordinate system, and setting automobile parameters;
step 303, controlling the vehicle to advance according to the set vehicle parameters, detecting whether the road longitudinal force effective distance is reached in real time in the vehicle advancing process, if the road longitudinal force effective distance is reached, entering step 304, and if the road longitudinal force effective distance is not reached, entering step 305;
step 304, the road longitudinal force takes effect, and the automobile moves forward under the combined action of the target gravitation function, the obstacle repulsive force function, the relative speed repulsive force function and the road longitudinal force function to obtain a preliminary planning path;
step 305, the car goes forward under the combined action of the target gravitation function, the obstacle repulsive force function and the relative speed repulsive force function, and a preliminary planning path is obtained.
5. The method for planning a vehicle path by fusing an improved potential field and a dynamic window as claimed in claim 4, wherein in step 5, the evaluation function and the weighting coefficient of the dynamic window are improved as follows:
Figure QLYQS_16
Figure QLYQS_17
wherein,,
Figure QLYQS_20
evaluation function representing improved dynamic window, < ->
Figure QLYQS_21
Representing the improved weighting coefficients of the model,
Figure QLYQS_24
for pose function, add->
Figure QLYQS_19
For the distance function of the driving track and the target point, +.>
Figure QLYQS_23
As a function of the linear speed of the driving track, +.>
Figure QLYQS_26
As a function of the distance between the driving trajectory and the obstacle, < > and the distance between the obstacle and the driving trajectory>
Figure QLYQS_27
Weighting coefficients for pose functions, +.>
Figure QLYQS_18
Weighting coefficient for the distance function of the driving track and the target point, < ->
Figure QLYQS_22
Weighting coefficient for the linear speed function of the driving trajectory, < ->
Figure QLYQS_25
The weighting coefficient of the function of the distance between the driving track and the obstacle is min, min and max.
CN202310498150.9A 2023-05-06 2023-05-06 Automobile path planning method integrating improved potential field and dynamic window Active CN116202550B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310498150.9A CN116202550B (en) 2023-05-06 2023-05-06 Automobile path planning method integrating improved potential field and dynamic window

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310498150.9A CN116202550B (en) 2023-05-06 2023-05-06 Automobile path planning method integrating improved potential field and dynamic window

Publications (2)

Publication Number Publication Date
CN116202550A CN116202550A (en) 2023-06-02
CN116202550B true CN116202550B (en) 2023-07-11

Family

ID=86515017

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310498150.9A Active CN116202550B (en) 2023-05-06 2023-05-06 Automobile path planning method integrating improved potential field and dynamic window

Country Status (1)

Country Link
CN (1) CN116202550B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117055559A (en) * 2023-08-30 2023-11-14 苏州大成运和智能科技有限公司 Automatic driving vehicle obstacle avoidance method for improving artificial potential field method

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115489548A (en) * 2022-09-20 2022-12-20 重庆大学 Intelligent automobile park road path planning method

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101076008B1 (en) * 2010-07-19 2011-10-21 삼성탈레스 주식회사 Autonomous navigation robot for performing magnetic field based path planning
CN105867365B (en) * 2016-03-11 2019-02-05 中国矿业大学(北京) Path planning navigation system and method based on modified embedded-atom method
CN106970648B (en) * 2017-04-19 2019-05-14 北京航空航天大学 Unmanned plane multi-goal path plans combined method for searching under the environment of city low latitude
KR102267316B1 (en) * 2019-03-05 2021-06-21 네이버랩스 주식회사 Method and system for learning automatic driving agent based on deep reinforcement learning
CN110989656A (en) * 2019-11-13 2020-04-10 中国电子科技集团公司第二十研究所 Conflict resolution method based on improved artificial potential field method
EP4099118A4 (en) * 2020-02-25 2023-01-25 Huawei Technologies Co., Ltd. Vehicle control method and apparatus
CN112109704B (en) * 2020-09-22 2022-04-01 同济大学 Vehicle collision avoidance dynamic safety path planning method based on accurate track prediction
CN112923944A (en) * 2021-01-29 2021-06-08 的卢技术有限公司 Automatic driving path planning method and system and computer readable storage medium
CN113296523A (en) * 2021-05-27 2021-08-24 太原科技大学 Mobile robot obstacle avoidance path planning method
CN114265410A (en) * 2021-12-25 2022-04-01 长安大学 Local path planning method and system based on multi-computational power fusion
CN114442637B (en) * 2022-02-10 2023-11-10 北京理工大学 Unmanned vehicle local dynamic obstacle avoidance path planning method
CN114995431A (en) * 2022-06-09 2022-09-02 安徽工业大学 Mobile robot path planning method for improving A-RRT
CN115328152B (en) * 2022-09-05 2023-06-30 北京理工大学 Unmanned vehicle local real-time obstacle avoidance path planning method based on improved artificial potential field method

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115489548A (en) * 2022-09-20 2022-12-20 重庆大学 Intelligent automobile park road path planning method

Also Published As

Publication number Publication date
CN116202550A (en) 2023-06-02

Similar Documents

Publication Publication Date Title
CN111338340B (en) Model prediction-based local path planning method for unmanned vehicle
CN110908373B (en) Intelligent vehicle track planning method based on improved artificial potential field
US11554785B2 (en) Driving scenario machine learning network and driving environment simulation
CN110749333B (en) Unmanned vehicle motion planning method based on multi-objective optimization
CN116202550B (en) Automobile path planning method integrating improved potential field and dynamic window
CN113064426B (en) Intelligent vehicle path planning method for improving bidirectional fast search random tree algorithm
CN108898866B (en) Intelligent vehicle control system
CN113359718B (en) Method and equipment for fusing global path planning and local path planning of mobile robot
CN111324848B (en) Vehicle-mounted track data optimization method of mobile laser radar measurement system
CN110703757B (en) Energy consumption optimization-oriented high-speed train speed planning method
CN112731916A (en) Global dynamic path planning method integrating skip point search method and dynamic window method
CN113325845B (en) Unmanned driving path planning method based on hybrid APF and RRT
CN113359768A (en) Path planning method based on improved A-x algorithm
CN113296523A (en) Mobile robot obstacle avoidance path planning method
Frego et al. Semi-analytical minimum time solutions for a vehicle following clothoid-based trajectory subject to velocity constraints
CN114442637A (en) Unmanned vehicle local dynamic obstacle avoidance path planning method
CN113608531A (en) Unmanned vehicle real-time global path planning method based on dynamic window of safety A-guiding point
CN116185014A (en) Intelligent vehicle global optimal track planning method and system based on dynamic planning
CN114859905A (en) Local path planning method based on artificial potential field method and reinforcement learning
CN112644486A (en) Intelligent vehicle obstacle avoidance trajectory planning method based on novel driving safety field
CN115755908B (en) JPS guided Hybrid A-based mobile robot path planning method
CN116360457A (en) Path planning method based on self-adaptive grid and improved A-DWA fusion algorithm
CN115016482A (en) Improved indoor mobile robot global and local path coordination optimization method
CN114545921B (en) Unmanned vehicle path planning algorithm based on improved RRT algorithm
CN116501030A (en) Automatic driving vehicle path planning method based on improved artificial potential field 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