Gradient-Based Time-Extended Potential Field Method for Real-Time Path Planning in Infrastructure-Based Cooperative Driving Systems
Abstract
1. Introduction
2. Related Works and Research Trends
2.1. Potential Field Applications in the Transportation Domain
2.2. Path Generation Using Potential Fields
3. Proposed Method
3.1. Overview
- Constructing composite potential functions from environmental elements;
- Integrating time into spatial potential field to form a time-extended spatiotemporal field;
- Generating a time-parameterized trajectory by following the negative gradient with added kinematic bias.
3.2. Construction of a PF Based on Road Environment
3.2.1. Potential for Surrounding Vehicles
3.2.2. Potential for Road Environment
- Lane Marking Potential
- 2.
- Road Boundary Potential
3.2.3. Goal Attraction Potential
3.2.4. Composite PF
3.2.5. Rationale and Empirical Validation of Parameter Settings
3.3. Path Generation
3.3.1. Principle of GT-PF Path Generation Based on Gradient Descent
3.3.2. GT-PF: Gradient-Based Path Search in a Time-Extended Spatiotemporal Field
4. Simulation and Performance Evaluation
4.1. Implementation and Experimental Setup
4.2. Comparative Results and Discussion
4.2.1. Path Visualization and Dynamic Characteristics
4.2.2. Quantitative Comparison
4.2.3. Parameter Sensitivity
4.2.4. Extended Scenario
4.2.5. Impact of Communication Latency on Path Planning
5. Conclusions
5.1. Discussion of Results
5.2. Evaluation from the Perspective of Infrastructure Application
5.3. Limitations and Future Work
- Further refining the integration of driving policies (e.g., steering angle change rate, vehicle following, lane selection);
- Increasing the influence of potential-based safety distances for obstacle avoidance;
- Detecting and escaping from local minima.
- Real-time applicability under RSU-to-vehicle communication systems;
- Integration of vehicle sensor data and infrastructure-provided data;
- Strategies for emergency maneuvers and handling unexpected obstacles;
- Mitigation of communication imperfections (e.g., latency, jitter, packet loss) and robustness against sensing noise.
Author Contributions
Funding
Data Availability Statement
Conflicts of Interest
Abbreviations
RSU | Road Side Unit |
RRT | Rapidly exploring Random Tree |
MEC | Multi-access Edge Computing |
PF | Potential Field |
V2X | Vehicle-to-Everything |
PRM | Probabilistic Roadmap Method |
MPC | Model Predictive Control |
iLQR | Iterative Linear Quadratic Regulator |
DWA | Dynamic Window Approach |
TTC | Time To Collision |
SDM | Safety Distance Margin |
References
- Jeon, H.; Yang, I.; Kim, H.; Lee, J.; Kim, S.-K.; Jang, J.; Kim, J. Some Lessons Learned from Previous Studies in Cooperative Driving Automation. J. Korean Inst. Intell. Transp. Syst. 2022, 21, 62–77. [Google Scholar] [CrossRef]
- Yang, I.; Jeon, W.H.; Lee, H.M. A Study on Dynamic Map Data Provision System for Automated Vehicle. J. Korean Inst. Intell. Transp. Syst. 2017, 16, 208–218. [Google Scholar] [CrossRef]
- SAE. Surface Vehicle Standard—V2X Communications Message Set Dictionary; SAE International: Warrendale, PA, USA, 2022; Available online: https://www.sae.org/standards/content/j2735_202211 (accessed on 15 June 2025).
- Jeon, H.; Yang, I.; Kim, H.; Lee, J.; Kim, S.-K.; Jang, J. A study on methodology to develop use cases of infra-guidance service for connected and automated driving. J. Digit. Contents Soc. 2022, 23, 1331–1340. [Google Scholar] [CrossRef]
- Abdallaoui, S.; Aglzim, E.-H.; Chaibet, A.; Kribèche, A. Thorough Review Analysis of Safe Control of Autonomous Vehicles: Path Planning and Navigation Techniques. Energies 2022, 15, 1358. [Google Scholar] [CrossRef]
- Zhang, L.; Cai, K.; Sun, Z.; Bing, Z.; Wang, C.; Figueredo, L.; Haddadin, S.; Knoll, A. Motion Planning for Robotics: A Review for Sampling-Based Planners. Biomim. Intell. Robot. 2025, 5, 100207. [Google Scholar] [CrossRef]
- Lou, Y.Y.; Spencer, J.; Kim, K.T.; Chiang, M. E-MPC: Edge-Assisted Model Predictive Control. arXiv 2024, arXiv:2410.00695. [Google Scholar]
- Cao, Y.; Nor, N.M. An Improved Dynamic Window Approach Algorithm for Dynamic Obstacle Avoidance in Mobile Robot Formation. Decis. Anal. J. 2024, 11, 100471. [Google Scholar] [CrossRef]
- Khatib, O. Real-Time Obstacle Avoidance for Manipulators and Mobile Robots. In Proceedings of the 1985 IEEE International Conference on Robotics and Automation, St. Louis, MO, USA, 25–28 March 1985; Volume 2, pp. 500–505. [Google Scholar]
- Ko, J.; Yang, I. Research on Vehicle Risk Field Model for Edge Infrastructure at Cooperative Driving. J. Korean Inst. Intell. Transp. Syst. 2024, 23, 338–354. [Google Scholar] [CrossRef]
- Reichardt, D.; Shick, J. Collision Avoidance in Dynamic Environments Applied to Autonomous Vehicle Guidance on the Motorway. In Proceedings of the Intelligent Vehicles’ 94 Symposium, Paris, France, 24–26 October 1994; pp. 74–78. [Google Scholar]
- Gerdes, J.C.; Rossetter, E.J. A Unified Approach to Driver Assistance Systems Based on Artificial Potential Fields. J. Dyn. Syst. Meas. Control 2001, 123, 431–438. [Google Scholar] [CrossRef]
- Wang, J.; Wu, J.; Li, Y. The Driving Safety Field Based on Driver–Vehicle–Road Interactions. IEEE Trans. Intell. Transp. Syst. 2015, 16, 2203–2214. [Google Scholar] [CrossRef]
- Wang, J.; Wu, J.; Li, Y. Concept, Principle and Modeling of Driving Risk Field Based on Driver–Vehicle–Road Interaction. China J. Highw. Transp. 2016, 29, 105–114. [Google Scholar]
- Ni, D. A Unified Perspective on Traffic Flow Theory, Part I: The Field Theory. In Proceedings of the ICCTP 2011: Towards Sustainable Transportation Systems, Nanjing, China, 14 August 2011; pp. 4227–4243. [Google Scholar]
- Wolf, M.T.; Burdick, J.W. Artificial Potential Functions for Highway Driving with Collision Avoidance. In Proceedings of the 2008 IEEE International Conference on Robotics and Automation, Pasadena, CA, USA, 19–23 May 2008; pp. 3731–3736. [Google Scholar]
- Li, Y.; Chen, Y. A New Method Based on Field Strength for Road Infrastructure Risk Assessment. J. Adv. Transp. 2018, 6379146. [Google Scholar] [CrossRef]
- Li, L.; Gan, J.; Ji, X.; Qu, X.; Ran, B. Dynamic Driving Risk Potential Field Model under the Connected and Automated Vehicles Environment and Its Application in Car-Following Modeling. IEEE Trans. Intell. Transp. Syst. 2020, 23, 122–141. [Google Scholar] [CrossRef]
- Kolekar, S.; Petermeijer, B.; Boer, E.; de Winter, J.; Abbink, D. A Risk Field-Based Metric Correlates with Driver’s Perceived Risk in Manual and Automated Driving: A Test-Track Study. Transp. Res. Part C Emerg. Technol. 2021, 133, 103428. [Google Scholar] [CrossRef]
- Tan, S.; Wang, Z.; Zhong, Y. RCP-RF: A Comprehensive Road–Car–Pedestrian Risk Management Framework Based on Driving Risk Potential Field. IET Intell. Transp. Syst. 2024, 18, 2618–2640. [Google Scholar] [CrossRef]
- Ploeg, C.; Nyberg, T.; Sánchez, J.M.G.; Silvas, E.; van de Wouw, N. Overcoming Fear of the Unknown: Occlusion-Aware Model-Predictive Planning for Automated Vehicles Using Risk Fields. IEEE Trans. Intell. Transp. Syst. 2024, 25, 12591–12604. [Google Scholar] [CrossRef]
- Joo, Y.-J.; Kim, E.-J.; Kim, D.-K.; Park, P.Y. A Generalized Driving Risk Assessment on High-Speed Highways Using Field Theory. Anal. Methods Accid. Res. 2023, 40, 100293. [Google Scholar] [CrossRef]
- Ma, Y.; Dong, F.; Yin, B.; Lou, Y. Real-Time Risk Assessment Model for Multi-Vehicle Interaction of Connected and Autonomous Vehicles in Weaving Area Based on Risk Potential Field. Phys. A Stat. Mech. its Appl. 2023, 620, 128725. [Google Scholar] [CrossRef]
- Tian, Y.; Pei, H.; Zhang, Y. Path Planning for CAVs Considering Dynamic Obstacle Avoidance Based on Improved Driving Risk Field and A* Algorithm. In Proceedings of the 2020 5th International Conference on Information Science, Computer Technology and Transportation (ISCTT), Shenyang, China, 13–15 November 2020; pp. 281–286. [Google Scholar]
- Liu, L.; Wang, B.; Xu, H. Research on Path-Planning Algorithm Integrating Optimization A-Star Algorithm and Artificial Potential Field Method. Electronics 2022, 11, 3660. [Google Scholar] [CrossRef]
- Shan, S.; Shao, J.; Zhang, H.; Xie, S.; Sun, F. Research and Validation of Self-Driving Path Planning Algorithm Based on Optimized A*-Artificial Potential Field Method. IEEE Sensors J. 2024, 24, 24708–24722. [Google Scholar] [CrossRef]
- Tao, F.; Ding, Z.; Fu, Z.; Li, M.; Ji, B. Efficient Path Planning for Autonomous Vehicles Based on RRT* with Variable Probability Strategy and Artificial Potential Field Approach. Sci. Rep. 2024, 14, 24698. [Google Scholar] [CrossRef]
- Ma, H.; Pei, W.; Zhang, Q. Research on Path Planning Algorithm for Driverless Vehicles. Mathematics 2022, 10, 2555. [Google Scholar] [CrossRef]
- Li, X.; Li, G.; Bian, Z. Research on Autonomous Vehicle Path Planning Algorithm Based on Improved RRT* Algorithm and Artificial Potential Field Method. Sensors 2024, 24, 3899. [Google Scholar] [CrossRef]
- Rasekhipour, Y.; Khajepour, A.; Chen, S.K.; Litkouhi, B. A Potential Field-Based Model Predictive Path-Planning Controller for Autonomous Road Vehicles. IEEE Trans. Intell. Transp. Syst. 2016, 18, 1255–1267. [Google Scholar] [CrossRef]
- Wahid, N.; Zamzuri, H.; Rahman, M.A.A.; Kuroda, S.; Raksincharoensak, P. Study on Potential Field Based Motion Planning and Control for Automated Vehicle Collision Avoidance Systems. In Proceedings of the 2017 IEEE International Conference on Mechatronics (ICM), Gippsland, VIC, Australia, 13–15 February 2017; pp. 208–213. [Google Scholar]
- Shang, X.; Eskandarian, A. Emergency Collision Avoidance and Mitigation Using Model Predictive Control and Artificial Potential Function. IEEE Trans. Intell. Veh. 2023, 8, 3458–3472. [Google Scholar] [CrossRef]
- Yang, H.; He, Y.; Xu, Y.; Zhao, H. Collision Avoidance for Autonomous Vehicles Based on MPC with Adaptive APF. IEEE Trans. Intell. Veh. 2023, 9, 1559–1570. [Google Scholar] [CrossRef]
- Chen, Q.; Yu, B.; Min, S.; Gan, L.; Luo, C.; Zeng, D.; Liu, Q. Study on Intelligent Vehicle Trajectory Planning and Tracking Control Based on Improved APF and MPC. Int. J. Automot. Technol. 2024, 25, 1–14. [Google Scholar] [CrossRef]
- Park, G.; Choi, M. Optimal Path Planning for Autonomous Vehicles Using Artificial Potential Field Algorithm. Int. J. Automot. Technol. 2023, 24, 1259–1267. [Google Scholar] [CrossRef]
- Huang, Z.; Wu, Q.; Ma, J.; Fan, S. An APF and MPC Combined Collaborative Driving Controller Using Vehicular Communication Technologies. Chaos Solitons Fractals 2016, 89, 232–242. [Google Scholar] [CrossRef]
- Wang, J.; Yan, Y.; Zhang, K.; Chen, Y.; Cao, M.; Yin, G. Path Planning on Large Curvature Roads Using Driver-Vehicle-Road System Based on the Kinematic Vehicle Model. IEEE Trans. Veh. Technol. 2021, 71, 311–325. [Google Scholar] [CrossRef]
- Li, Y.; Li, G.; Peng, K. Research on Obstacle Avoidance Trajectory Planning for Autonomous Vehicles on Structured Roads. World Electr. Veh. J. 2024, 15, 168. [Google Scholar] [CrossRef]
- Han, J.; Zhao, J.; Zhu, B.; Song, D. Spatial–Temporal Risk Field for Intelligent Connected Vehicle in Dynamic Traffic and Application in Trajectory Planning. IEEE Trans. Intell. Transp. Syst. 2023, 24, 2963–2975. [Google Scholar] [CrossRef]
- Lozano-Pérez, T. Spatial Planning: A Configuration Space Approach. IEEE Trans. Comput. 1983, 32, 108–120. [Google Scholar] [CrossRef]
Category | GT-PF | [30] | [36] | [39] |
---|---|---|---|---|
Agent Potential Function | velocity and acceleration aware potential | APF | APF (vehicle-type variant) | Risk Field |
Exploration Method | Gradient-based PF Search | MPC-based Optimization | MPC-based Control | RRT-based Sampling |
Planning Dimension | Space–Time (Gradient-based) | Space (2D) | Space + Communication | Space–Time (RRT-based) |
Dynamic Adaptation Method | Time-Extended PF with Gradient Search | Real-time MPC re-optimization | Cooperative MPC with V2V/V2X | Time-Expanded RRT Sampling |
Real-time Capability | High | Medium | Medium | Low (due to sampling) |
Control Level | Trajectory-level (no direct control) | MPC-level (explicit control input) | MPC-level | Trajectory-level (slow, heavy) |
Road & Lane Structure | Trajectory-level (no direct control) | MPC-level (explicit control input) | MPC-level | Trajectory-level (slow, heavy) |
Cooperation | Infrastructure-assisted | Single | Cooperative | Connected |
Search Angle | ±1° | ±2° | ±3° | ±5° | ±10° | ±15° | ±30° |
---|---|---|---|---|---|---|---|
Maximum speed (m/s) | 1.04v (17.25) | 1.07v (17.88) | 1.11v (18.50) | 1.19v (19.87) | 1.43v (23.81) | 1.73v (28.85) | 3.73v (62.18) |
Minimum speed (m/s) | 0.97v (16.09) | 0.93v (15.54) | 0.90 v (15.00) | 0.84v (13.97) | 0.70v (11.67) | 0.58v (9.62) | 0.27v (4.47) |
Category | Item | Value/Description |
---|---|---|
Road | Road type | Two-lane one way, Straight section |
Road width | 7 m | |
Ego Vehicle | Initial Position | (x, y) = (−75, 1, 75) |
Initial Speed | 16.66 m/s (60 km/s) | |
Leading Vehicle | Initial Position | (x, y) = (0, 1.75) |
Initial Speed | 11.11 m/s (40 km/s) | |
Initial acceleration | 0.1 m/s2 | |
Goal point | (x, y) = (500, 1.75) | |
Time resolution | 0.1 s | |
PF/dynamics Parameter | Defined internally in the implementation; not detailed here |
Metric | Definition |
---|---|
Arrival time and travel distance (Efficiency) | Total time and distance taken by the ego vehicle to reach its goal. |
Minimum and average distance to the leading vehicle (Safety) | Minimum and average inter-vehicle distance throughout the scenario. |
Time spent in risk zones (Critical Time in Risk Zone) | Cumulative time with distance to the lead vehicle less than 50 m. |
Integrated potential risk (Integrated Risk) | Time-integrated potential field values, normalized by travel distance. |
Acceleration and jerk (Comfort) | Maximum and average longitudinal/lateral acceleration, jerk, steering rate. |
Computation time (Computational Cost) | Total processing time required to generate a full trajectory. |
Category | RRT-PF | GT-PF | Relative Difference (%) |
---|---|---|---|
Arrival Time (s) | 27.23 | 34.36 | +26.18 |
Travel Distance (m) | 574.23 | 572.69 | −0.27 |
Minimum Safety Distance (m) | 4.89 | 4.04 | −17.38 |
Time in Risk Zone (s) | 7.36 | 14.97 | +103.40 |
Avg. Risk per Distance | 1364.05 | 824.8 | −39.53 |
Average Acceleration (m/s2) | 11.39 | 0.63 | −94.49 |
Peak-to-Mean Jerk Ratio (m/s3) | 37.07 | 13.49 | −63.61 |
Computation Time (s) | 10.89 | 0.35 | −96.82 |
Category | GT-PF | GT-PF with Latency | Relative Difference (%) |
---|---|---|---|
Arrival Time (s) | 34.36 | 34.42 | +0.17 |
Travel Distance (m) | 572.69 | 572.65 | −0.01 |
Minimum Safety Distance (m) | 4.04 | 3.72 | −7.92 |
Time in Risk Zone (s) | 14.97 | 15.08 | +0.73 |
Avg. Risk per Distance | 824.8 | 831.56 | +0.82 |
Average Acceleration (m/s2) | 0.63 | 0.69 | +9.73 |
Peak-to-Mean Jerk Ratio (m/s3) | 13.49 | 13.39 | −0.74 |
Computation Time (s) | 0.35 | 0.34 | −1.42 |
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content. |
© 2025 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/).
Share and Cite
Ko, J.; Yang, I. Gradient-Based Time-Extended Potential Field Method for Real-Time Path Planning in Infrastructure-Based Cooperative Driving Systems. Sensors 2025, 25, 5601. https://doi.org/10.3390/s25175601
Ko J, Yang I. Gradient-Based Time-Extended Potential Field Method for Real-Time Path Planning in Infrastructure-Based Cooperative Driving Systems. Sensors. 2025; 25(17):5601. https://doi.org/10.3390/s25175601
Chicago/Turabian StyleKo, Jakyung, and Inchul Yang. 2025. "Gradient-Based Time-Extended Potential Field Method for Real-Time Path Planning in Infrastructure-Based Cooperative Driving Systems" Sensors 25, no. 17: 5601. https://doi.org/10.3390/s25175601
APA StyleKo, J., & Yang, I. (2025). Gradient-Based Time-Extended Potential Field Method for Real-Time Path Planning in Infrastructure-Based Cooperative Driving Systems. Sensors, 25(17), 5601. https://doi.org/10.3390/s25175601