IP Library › Granted Patent US 12,325,445
Granted Patent B2
US 12,325,445 · App. 18/101,169 · Granted Jun 10, 2025

High-definition map-based local path planning method and apparatus for dynamic and static obstacle avoidance

Inventors: Hyun Myung (Daejeon, KR); Euigon Jung (Daejeon, KR); Wonho Song (Daejeon, KR)
Assignee: Korea Advanced Institute of Science and Technology
B60W60/0011B60W60/0015B60W2554/20B60W2554/40B60W2556/40
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 12,325,445
App. No.
18/101,169
Granted
Jun 10, 2025
Kind
B2
Abstract

Disclosed is a high-definition (HD) map-based local path planning method and apparatus for dynamic and static object avoidance. An HD map-based local path planning method for dynamic and static object avoidance performed by a computer device includes verifying a position on a global path by parameterizing the global path using an arc length; generating a path candidate group based on the global path; and selecting an optimal path as a path having a smallest cost function related to a global path following from the path candidate group. The cost function includes a global-path-following cost for selecting a path candidate group having a smallest lateral offset from the global path.

Claims (28)

1. A high-definition (HD) map-based local path planning method for dynamic and static object avoidance performed by a computer device, the method comprising:

verifying a position on a global path by parameterizing the global path using an arc length;

generating a path candidate group based on the global path; and

selecting an optimal path as a path having a smallest cost function related to a global path following from the path candidate group,

wherein the cost function includes a global-path-following cost for selecting a path candidate group having a smallest lateral offset from the global path,

wherein the generating of the path candidate group comprises determining, as an obstacle, an object that is not mapped to the HD map among objects determined through a sensor, computing a difference in the arc length from a current vehicle to each obstacle, and determining an arc length value of a path depending on presence or absence of the obstacle.

2. The method of claim 1 , further comprising:

determining a velocity of a vehicle for the selected optimal path.

3. The method of claim 1 , wherein the verifying of the position on the global path comprises interpolating waypoints of the global path generated based on the HD map into a cubic spline curve.

4. The method of claim 1 , wherein the verifying of the position on the global path comprises expressing each waypoint corresponding to the global path as coordinates by parameterizing a position of a vehicle in a road environment with respect to the arc length.

5. The method of claim 1 , wherein the verifying of the position on the global path comprises verifying the position on the global path by expressing a position of a vehicle as an arc length and a lateral offset with respect to the global path.

6. The method of claim 1 , wherein the generating of the path candidate group comprises generating the path candidate group by applying a lateral offset based on the global path.

7. The method of claim 1 , wherein the generating of the path candidate group comprises applying each path candidate group for vehicle control by converting from a Cartesian coordinate system to a curvilinear coordinate system.

8. The method of claim 1 , wherein the cost function includes a static object cost, a smoothness cost, a global-path-following cost, and a dynamic object cost, and is determined by adjusting an importance of each cost.

9. The method of claim 1 , wherein the selecting of the optimal path comprises allowing driving by reflecting a cost function for a dynamic object and by planning a path that uses cut-in and following for the dynamic object.

10. A high-definition (HD) map-based local path planning apparatus for dynamic and static object avoidance, the apparatus comprising:

a position verifier configured to verify a position on a global path by parameterizing the global path using an arc length;

a path candidate group generator configured to generate a path candidate group based on the global path; and

an optimal path selector configured to select an optimal path having a smallest cost function related to a global path following from the path candidate group,

wherein the cost function includes a global-path-following cost for selecting a path candidate group having a smallest lateral offset from the global path,

wherein the path candidate group generator is configured to determine, as an obstacle, an object that is not mapped to the HD map among objects determined through a sensor, to compute a difference in the arc length from a current vehicle to each obstacle, and to determine an arc length value of a path depending on presence or absence of the obstacle.

11. The apparatus of claim 10 , further comprising:

a vehicle velocity determiner configured to determine a velocity of a vehicle for the selected optimal path.

12. The apparatus of claim 10 , wherein the position verifier is configured to express each waypoint corresponding to the global path as coordinates by parameterizing a position of a vehicle in a road environment with respect to the arc length.

13. The apparatus of claim 10 , wherein the position verifier is configured to verify the position on the global path by expressing a position of a vehicle as an arc length and a lateral offset with respect to the global path.

14. The apparatus of claim 10 , wherein the path candidate group generator is configured to generate the path candidate group by applying a lateral offset based on the global path.

15. The apparatus of claim 10 , wherein the cost function includes a static object cost, a smoothness cost, a global-path-following cost, and a dynamic object cost, and is determined by adjusting an importance of each cost.

16. The apparatus of claim 10 , wherein the optimal path selector is configured to allow driving by reflecting a cost function for a dynamic object and by planning a path that uses cut-in and following for the dynamic object.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Jan 25, 2023
From: MYUNG, HYUN; JUNG, EUIGON; SONG, WONHO
To: KOREA ADVANCED INSTITUTE OF SCIENCE AND TECHNOLOGY
Reel/Frame 062479/0662 →
Priority Claims (1)
KR 10-2022-0067049 · May 31, 2022 · national
Continuity (1)
Related Publication 20240001961A1 · Jan 4, 2024
References Cited (10)
US 12077181B1 · Costantino · 2024 [cited by examiner]
US 20210294333A1 · Jing · 2021 [cited by examiner]
US 20210373566A1 · Agarwal · 2021 [cited by examiner]
US 20220194419A1 · Houshmand · 2022 [cited by examiner]
US 20230242142A1 · Zhang · 2023 [cited by examiner]
CN 111998867A · 2020 [cited by examiner]
CN 112362074A · 2021 [cited by examiner]
X. Hu, L. Chen, B. Tang, D. Cao, and H. He, “Dynamic path planning for autonomous driving on various roads with avoidance of static and moving obstacles,” Mech. Syst. Signal Process., vol. 100, pp. 482-500, Feb. 2018. [cited by applicant]
K. Chu, M. Lee, and M. Sunwoo, “Local path planning for off-road autonomous driving with avoidance of static obstacles,” IEEE Trans. Intell. Transp. Syst., vol. 13, No. 4, pp. 1599-1616, Dec. 2012. [cited by applicant]
H. Wang, J. Kearney, and K. Atkinson, “Arc-length parameterized spline curves for real-time simulation,” in Proc. 5th Int. Conf. Curves Surf., pp. 387-396, 2002. [cited by applicant]