A Hierarchical Trajectory Planning Algorithm for Automated Guided Vehicles in Construction Sites

Herein, to address the challenges faced by Automatic Guided Vehicles (AGVs) in construction site environments, including heavy vehicle loads, extensive road search areas, and randomly distributed obstacles, this paper presents a hierarchical trajectory planning algorithm that combines coarse plannin...

Full description

Bibliographic Details
Main Authors: Yu Bai, Pengpeng Li, Zhipeng Cui, Peng Yang, Weihua Li
Format: Article
Language:English
Published: MDPI AG 2024-03-01
Series:Electronics
Subjects:
Online Access:https://www.mdpi.com/2079-9292/13/6/1080
_version_ 1797241321265561600
author Yu Bai
Pengpeng Li
Zhipeng Cui
Peng Yang
Weihua Li
author_facet Yu Bai
Pengpeng Li
Zhipeng Cui
Peng Yang
Weihua Li
author_sort Yu Bai
collection DOAJ
description Herein, to address the challenges faced by Automatic Guided Vehicles (AGVs) in construction site environments, including heavy vehicle loads, extensive road search areas, and randomly distributed obstacles, this paper presents a hierarchical trajectory planning algorithm that combines coarse planning and precise planning. In the first-level coarse planning, lateral and longitudinal sampling is performed based on road environment constraints. A multi-criteria cost function is designed, taking into account factors such as deviation from the road centerline, shortest path cost, and obstacle collision safety cost. An efficient dynamic programming algorithm is used to obtain the optimal path. Considering nonholonomic constraints of vehicles, eliminating inflection points using improved B-Spline path fitting, and a quadratic programming algorithm is proposed to enhance path smoothness, completing the coarse planning algorithm. In the second-level precise planning, the coarse planning path is used as a reference line, and small-range sampling is conducted based on AGV motion constraints, including lateral displacement and longitudinal velocity. Lateral and longitudinal polynomials are constructed. To address the impact of randomly appearing obstacles on vehicle stability and safety, an evaluation function is designed, considering factors such as jerk and acceleration. The optimal trajectory is determined through collision detection, ensuring both safe obstacle avoidance and AGV smoothness. Experimental results demonstrate the effectiveness of this method in solving the path planning challenges faced by AGVs in construction site environments characterized by heavy vehicle loads, extensive road search areas, and randomly distributed obstacles.
first_indexed 2024-04-24T18:21:28Z
format Article
id doaj.art-94655117dcc743b3b7ce9f69b660a8be
institution Directory Open Access Journal
issn 2079-9292
language English
last_indexed 2024-04-24T18:21:28Z
publishDate 2024-03-01
publisher MDPI AG
record_format Article
series Electronics
spelling doaj.art-94655117dcc743b3b7ce9f69b660a8be2024-03-27T13:34:55ZengMDPI AGElectronics2079-92922024-03-01136108010.3390/electronics13061080A Hierarchical Trajectory Planning Algorithm for Automated Guided Vehicles in Construction SitesYu Bai0Pengpeng Li1Zhipeng Cui2Peng Yang3Weihua Li4School of Automotive Engineering, Harbin Institute of Technology (Weihai), Weihai 264201, ChinaSchool of Astronautics, Harbin Institute of Technology, Harbin 150001, ChinaChina Construction Institute of Advanced Technology, Wuhan 430073, ChinaChina Construction Institute of Advanced Technology, Wuhan 430073, ChinaSchool of Automotive Engineering, Harbin Institute of Technology (Weihai), Weihai 264201, ChinaHerein, to address the challenges faced by Automatic Guided Vehicles (AGVs) in construction site environments, including heavy vehicle loads, extensive road search areas, and randomly distributed obstacles, this paper presents a hierarchical trajectory planning algorithm that combines coarse planning and precise planning. In the first-level coarse planning, lateral and longitudinal sampling is performed based on road environment constraints. A multi-criteria cost function is designed, taking into account factors such as deviation from the road centerline, shortest path cost, and obstacle collision safety cost. An efficient dynamic programming algorithm is used to obtain the optimal path. Considering nonholonomic constraints of vehicles, eliminating inflection points using improved B-Spline path fitting, and a quadratic programming algorithm is proposed to enhance path smoothness, completing the coarse planning algorithm. In the second-level precise planning, the coarse planning path is used as a reference line, and small-range sampling is conducted based on AGV motion constraints, including lateral displacement and longitudinal velocity. Lateral and longitudinal polynomials are constructed. To address the impact of randomly appearing obstacles on vehicle stability and safety, an evaluation function is designed, considering factors such as jerk and acceleration. The optimal trajectory is determined through collision detection, ensuring both safe obstacle avoidance and AGV smoothness. Experimental results demonstrate the effectiveness of this method in solving the path planning challenges faced by AGVs in construction site environments characterized by heavy vehicle loads, extensive road search areas, and randomly distributed obstacles.https://www.mdpi.com/2079-9292/13/6/1080hierarchical planningquadratic programmingconstraint samplingtrajectory planning
spellingShingle Yu Bai
Pengpeng Li
Zhipeng Cui
Peng Yang
Weihua Li
A Hierarchical Trajectory Planning Algorithm for Automated Guided Vehicles in Construction Sites
Electronics
hierarchical planning
quadratic programming
constraint sampling
trajectory planning
title A Hierarchical Trajectory Planning Algorithm for Automated Guided Vehicles in Construction Sites
title_full A Hierarchical Trajectory Planning Algorithm for Automated Guided Vehicles in Construction Sites
title_fullStr A Hierarchical Trajectory Planning Algorithm for Automated Guided Vehicles in Construction Sites
title_full_unstemmed A Hierarchical Trajectory Planning Algorithm for Automated Guided Vehicles in Construction Sites
title_short A Hierarchical Trajectory Planning Algorithm for Automated Guided Vehicles in Construction Sites
title_sort hierarchical trajectory planning algorithm for automated guided vehicles in construction sites
topic hierarchical planning
quadratic programming
constraint sampling
trajectory planning
url https://www.mdpi.com/2079-9292/13/6/1080
work_keys_str_mv AT yubai ahierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites
AT pengpengli ahierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites
AT zhipengcui ahierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites
AT pengyang ahierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites
AT weihuali ahierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites
AT yubai hierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites
AT pengpengli hierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites
AT zhipengcui hierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites
AT pengyang hierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites
AT weihuali hierarchicaltrajectoryplanningalgorithmforautomatedguidedvehiclesinconstructionsites