Abstract
Automated valet-parking trajectory planning has been widely studied in structured environments, whereas its counterpart in unstructured environments remains insufficiently explored. The working face of an open-pit mine is a typical unstructured production environment, where autonomous mining trucks (AMTs) must perform collision-free and kinematically feasible maneuvers under irregular boundaries, locally confined passages, large vehicle footprints, and strict terminal pose requirements. To address this problem, we introduce an adaptive bounded Hybrid A* planner for AMT maneuver planning at mining working faces. The proposed planner integrates local-geometry-aware top-K motion primitive scheduling, adaptive rollout-length assignment, progress-reward-based dual-cost correction, and bounded continuation after the first feasible Reeds–Shepp closure. By ranking and filtering motion primitives according to obstacle clearance, maneuver margin, goal distance, and heading alignment, the planner reduces ineffective successor generation during search. By adapting rollout lengths to local spatial constraints and primitive curvature, it improves the consistency between expansion scale and environmental structure. By retaining the first feasible Reeds–Shepp connection as an initial upper bound and continuing bounded refinement, it improves the final returned path beyond the first feasible solution. Comparative studies demonstrate that, relative to the conventional Hybrid A* baseline, the proposed planner reduces the average final planning time, generated nodes, and final path cost by 54.73%, 74.10%, and 12.76%, respectively, in the abstract mine-like scenarios. In the real-map-derived mining working-face scenarios, the corresponding reductions are 25.12%, 37.98%, and 7.15%, respectively. These results indicate that the proposed method reduces search redundancy while improving the efficiency–quality trade-off in confined and geometrically irregular working-face environments.
Keywords: autonomous mining trucks, adaptive expansion, Hybrid A*, bounded continued search
1. Introduction
Automated valet-parking trajectory planning has been extensively studied in structured environments, where parking slots, driving boundaries, and terminal poses are usually well defined [1,2]. In contrast, trajectory planning in unstructured environments usually lacks reliable reference lines, encounters irregular obstacles, and requires mixed forward/backward maneuvers [3]. The working face of an open-pit mine is a typical unstructured production environment [4,5,6]. In this area, autonomous mining trucks (AMTs) must complete loading, unloading, docking, queuing, and short-distance maneuvering tasks under irregular boundaries, large vehicle footprints, wide turning radii, and strict terminal pose requirements, as depicted in Figure 1.
Figure 1.

Typical unstructured scenario of the open-pit mine working face.
Search-based planners with motion primitives are widely used for low-speed nonholonomic maneuver planning. Hybrid A* is a representative method because it combines graph search with continuous vehicle-state propagation and can generate kinematically feasible paths for car-like systems [7]. Reeds–Shepp (RS) curves are often used as analytical connections to accelerate terminal pose reaching [8]. These properties make Hybrid A* a suitable baseline for AMT path planning at open-pit mine working faces.
Recent studies have improved narrow-space motion planning through intermediate-point-guided Hybrid A* search, richer terminal-set or target-tree construction, multi-resolution motion-primitive sampling, and optimization-based path refinement [9,10,11]. These methods can reduce search effort, enlarge terminal reachability, or improve path quality in constrained parking environments. However, most of them are developed for passenger-vehicle-scale parking tasks and either rely on structured parking geometry, externally generated guidance, or subsequent numerical optimization. Mining-oriented studies have considered loading/dumping and other operation-specific trajectory-planning tasks [12,13], but the coexistence of large vehicle footprints, irregular working-face boundaries, local bottlenecks, heterogeneous free-space scales, and mixed forward–reverse maneuvering remains insufficiently addressed. This gap motivates an adaptive search strategy that directly modifies the expansion process of Hybrid A* according to local working-face geometry.
However, directly applying conventional Hybrid A* to AMT working face scenarios still has three limitations. First, fixed rollout lengths cannot adapt to the coexistence of open regions and locally narrow passages. Short rollouts cause redundant expansion in open areas, whereas long rollouts may lead to collision or expansion deadlock in confined spaces. Second, exhaustive primitive expansion evaluates many low-value candidates at each node, increasing collision-checking cost for AMT with large swept areas. Third, early termination after the first feasible RS closure may return a feasible but high-cost path with unnecessary reversing, gear switching, or steering correction.
To address these limitations, this paper proposes an adaptive bounded Hybrid A* planner for AMT path planning at open-pit mine working faces. The proposed planner uses local geometric descriptors, including obstacle clearance, directional maneuver margin, goal distance, and heading alignment, to rank and filter a fixed primitive pool through top-K motion primitive scheduling. It further assigns adaptive rollout lengths according to local obstacle proximity, maneuver margin, and primitive curvature. A progress-reward-based dual-cost correction is introduced to reduce the cost-comparison bias caused by variable-length rollout. Finally, the first feasible RS-connected path is treated as an initial upper-bound candidate, and bounded continuation is performed to search for lower-cost feasible paths.
The main contributions of this paper are summarized as follows:
A local-geometry-aware top-K motion primitive scheduling strategy is proposed to reduce ineffective successor generation in confined and irregular AMT working face scenarios.
An adaptive rollout-length assignment mechanism is developed to match the expansion scale with local spatial conditions and primitive curvature.
A progress-reward-based dual-cost correction is introduced to separate true path evaluation from search ordering under variable-length rollout.
A bounded continuation strategy after the first feasible RS closure is proposed to refine the final returned path beyond the first feasible solution.
Comparative experiments in abstract mine-like scenarios and real-map-derived mining working-face scenarios validate the effectiveness of the proposed planner in reducing search redundancy, improving computational efficiency, and enhancing final path quality.
The remainder of this paper is organized as follows. Section 2 reviews related work. Section 3 formulates the AMT path planning problem. Section 4 presents the proposed planner. Section 5 describes the experimental setup and discusses the experimental results. Section 6 concludes the paper.
2. Related Work
Trajectory planning methods for low-speed maneuvering in unstructured environments can be broadly divided into geometry-based planners, sampling-based planners, optimization-based planners, and learning-based planners [14,15,16]. Geometry-based planners generate paths using predefined geometric primitives according to terminal pose, vehicle size, and minimum turning radius. They are computationally efficient and effective in standardized parallel parking, reverse parking, and angle parking scenarios [9,17,18]. However, their applicability is limited in open-pit mine working faces because the boundaries, obstacles, and terminal approach regions are usually irregular rather than standardized. Optimization-based motion-planning and control methods formulate kinematic or dynamic behavior, actuation limits, positioning or terminal requirements, and collision-avoidance constraints within optimal-control or numerical-optimization frameworks [19,20,21,22]. These methods can handle precise obstacle constraints, but the resulting problems are often nonlinear and non-convex, especially when irregular obstacles and large vehicle footprints are considered. Learning-based planners have also been used to generate parking or maneuvering trajectories through supervised learning, reinforcement learning, or hybrid learning-control frameworks [23,24,25]. Although learning-based methods can provide stable inference time, their generalization ability in narrow, cluttered, and safety-critical unstructured environments still depends heavily on the diversity and fidelity of training scenarios.
Sampling-based planners are more directly related to this work. They can be divided into control-space sampling and state-space sampling methods. Control-space sampling methods, such as Hybrid A*, expand a trajectory tree by rolling out fixed motion primitives under vehicle kinematic constraints [7]. Deterministic primitive sampling can also pre-generate a connectivity graph under a given spatial and angular resolution, after which a feasible path is obtained by graph search [26]. These methods naturally incorporate nonholonomic constraints and are suitable for AMT, whose large dimensions, wide turning radii, and restricted reverse maneuvers must be explicitly considered. However, conventional control-space sampling does not directly incorporate environmental information into the primitive sampling process. Its efficiency and success rate are strongly tied to the primitive resolution: dense primitives improve feasibility but increase solution time, whereas sparse primitives reduce computation but may miss feasible maneuvers in narrow passages [27,28]. State-space sampling methods, including RRT-based variants, can use environmental information more flexibly and can be probabilistically complete [29,30,31,32,33]. Nevertheless, narrow spaces remain a bottleneck because random samples have a low probability of connecting to the existing trajectory tree without collision.
Several studies have attempted to improve trajectory planning in narrow or unstructured spaces. For standardized parking tasks, early geometry-based methods focused on retrieving feasible parallel-parking paths in extremely limited parking spaces by exploiting predefined path patterns, minimum turning-radius constraints, and terminal-pose geometry [34,35]. Although these methods are efficient, their reliance on standardized parking geometry limits their applicability when obstacle shapes and free-space boundaries become irregular. To improve applicability in narrow environments, optimization-based path planning methods have been proposed to adjust path shapes under vehicle kinematic and terminal constraints [36]. More recent studies further improve terminal reliability by transforming the parking target or enlarging the reachable terminal set. For example, mirroring-based parking target construction converts bidirectional parking into a more reliable planning problem and improves completion efficiency in constrained parking scenarios [37]. Target-set and target-tree methods also replace a single terminal pose with a set of backward parking paths or continuous-curvature target branches, allowing sampling-based planners to connect the initial state to a richer terminal structure [10,38]. These methods improve narrow-space reachability, but they are still mainly designed for passenger-car parking rather than AMT maneuver planning at open-pit mine working faces.
In addition to target-structure design, researchers have improved the front-end search process itself. Multi-resolution motion-primitive sampling has been introduced to alleviate redundant expansion in non-convex feasible spaces, allowing the planner to discover farther and more valuable nodes within a single expansion process [11]. Replanning and stitching strategies have also been studied to handle sudden environmental changes during automated parking, where an updated local trajectory is generated by connecting the current vehicle state to the remaining planned trajectory [16]. Learning-based methods provide another direction. Graph neural networks, reinforcement learning, and imitation learning have been used to generate initial trajectories, hybrid policies, or end-to-end parking paths [39,40,41,42]. These methods can reduce online computation or stabilize inference time, but their robustness in narrow and cluttered environments depends strongly on the diversity of training data and the coverage of difficult homotopy classes. For mining-related applications, trajectory planning for autonomous trucks has been studied in open-pit mine transport sections, loading/dumping scenarios, and mining-site loading tasks [12,13,43]. These studies confirm the importance of vehicle kinematics, terminal-pose accuracy, and operation-specific maneuver quality. However, existing methods still do not sufficiently address AMT path planning at the open-pit mine working face, where irregular boundaries, local bottlenecks, mixed forward/backward maneuvers, and large swept areas coexist.
The above studies reveal three limitations that motivate this work. First, fixed-resolution primitive expansion is difficult to reconcile with the spatial heterogeneity of a working face. In open regions, short fixed rollouts produce redundant nodes; in narrow regions, long fixed rollouts may exceed the geometric width of the navigable space and cause expansion deadlock. Second, exhaustive primitive expansion evaluates many low-value candidates at every node, which increases collision-checking cost for AMT with large swept areas. Third, conventional Hybrid A* often terminates once a feasible Reeds–Shepp connection to the goal is found, although the first feasible analytical connection may still contain unnecessary reversing, gear switching, or steering correction. To address these issues, this paper proposes an adaptive bounded Hybrid A* planner that introduces local-geometry-aware top-K motion primitive scheduling, adaptive rollout-length assignment, progress-reward-based dual-cost correction, and bounded continuation after the first feasible Reeds–Shepp closure. Unlike previous methods that only refine sampling resolution or improve terminal connection, the proposed planner reshapes the search process according to local geometric descriptors and separates first-solution discovery from final-path refinement for AMT planning at open-pit mine working faces.
3. Framework Overview
This section formulates the AMT path planning problem at open-pit mine working faces and presents the overall framework of the proposed adaptive bounded Hybrid A* planner. The proposed method assumes a known static working face map and focuses on low-speed spatial path generation in the Cartesian frame. The goal is to generate a collision-free and kinematically feasible path that satisfies the terminal pose requirement while reducing inefficient search expansion and unnecessary maneuvering cost.
3.1. Problem Formulation
Given a working face map , an initial pose , and a target pose , the planning task is to generate a feasible path for an AMT. Since AMT maneuvering at the working face is usually performed at low speed, the vehicle is modeled by a kinematic bicycle model. The vehicle state and control input are defined as
| (1) |
where x and y denote the position of the rear-axle reference point in the global Cartesian frame, denotes the heading angle, v is the longitudinal velocity, and is the front-wheel steering angle. The low-speed kinematic model is written as
| (2) |
where is the wheelbase. The steering angle satisfies . The AMT body is represented by a rectangular envelope attached to the rear-axle reference point, as shown in Figure 2.
Figure 2.

AMT kinematic model and geometric parameters.
Let denote the obstacle region in the working face map, and let denote the occupied region of the AMT at state . A path is defined as
| (3) |
The path planning problem is formulated as
| (4) |
where is the terminal tolerance region around the target pose, and is the sequence of motion primitives used to generate the path.
The path cost evaluates the maneuver quality of the AMT. Considering the operational requirements at the working face, the cost function penalizes path length, reverse motion, gear switching, steering magnitude, and steering variation:
| (5) |
where is the traveled length of the k-th transition, denotes the driving direction, and is the indicator function. The coefficients , , , , and are non-negative weights.
To support local-geometry-aware expansion, a compact set of local geometric descriptors is extracted at each search node. The nearest-obstacle distance is defined as
| (6) |
where is the vehicle reference position. In the local vehicle frame, probing rays are cast in the forward, backward, left, and right directions to obtain the directional clearances , , , and , as illustrated in Figure 3. The lateral free width is
| (7) |
The forward and backward maneuver margins are defined as
| (8) |
| (9) |
where W is the AMT width. The goal distance and heading error are defined as
| (10) |
| (11) |
Accordingly, the local descriptor set is written as
| (12) |
Figure 3.

Local geometric descriptors extracted around the current AMT state.
The descriptor set provides the geometric basis for primitive scheduling and adaptive rollout-length assignment in the proposed planner. These ray-based clearances are used only for primitive scheduling and rollout-length assignment; collision feasibility is still verified independently using the rectangular AMT footprint along each primitive rollout.
3.2. Algorithm Framework
The proposed planner is built upon the Hybrid A* search framework but modifies the primitive expansion, cost update, and termination logic. Figure 4 shows the overall architecture of the proposed adaptive bounded Hybrid A* planner. The inputs include the working face map, AMT parameters, initial pose, target pose, obstacle query structure, and search-state containers. The output is the final returned AMT path for downstream execution.
Figure 4.

Overall framework of the proposed adaptive bounded Hybrid A* planner for AMT path planning at open-pit mine working faces.
The planner first initializes the Hybrid A* search state, including the indexed search space, open set, closed set, and node attributes. At each iteration, the planner selects the current node from the open set according to the search priority. Then, the local descriptor set is extracted from the current AMT state. Based on these descriptors, the fixed motion primitive pool is ranked and filtered through a local-geometry-aware top-K scheduling strategy. This step reduces ineffective successor generation and lowers the effective branching factor.
For each selected primitive, the planner assigns an adaptive rollout length according to local obstacle proximity, direction-dependent maneuver margin, and primitive curvature. The primitive is then rolled out under a fixed integration step, and the generated candidate node is checked using the AMT rectangular envelope. If the candidate node is valid, the planner updates two costs: the true path cost and the search-ordering cost. The true path cost evaluates the final returned path, whereas the search-ordering cost introduces a progress reward to reduce the local comparison bias caused by variable-length rollout.
In parallel with primitive expansion, the planner attempts Reeds–Shepp (RS) analytical closure from selected nodes to the target pose. Unlike the baseline Hybrid A*, the proposed planner does not terminate immediately after the first feasible RS closure. Instead, the first feasible RS-connected path is recorded as an initial upper-bound candidate. The planner then continues bounded search and updates the upper-bound path whenever a lower-cost feasible candidate is found. The search terminates when the remaining nodes in the open set do not show sufficient potential to improve the current upper bound.
The framework therefore consists of four coupled mechanisms: local-geometry-aware primitive scheduling, adaptive rollout-length assignment, progress-reward-based dual-cost update, and bounded continuation after the first feasible RS closure. These mechanisms jointly reshape the Hybrid A* search process for AMT path planning in confined and geometrically irregular working face environments.
4. Proposed Adaptive Bounded Hybrid A* Planner
This section presents the core modules of the proposed adaptive bounded Hybrid A* planner. The planner is built upon a conventional Hybrid A* search structure, but modifies its primitive expansion, rollout scale, cost update, and termination strategy. The objective is to reduce redundant search expansion while improving the final returned path for AMT maneuvering at open-pit mine working faces.
4.1. Local-Geometry-Aware Top-K Motion Primitive Scheduling
In the baseline Hybrid A* planner, a fixed motion primitive pool is expanded at every search node. Each primitive is defined by a steering angle and a driving direction. Let the primitive pool be
| (13) |
where is the steering angle and denotes forward or reverse motion. In the baseline planner, all primitives in are rolled out uniformly. This strategy is simple, but inefficient in confined working face environments because many primitives are locally irrelevant or immediately lead to collision.
Different from the baseline expansion shown in Figure 5, the proposed planner performs local-geometry-aware primitive scheduling. The key idea is to rank the fixed primitive pool according to the local descriptor set defined in Section 3. The proposed method does not generate new control primitives online; instead, it adaptively schedules and filters the existing primitive pool.
Figure 5.

Baseline Hybrid A* primitive expansion with a fixed rollout length.
For a primitive u at node , the score is defined as
| (14) |
where is the directional preference term, is the goal-alignment term, is the clearance-constraint term, and penalizes unnecessary large steering. A smaller score indicates a higher scheduling priority.
The directional preference term is constructed according to the forward and backward maneuver margins:
| (15) |
This term favors the direction with larger maneuver margin. For example, if the forward margin is larger than the backward margin, forward primitives receive better scores.
The goal-alignment term is defined as
| (16) |
When the AMT heading is already close to the target heading, this term prioritizes small-steering forward primitives and avoids unnecessary aggressive maneuvers.
The clearance-constraint term suppresses primitives that steer toward insufficient lateral clearance:
| (17) |
Thus, left-turn primitives are penalized when the left clearance is insufficient, and right-turn primitives are penalized when the right clearance is insufficient.
The coefficients , , , and are user-defined positive scaling constants. Specifically, and control the magnitude of the forward- and reverse-direction preferences, respectively; determines the strength of the small-steering forward preference when the AMT heading is close to the target heading; and controls the penalty applied to primitives steering toward insufficient lateral clearance. Their numerical values are reported later in the parameter sensitivity analysis in Section 5.4.
After all primitives are scored, they are sorted in ascending order. The top-K candidate primitive set is then obtained as
| (18) |
To avoid collapsing the selected set into a single driving direction, a direction-diversity compensation mechanism is used. If contains only forward primitives or only reverse primitives, the best-scored primitive from the opposite direction is added to the candidate set. This preserves basic maneuver diversity while reducing the effective branching factor.
4.2. Adaptive Rollout-Length Assignment
The baseline Hybrid A* planner uses a fixed rollout length for all motion primitives. Such a fixed expansion scale is not suitable for working face environments, where open areas and narrow regions may coexist in the same task. A short fixed rollout increases redundant node generation in open regions, whereas a long fixed rollout may cause collision or expansion deadlock in confined regions.
To address this scale mismatch, the proposed planner assigns an adaptive rollout length to each selected primitive according to the local environment and primitive curvature. The curvature of primitive u is defined as
| (19) |
Since the available space for forward and reverse motions may be different, the direction-dependent maneuver margin is defined as
| (20) |
The adaptive rollout length is then given by
| (21) |
where and are the minimum and maximum rollout lengths, , , and are weighting coefficients, and is a small positive constant.
As shown in Figure 6, the rollout length becomes longer in open areas and shorter near constrained regions. The term reflects general obstacle proximity, reflects direction-dependent maneuverability, and suppresses overly long high-curvature expansion. Therefore, the proposed rollout strategy reduces node density in open regions while maintaining finer maneuver resolution in confined areas.
Figure 6.

Illustration of node generation under different rollout-length strategies. (a) Fixed rollout length produces dense expansion nodes. (b) Adaptive rollout length reduces node density while preserving feasible progress.
It should be emphasized that the proposed method does not change the integration step used in primitive rollout. Let denote the fixed integration step. The number of integration steps for primitive u is
| (22) |
Therefore, the proposed strategy is a variable-length primitive expansion method under a fixed integration step, rather than a variable integration-step method. This design preserves collision-checking resolution while allowing the expansion scale to adapt to local spatial conditions.
4.3. Progress-Reward-Based Dual-Cost Update
Adaptive rollout length changes the cost-comparison basis among successor nodes. In the baseline Hybrid A* planner, all primitives have the same rollout length, so their incremental costs are compared on a similar spatial scale. Under variable-length rollout, however, short primitives may appear artificially cheaper simply because they travel a shorter distance. This may cause the planner to prefer local small-step maneuvers rather than primitives that make effective progress toward the target.
To reduce this bias, the proposed planner separates the true path cost from the search-ordering cost. The true path cost evaluates the physical cost of the final returned path. For a child node n generated from its parent node , the true incremental cost is
| (23) |
The true path cost is recursively updated as
| (24) |
To guide the search ordering under variable-length rollout, a progress reward is introduced. The progress made by node n is defined as
| (25) |
To avoid excessive reward caused by long rollouts, the reward is clipped:
| (26) |
Although is already indirectly bounded by the maximum rollout length , the clipping is retained as a saturation mechanism for search ordering rather than for mathematical boundedness; it prevents long rollouts from receiving disproportionate progress rewards while leaving the true path cost unchanged.
The search-ordering cost is then defined as
| (27) |
where is the progress-reward weight. The node priority used in the open set is
| (28) |
where denotes the heuristic cost.
The progress reward is only used for node ordering and is not included in the final path cost. Thus, the final returned path is still evaluated by , while improves the fairness of local comparison under variable-length expansion.
4.4. Bounded Continuation After the First Feasible RS Closure
In the baseline Hybrid A* planner, the search usually terminates once a collision-free Reeds–Shepp (RS) connection from the current node to the target pose is found. This early-termination strategy can quickly produce a feasible path, but the first feasible RS-connected path may not be the best complete path. In confined working-face scenarios, early RS closure may be reached from a node whose preceding path contains unnecessary reversing, gear switching, or steering correction.
To address this issue, the proposed planner treats the first feasible RS closure as an initial upper-bound candidate rather than an immediate final result. Suppose that node n can be connected to the target pose through a collision-free RS curve. The candidate complete-path cost is
| (29) |
where is the true cost of the RS connection from node n to the target pose. If no feasible complete path has been recorded, the upper bound is initialized as
| (30) |
The corresponding complete path is stored as the current best path .
Unlike the baseline method, the proposed planner continues the search after the first feasible RS closure. For any subsequent node , if its RS-connected candidate path satisfies
| (31) |
then the upper bound and the best path are updated:
| (32) |
By continuing the search under the current upper bound, the planner may find a lower-cost complete path. The bounded continuation process terminates when the best-ranked node in the open set no longer has sufficient potential to improve the current upper bound:
| (33) |
where is a continuation tolerance. Because contains the progress-reward term, Equation (33) is used as a heuristic stopping criterion rather than as an optimality-preserving lower-bound test.
4.5. Algorithm Procedure
The complete procedure of the proposed adaptive bounded Hybrid A* planner is summarized in Algorithm 1.
| Algorithm 1 Adaptive Bounded Hybrid A* Planner |
|
Require: Working face map , start pose , target pose , AMT parameters, primitive pool Ensure: Final returned path
|
5. Experimental Evaluation and Discussion
This section evaluates the proposed adaptive bounded Hybrid A* planner from four aspects: mechanism-level effectiveness, parameter sensitivity, planning performance in abstract mine-like scenarios, and planning performance in real-map-derived mining working-face scenarios. Both first-solution and final-solution results are reported to distinguish initial feasible-path discovery from subsequent refinement.
5.1. Experimental Setup
All experiments are conducted in static unstructured environments represented by occupancy-grid maps. The AMT is modeled by the kinematic bicycle model defined in Section 3.1, and collision checking is performed using the rectangular vehicle envelope.
All planners were implemented in Python 3.14 and executed on the same computer equipped with an AMD Ryzen 5 5600H processor (Advanced Micro Devices, Inc., Santa Clara, CA, USA) at 3.30 GHz and 16 GB of RAM. The search maps use a Cartesian occupancy-grid resolution of 2.0 m and a heading discretization of 15°. Obstacle-boundary points are sampled at an approximate spatial interval of 0.4 m. The common primitive propagation/motion step used in the reported comparisons is 1.0 m. The maximum distance used for local clearance probing is 20 m.
The baseline uses a conventional Hybrid A* search front end with a fixed rollout length, full primitive-pool expansion, and conventional path-cost ordering. The proposed planner uses the same vehicle model, primitive pool, map representation, heuristic configuration, collision-checking resolution, and start–target poses, but introduces local-geometry-aware top-K primitive scheduling, adaptive rollout-length assignment, and progress-reward-based dual-cost ordering.
To provide an external comparison with a recent improved Hybrid A* strategy, an improved Hybrid A* planner (IHA*) is additionally implemented for the abstract mine-like scenarios. The implemented IHA* follows the first-stage planning framework in [9]: a two-dimensional A* search is first used to obtain a coarse collision-free guidance path, intermediate poses are extracted according to the heading variation of the coarse path, and conventional Hybrid A* is subsequently used to connect adjacent intermediate poses. Only the path-search stage is considered in this study; the subsequent trajectory-optimization stage of the original method is not included, because the present work focuses on spatial path planning rather than trajectory optimization.
For fairness, IHA* uses the same AMT geometry, occupancy-grid maps, start–target poses, steering limit, Reeds–Shepp turning-radius constraint, and rectangular-footprint collision checker as the baseline and proposed planners. The complete path returned by IHA* is also re-evaluated using the common true path-cost function defined in Equation (5). The proposed adaptive primitive scheduling, adaptive rollout, dual-cost ordering, and bounded continuation mechanisms are not incorporated into IHA*.
For a fair internal comparison, the baseline and proposed search front ends use the same multi-RS continuation procedure. Throughout Section 5, the term baseline therefore refers to conventional Hybrid A* combined with this common continuation procedure.
The tested scenarios include three groups. The first group consists of simplified validation maps used to isolate the effect of each proposed module. The second group consists of abstract mine-like scenarios that reproduce typical constrained maneuvering patterns, including terminal docking, bottleneck traversal, diagonal obstacle avoidance, L-shaped transfer, and converging-corridor alignment. The third group consists of real-map-derived mining working-face scenarios, which contain irregular obstacle boundaries and working-face-like spatial structures. These scenarios are used to examine whether the proposed planner remains effective beyond simplified synthetic maps.
Table 1 lists the main AMT model and planner parameters. The values should be kept identical for the baseline and the proposed planner unless otherwise stated. This setting ensures that the performance difference comes from the proposed search strategy rather than from changes in vehicle geometry, map resolution, or collision-checking resolution.
Table 1.
AMT model and planner parameters used in the experiments.
| Parameter | Value | Meaning |
|---|---|---|
| 7.6 m | Front extent measured from the rear-axle reference point | |
| 3.0 m | Rear extent measured from the rear-axle reference point | |
| W | 4.77 m | AMT width |
| 5.5 m | Wheelbase | |
| 0.43 rad | Maximum steering angle | |
| 1.0 m | Primitive integration step | |
| 2.0 m | Minimum rollout length | |
| 8.0 m | Maximum rollout length | |
| K | 25 | Number of selected primitives |
5.2. Evaluation Metrics
The evaluation metrics are divided into first-solution metrics and final-solution metrics. For both the baseline and proposed planners, the first-solution metrics are recorded when the first collision-free RS-connected complete path is obtained. The final-solution metrics are recorded when the common multi-RS continuation stage terminates. Thus, the first-solution metrics characterize initial feasible-path discovery, whereas the final-solution metrics characterize the best incumbent path returned after evaluating multiple feasible RS connections.
The planning time measures computational efficiency. The number of expanded nodes reflects the depth and breadth of the actual search process. The number of generated nodes measures the total successor-generation burden and is closely related to collision-checking cost. The number of RS attempts reflects the frequency of analytical closure trials. The path cost is calculated using the true cost function defined in Section 3 and includes path length, reverse-motion penalty, gear-switching penalty, steering penalty, and steering-change penalty. The evaluation metrics are summarized in Table 2.
Table 2.
Evaluation metrics used in the experiments.
| Metric | Description |
|---|---|
| First-solution time | Time to obtain the first feasible complete path |
| First expanded nodes | Expanded nodes before the first feasible solution |
| First generated nodes | Generated nodes before the first feasible solution |
| First RS attempts | RS closure attempts before the first feasible solution |
| First-solution cost | True cost of the first feasible complete path |
| Final planning time | Total planning time before termination |
| Final expanded nodes | Total expanded nodes before termination |
| Final generated nodes | Total generated nodes before termination |
| Final RS attempts | Total RS closure attempts before termination |
| Final path cost | True cost of the final returned path |
This metric design is important for the proposed method. A planner may obtain a feasible path quickly but return a higher-cost trajectory if it terminates too early. Therefore, first-solution performance and final-returned-path performance are analyzed separately.
For the additional comparison with IHA*, only planning success, planning time, and common path cost are compared. For the baseline and proposed planners, the first complete feasible solution is used, whereas for IHA*, the complete path returned after the intermediate-point-guided search is used. Expanded nodes, generated nodes, and RS attempts are not used for the three-planner comparison because IHA* combines a two-dimensional A* guidance stage with multiple segmented Hybrid A* searches, and therefore its node-count statistics are not directly equivalent to those of the single-stage Hybrid A* search front ends.
5.3. Mechanism-Level Validation
This subsection validates the three main behavioral changes introduced by the proposed planner: adaptive rollout-length assignment, top-K primitive scheduling, and bounded continuation after the first feasible RS closure. These experiments are performed on simplified validation maps to make the effect of each module visually interpretable. The dual-cost update is not treated as an independent mechanism-level switch because it is introduced specifically to compensate for the cost-comparison bias caused by variable-length rollout, as explained in Section 4.3.
5.3.1. Effect of Adaptive Rollout-Length Assignment
Figure 7 compares the baseline Hybrid A* planner and the planner with adaptive rollout-length assignment. Under fixed rollout length, the baseline planner generates dense and redundant search branches even in locally open regions. After adaptive rollout is introduced, the planner uses longer rollouts in open regions and shorter rollouts near constrained areas. This result shows that adaptive rollout reduces the mismatch between a fixed primitive length and local free-space geometry.
Figure 7.

Mechanism-level validation of adaptive rollout-length assignment: (a) baseline Hybrid A* with fixed rollout length; (b) Hybrid A* with adaptive rollout-length assignment. Black squares denote obstacles in both panels.
The main effect of adaptive rollout is not only acceleration. It changes the spatial scale of expansion according to local geometry. In open regions, the planner reduces node density by using longer rollouts. In narrow regions, the planner preserves maneuver resolution by shortening high-risk expansions. However, variable-length rollout also changes the local cost-comparison basis, which motivates the dual-cost update introduced in Section 4.
5.3.2. Effect of Top-K Primitive Scheduling
Figure 8 compares the search behavior with and without top-K primitive scheduling. Without top-K filtering, the planner still evaluates many primitives that are unlikely to contribute to feasible or efficient maneuvers under the current local geometry. After top-K scheduling is enabled, the search tree becomes more concentrated, and redundant successor generation is reduced.
Figure 8.

Mechanism-level validation of local-geometry-aware top-K primitive scheduling: (a) adaptive Hybrid A* with top-K primitive scheduling; (b) adaptive Hybrid A* without top-K filtering. Black squares denote obstacles in both panels.
The role of top-K scheduling is to reduce the effective branching factor. It should not be interpreted as a direct path-quality improvement mechanism. Its benefit comes from suppressing locally irrelevant primitive rollouts and reducing unnecessary collision checks. Since top-K scheduling is heuristic, the proposed planner preserves direction diversity to avoid selecting only forward or only reverse primitives.
5.3.3. Effect of Bounded Continuation After First RS Closure
Figure 9 illustrates the role of bounded continuation after the first feasible RS closure. In the first-solution evaluation mode, the first collision-free RS-connected path is recorded immediately when it is found. During the subsequent multi-RS continuation stage, this first feasible path is retained as the initial incumbent solution, while additional feasible RS connections are evaluated. If a later RS-connected candidate has a lower true cost, the incumbent path is updated. The same first-solution recording and multi-RS continuation procedure is applied to both the baseline and proposed search front ends.
Figure 9.

Mechanism-level validation of bounded continuation after the first feasible RS closure.
This example shows that the first feasible RS-connected path is not necessarily the best complete path. In confined working face environments, early RS closure may occur at a node whose preceding path contains unnecessary reversing or steering correction. Bounded continuation changes the role of RS closure from an immediate stopping condition to an upper-bound update mechanism.
5.4. Parameter Sensitivity Analysis
This subsection analyzes the sensitivity of the proposed planner to the adaptive rollout coefficients and the top-K parameter. The purpose is not to identify a single-metric optimum, but to select a stable default setting that balances search efficiency and final path quality.
In addition to the parameters varied below, Table 3 summarizes the main fixed coefficients and activation thresholds used in the proposed planner.
Table 3.
Main coefficients and thresholds used in the proposed planner.
| Parameter | Value | Role |
|---|---|---|
| 1.0 | Directional-preference weight | |
| 1.0 | Goal-heading-alignment weight | |
| 1.0 | Lateral-clearance weight | |
| 0.2 | Small-steering preference weight | |
| 0.8 | Forward-direction preference gain | |
| 1.6 | Reverse-direction preference gain | |
| 1.2 | Heading-alignment gain | |
| Lateral-clearance penalty gain | ||
| 3.0 m | Lateral-clearance activation threshold | |
| 12° | Heading-alignment threshold | |
| 8° | Small-steering threshold | |
| K | 25 | Number of retained motion primitives |
| 0.26 | Obstacle-distance contribution to rollout length | |
| 0.14 | Maneuver-margin contribution to rollout length | |
| 0.04 | Curvature contribution to rollout length | |
| Curvature regularization constant | ||
| 1.0 | Progress-reward weight | |
| 3.0 m | Progress-reward saturation limit | |
| 1.0 | Path-length cost weight | |
| 40.0 | Reverse-motion cost weight | |
| 500.0 | Gear-switching cost weight | |
| 15.0 | Steering-magnitude cost weight | |
| 20.0 | Steering-change cost weight |
The parameters in Table 3 are determined in three ways. The rollout coefficients and and the retained primitive number K are selected according to the sensitivity analyses in this section. Vehicle-scale activation thresholds and the remaining scheduling and cost coefficients are fixed through preliminary calibration and are kept unchanged for all reported scenarios. The small constant is used only for numerical regularization.
The adaptive rollout length in Section 4 depends mainly on , , and . The coefficient controls the influence of nearest-obstacle distance, controls the influence of direction-dependent maneuver margin, and regularizes the effect of primitive curvature. Since and directly determine how rollout length responds to local geometry, the sensitivity analysis focuses on and , while is fixed at its nominal value.
Because planning time, generated nodes, expanded nodes, and final cost differ substantially across scenario cases, raw metrics are not directly averaged. Instead, case-wise normalized metrics are used. For a scenario–case pair c and a tested parameter configuration p, let denote a metric value. The case-specific minimum is
| (34) |
The normalized value is
| (35) |
The final normalized result is averaged across all cases:
| (36) |
where is the set of scenario–case pairs and is the set of parameter configurations. A normalized value larger than one indicates degradation relative to the best configuration within the same case.
Figure 10 shows the normalized heatmaps for planning time, generated nodes, and final path cost with respect to and . The heatmaps for planning time and generated nodes show similar patterns, indicating that runtime is mainly affected by search-tree size. Increasing from a small value to a moderate value generally reduces generated nodes because longer rollouts are used in open regions. The effect of is more coupled: moderate values help exploit direction-dependent maneuver space, whereas excessive values may introduce local bias.
Figure 10.

Sensitivity heatmaps of and with respect to normalized planning time, normalized final path cost, and normalized generated nodes. (a) Heatmap of average planning time, (b) heatmap of average final cost, and (c) heatmap of average generated nodes.
The final path cost heatmap does not fully overlap with the minimum-time region. This result indicates that the most efficient parameter setting does not necessarily produce the lowest-cost path. Therefore, and should be selected as an efficiency–quality trade-off rather than as a single-metric optimum.
By jointly considering the three heatmaps, it can be concluded that the favorable combinations of and are not concentrated at a single isolated optimum, but rather distributed over a relatively stable low-value region. In the present experiments, a recommended parameter region can be approximately identified as , .
This region is selected by the green dotted box, as shown in Figure 10. This region simultaneously achieves low normalized planning time, low normalized generated nodes, and comparatively low normalized final cost. Since the goal of parameter selection is to determine a robust default setting rather than a single-metric extreme point, the final default configuration is selected near the center of this favorable region as , .
Figure 11 shows the effect of top-K on normalized planning time, final path cost, and generated nodes. The number of generated nodes increases as top-K increases because more primitives are retained at each node. The final path cost decreases rapidly when top-K increases from a very small value, but it gradually saturates after reaching a moderate range. This trend indicates that small top-K values may over-prune useful primitives, whereas overly large values mainly increase computation without substantial path-quality gain. In the present experiments, a favorable trade-off region can be identified approximately as top-K [20, 25].
Figure 11.

Sensitivity of top-K with respect to normalized planning time, normalized final path cost, and normalized generated nodes. The normalized generated nodes are plotted on the secondary vertical axis.
Within this interval, the normalized final cost has already dropped close to its plateau, while the normalized planning time and normalized generated nodes remain comparatively low. Therefore, the final default setting used in the subsequent experiments is chosen as top-K = 25.
This choice avoids the over-pruning effect observed at very small top-K values while also preventing the substantial search-scale inflation that occurs when top-K becomes too large.
Based on the sensitivity results, the default parameters are selected from a stable trade-off region rather than from an isolated optimum. This choice avoids over-aggressive rollout, over-pruning of primitives, and excessive search-tree inflation.
5.5. Results in Abstract Mine-like Scenarios
The proposed planner was first evaluated in five abstract mine-like scenarios, which represent typical AMT maneuvering patterns at working faces, including long-corridor terminal docking, bottleneck traversal, diagonal obstacle avoidance, L-shaped transfer, and converging-corridor alignment, as shown in Figure 12 and Figure 13. These scenarios are used both to evaluate the proposed local-geometry-aware expansion and bounded continuation mechanisms against the baseline Hybrid A* planner and to provide an external comparison with IHA*. Each scenario contains two start–goal cases, resulting in a total of ten planning tasks.
Figure 12.

Path comparison in abstract mine-like scenarios: (a) scene_1 case_1, long-corridor terminal docking; (b) scene_1 case_2, long-corridor terminal docking; (c) scene_2 case_1, bottleneck-constrained through-corridor planning; (d) scene_2 case_2, bottleneck-constrained through-corridor planning. No IHA* path is shown in (a) or (d) because IHA* did not obtain a complete feasible solution in these cases.
Figure 13.

Path comparison in abstract mine-like scenarios: (a) scene_3 case_1, diagonal traversal; (b) scene_3 case_2, diagonal traversal; (c) scene_4 case_1, L-shaped transfer; (d) scene_4 case_2, L-shaped transfer; (e) scene_5 case_1, converging-corridor multi-stage alignment; (f) scene_5 case_2, converging-corridor multi-stage alignment. No IHA* path is shown in (b) because IHA* did not obtain a complete feasible solution in this case.
Table 4 summarizes the average final-solution results in the five abstract mine-like scenarios. The reported final solutions are obtained after applying the same multi-RS continuation procedure to both the conventional and proposed search front ends. Compared with the baseline Hybrid A* planner, the proposed planner reduces the average final planning time from 20.72 s to 9.38 s, corresponding to a 54.73% reduction. The average number of expanded nodes decreases from 2080 to 1078, and the average number of RS attempts decreases from 104.0 to 53.9, both corresponding to a 48.17% reduction. The most significant improvement is observed in generated nodes, which decrease from 170,478 to 44,157, corresponding to a 74.10% reduction. This result confirms that local-geometry-aware top-K scheduling effectively reduces successor generation and collision-checking burden.
Table 4.
Average Final-Solution Results in Different Scenarios.
| Scene | Mode | Average Value | ||||
|---|---|---|---|---|---|---|
| Time (s) | Expanded | Generated | RS Attempts | Cost | ||
| scene_1 | baseline | 48.06 | 4620 | 378,758 | 231.0 | 1333.86 |
| scene_1 | proposed | 9.29 | 960 | 39,319 | 48.0 | 1043.23 |
| scene_2 | baseline | 36.93 | 3980 | 326,278 | 199.0 | 2318.47 |
| scene_2 | proposed | 22.25 | 2850 | 116,809 | 142.5 | 2215.83 |
| scene_3 | baseline | 9.28 | 900 | 73,718 | 45.0 | 1305.30 |
| scene_3 | proposed | 9.80 | 1030 | 42,189 | 51.5 | 968.86 |
| scene_4 | baseline | 6.98 | 700 | 57,318 | 35.0 | 1862.39 |
| scene_4 | proposed | 3.24 | 330 | 13,489 | 16.5 | 1849.67 |
| scene_5 | baseline | 2.33 | 200 | 16,318 | 10.0 | 2356.42 |
| scene_5 | proposed | 2.31 | 220 | 8979 | 11.0 | 1927.60 |
In terms of final path cost, the average cost decreases from 1835.29 to 1601.04, corresponding to a 12.76% reduction. The improvement is scenario-dependent. In scene_1, the proposed planner reduces final planning time by 80.67%, expanded nodes by 79.22%, generated nodes by 89.62%, RS attempts by 79.22%, and final cost by 21.79%. This indicates that the proposed expansion strategy is particularly effective when the baseline planner suffers from substantial redundant exploration. In scene_2, final planning time, generated nodes, and final cost are reduced by 39.75%, 64.20%, and 4.43%, respectively, showing that the method still improves efficiency in bottleneck-constrained planning, although the path-quality gain is more moderate.
Scene_3 provides a useful non-dominance case. The proposed planner reduces generated nodes by 42.77% and final cost by 25.77%, but final planning time increases by 5.60%, while expanded nodes and RS attempts increase by 14.44%. Scene_5 shows a similar partial trade-off: generated nodes and final cost decrease by 44.97% and 18.20%, respectively, but expanded nodes and RS attempts increase by 10.00%. These cases indicate that reducing successor generation does not always guarantee fewer expanded nodes or shorter runtime, because the remaining search branches may still require difficult collision checking or RS closure attempts.
Table 5 reports the corresponding first-solution results in the same abstract mine-like scenarios. These metrics are recorded when each search front end obtains its first collision-free RS-connected complete path, before the subsequent multi-RS continuation stage. Compared with the baseline planner, the proposed planner reduces average first-solution time from 10.22 s to 4.26 s, corresponding to a 58.30% reduction. The average first expanded nodes decrease from 966 to 456, and first RS attempts decrease from 48.3 to 22.8, both corresponding to a 52.80% reduction. The average first generated nodes decrease from 79,130 to 18,655, corresponding to a 76.42% reduction. These results indicate that the proposed planner can substantially accelerate the discovery of the first feasible complete path.
Table 5.
First-solution results in abstract mine-like scenarios.
| Scene | Mode | Average Value | ||||
|---|---|---|---|---|---|---|
| Time (s) | Expanded | Generated | RS Attempts | Cost | ||
| scene_1 | baseline | 42.45 | 4050 | 332,018 | 202.5 | 1364.89 |
| scene_1 | proposed | 5.60 | 520 | 21,279 | 26 | 1156.33 |
| scene_2 | baseline | 4.67 | 470 | 38,458 | 23.5 | 2528.85 |
| scene_2 | proposed | 10.19 | 1260 | 51,619 | 63 | 2419.09 |
| scene_3 | baseline | 1.95 | 160 | 13,038 | 8 | 1617.74 |
| scene_3 | proposed | 4.04 | 400 | 16,359 | 20 | 1847.64 |
| scene_4 | baseline | 1.55 | 130 | 10,578 | 6.5 | 1909.30 |
| scene_4 | proposed | 1.04 | 80 | 3239 | 4 | 2065.22 |
| scene_5 | baseline | 0.49 | 20 | 1558 | 1 | 2762.34 |
| scene_5 | proposed | 0.46 | 20 | 779 | 1 | 3135.06 |
The first-solution table reveals an important difference between feasibility discovery and final path refinement. In scene_1, the proposed planner reduces first-solution time by 86.81%, generated nodes by 93.59%, and first-solution cost by 15.28%, showing a clear improvement in both efficiency and first feasible path quality. However, in scene_2 and scene_3, the proposed planner requires more time and more expanded nodes to obtain the first feasible path. Specifically, first-solution time increases by 117.95% in scene_2 and 106.60% in scene_3, while first expanded nodes increase by 168.09% and 150.00%, respectively. Nevertheless, these two cases do not contradict the final-solution improvement because bounded continuation and subsequent RS candidate updates can still reduce the final returned cost.
The cost behavior is more revealing. Although the proposed planner reduces first-solution cost by 15.28% in scene_1 and 4.34% in scene_2, it increases first-solution cost by 14.21%, 8.17%, and 13.49% in scene_3, scene_4, and scene_5, respectively. As a result, the average first-solution cost increases by 4.32%. However, the average final path cost decreases by 12.76%. This contrast confirms that the proposed method should not be evaluated only by the first feasible path. The first feasible RS closure provides an initial upper-bound candidate, while the final returned path is improved through bounded continuation.
Comparison with IHA*
Using the common setup and evaluation protocol defined in Section 5.1 and Section 5.2, IHA* is compared with the baseline and proposed planners on the same ten start–goal tasks in the five abstract mine-like scenarios. All successful paths are evaluated using the common true path-cost function defined in Equation (5).
Table 6 summarizes the comparison. Both the baseline and proposed planners successfully solve all ten planning tasks, whereas IHA* succeeds in seven of the ten cases. IHA* fails to obtain a complete feasible path in scene_1 case_1, scene_2 case_2, and scene_3 case_2. These failures indicate that the intermediate-point decomposition based on a two-dimensional coarse path can become sensitive to the compatibility between the holonomic guidance path and the nonholonomic maneuver required by the large AMT.
Table 6.
Comparison of initial complete feasible-path planning performance among the baseline, IHA*, and proposed planners.
| Scene | Case | Baseline | IHA* | Proposed | ||||||
|---|---|---|---|---|---|---|---|---|---|---|
| Success | Time (s) | Cost | Success | Time (s) | Cost | Success | Time (s) | Cost | ||
| scene_1 | case_1 | Yes | 38.41 | 1451.23 | No | 29.56 | – | Yes | 4.13 | 1150.13 |
| scene_1 | case_2 | Yes | 46.50 | 1278.56 | Yes | 43.99 | 1795.86 | Yes | 7.07 | 1162.53 |
| scene_2 | case_1 | Yes | 5.90 | 2490.84 | Yes | 5.34 | 2775.76 | Yes | 7.07 | 2439.07 |
| scene_2 | case_2 | Yes | 3.45 | 2566.86 | No | 3.29 | – | Yes | 13.30 | 2399.11 |
| scene_3 | case_1 | Yes | 3.33 | 1207.62 | Yes | 66.65 | 1777.58 | Yes | 7.52 | 1079.86 |
| scene_3 | case_2 | Yes | 0.57 | 2027.85 | No | 3.45 | – | Yes | 0.56 | 2615.41 |
| scene_4 | case_1 | Yes | 0.70 | 2817.92 | Yes | 3.40 | 5184.19 | Yes | 1.06 | 2969.58 |
| scene_4 | case_2 | Yes | 2.40 | 1000.69 | Yes | 6.06 | 1548.78 | Yes | 1.01 | 1160.86 |
| scene_5 | case_1 | Yes | 0.50 | 3096.14 | Yes | 3.04 | 5507.71 | Yes | 0.46 | 3668.42 |
| scene_5 | case_2 | Yes | 0.48 | 2428.53 | Yes | 3.06 | 5610.34 | Yes | 0.46 | 2601.70 |
For successful runs, the reported time denotes the elapsed wall-clock time required to obtain the complete feasible path. For the three failed IHA* cases, the reported time denotes the elapsed time until the planner terminated without obtaining a complete feasible solution, and the corresponding path cost is therefore not reported.
To avoid bias caused by failed cases, the quantitative time and cost comparison is further examined on the seven tasks successfully solved by all three planners. Over these common-success cases, the average planning times of the baseline, IHA*, and proposed planners are 8.54 s, 18.79 s, and 3.52 s, respectively. Thus, the proposed planner reduces the average initial feasible-path planning time by 58.79% relative to the baseline and by 81.26% relative to IHA*. This result indicates that the proposed adaptive expansion strategy retains the global Hybrid A* search structure while avoiding the additional computational burden caused by repeated intermediate-point-guided sub-searches in difficult cases.
The corresponding average path costs over the seven common-success cases are 2045.76, 3457.17, and 2154.57 for the baseline, IHA*, and proposed planners, respectively. The proposed planner reduces the average path cost by 37.68% relative to IHA*, although its initial feasible-path cost remains 5.32% higher than that of the baseline on this common-success subset. This result is consistent with the first-solution analysis in Table 5: the proposed search strategy does not necessarily produce the lowest-cost first feasible path in every case. Its main advantage is that it generates feasible solutions more reliably and generally more efficiently than IHA*, while the subsequent bounded continuation stage further improves the final returned path.
The visual comparisons in Figure 12 and Figure 13 further illustrate the difference among the three planners. IHA* can generate feasible paths efficiently when the two-dimensional coarse guidance and extracted intermediate poses are compatible with the required AMT maneuver. However, its performance deteriorates when the coarse guidance does not adequately represent the forward–reverse nonholonomic maneuver required by the large vehicle. In contrast, the proposed planner does not rely on externally generated intermediate poses and successfully solves all ten benchmark tasks while retaining the ability to refine the initial feasible path through bounded continuation.
5.6. Results in Real-Map-Derived Mining Working-Face Scenarios
The proposed planner was further evaluated in static simulations constructed from point-cloud scans of a real open-pit coal-mine working face. Obstacle and free-space boundaries were extracted from the point-cloud data and subsequently represented in occupancy-grid planning maps. These scenarios preserve non-convex obstacle outlines, local bottlenecks, and less regular free-space distributions than the abstract mine-like scenarios. The experiments are offline path-planning simulations rather than on-vehicle field tests, and are used to examine whether the proposed planner remains effective when the simplified benchmark geometry is replaced by real-map-derived working-face geometry. The experimental planning paths are shown in Figure 14.
Figure 14.

Path comparison in real-map-derived mining working-face scenarios with irregular obstacle boundaries: (a) case_1; (b) case_2; (c) case_3; (d) case_4.
Table 7 reports the final-solution results in the real-map-derived mining working face cases with irregular obstacle boundaries. For both planners, the reported final solutions are obtained after the same multi-RS continuation procedure. Averaged over the four cases, the proposed planner reduces final planning time from 181.52 s to 135.92 s, corresponding to a 25.12% reduction. The average number of final generated nodes decreases from 555,058 to 344,245, corresponding to a 37.98% reduction. The average final path cost decreases from 1886.53 to 1751.61, corresponding to a 7.15% reduction. The reductions in expanded nodes and RS attempts are smaller, both decreasing by 7.53%. This indicates that, in irregular working face scenarios, the primary benefit of the proposed planner is the reduction of generated successors rather than a uniform reduction of all intermediate search indicators.
Table 7.
Results in real-map-derived mining working-face scenarios with irregular obstacle boundaries.
| Case | Method | Final Time (s) | Final Expanded | Final Generated | Final RS Attempts | Final Cost |
|---|---|---|---|---|---|---|
| case_1 | baseline | 687.25 | 25,680 | 2,105,678 | 1284 | 3395.98 |
| case_1 | proposed | 515.29 | 23,900 | 1,314,445 | 1195 | 3171.76 |
| case_2 | baseline | 10.69 | 380 | 31,078 | 19 | 1058.91 |
| case_2 | proposed | 7.66 | 300 | 16,445 | 15 | 960.13 |
| case_3 | baseline | 19.73 | 740 | 60,598 | 37 | 1496.20 |
| case_3 | proposed | 13.05 | 560 | 30,745 | 28 | 1453.16 |
| case_4 | baseline | 8.40 | 280 | 22,878 | 14 | 1595.04 |
| case_4 | proposed | 7.67 | 280 | 15,345 | 14 | 1421.39 |
The case-wise results show that final generated nodes are reduced in all four real working face cases. The reductions are 37.58%, 47.08%, 49.26%, and 32.93% from case_1 to case_4, respectively. Final planning time is also reduced in all four cases, with reductions of 25.02%, 28.39%, 33.85%, and 8.61%. Final cost decreases by 6.60%, 9.33%, 2.88%, and 10.89%, respectively. These results indicate that the proposed planner remains effective when obstacle boundaries are highly irregular.
In addition to the irregular working face cases, a corridor-like real-map-derived mining working-face case is evaluated to examine the effect of bounded continuation in a spatially constrained environment. Figure 15 shows the path comparison, and Table 8 reports the quantitative results.
Figure 15.

Path comparison in a real-map-derived mining working-face corridor scenario.
Table 8.
Quantitative comparison in a real-map-derived mining working-face corridor scenario.
| Metric | Baseline | Proposed | Improve |
|---|---|---|---|
| Final planning time (s) | 17.015 | 14.022 | |
| Final expanded nodes | 940 | 900 | |
| Final generated nodes | 76,998 | 49,445 | |
| Final RS attempts | 47 | 45 | |
| Final path cost | 2627.80 | 1971.08 | |
| First-solution time (s) | 1.733 | 1.090 | |
| First expanded nodes | 80 | 60 | |
| First generated nodes | 6478 | 3245 | |
| First RS attempts | 4 | 3 | |
| First-solution cost | 3549.47 | 3931.33 |
In this corridor case, the proposed planner reduces final planning time by 17.59%, final generated nodes by 35.78%, and final path cost by 24.99%. The reduction in final generated nodes again confirms that top-K scheduling and adaptive rollout reduce redundant successor generation. The improvement in final path cost is more pronounced than in the irregular working face cases, indicating that bounded continuation can be particularly useful when the first feasible connection is not sufficient to represent the best available maneuver.
The first-solution results in Table 8 reveal a different behavior. The proposed planner reduces first-solution time by 37.11%, first generated nodes by 49.91%, and first RS attempts by 25.00%, but the first-solution cost increases by 10.76%. Therefore, the first feasible path is found faster but is not better in terms of cost. After bounded continuation, however, the proposed planner reduces the path cost from 3931.33 to 1971.08, corresponding to a 49.86% improvement from its own first feasible path. By comparison, the baseline cost decreases from 3549.47 to 2627.80, corresponding to a 25.97% improvement. This comparison shows that bounded continuation contributes more substantially to the proposed planner in this corridor working face case.
5.7. Integrated Analysis and Limitations
The complete experimental results reveal three key observations. First, the proposed planner most consistently reduces generated nodes. In the five abstract mine-like scenarios, final generated nodes are reduced by 74.10% on average. In the real-map-derived mining working-face irregular cases, they are reduced by 37.98% on average. In the real-map-derived mining working-face corridor case, they are reduced by 35.78%. Across all reported final-solution cases, generated nodes are reduced in every case. This confirms that top-K primitive scheduling and adaptive rollout-length assignment effectively reduce redundant successor generation.
Second, final path cost is more consistently improved than first-solution cost. In the abstract mine-like scenarios, final path cost decreases by 12.76% on average, while first-solution cost increases by 4.32%. In the real-map-derived mining working-face corridor case, first-solution cost also increases by 10.76%, but final path cost decreases by 24.99%. These results show that the proposed planner should not be judged solely by the first feasible path. Because the same multi-RS continuation procedure is applied to both methods, the difference in final-path performance mainly reflects the different RS-connectable candidate states generated by the two search front ends. The proposed search strategy does not always produce a lower-cost first solution, but it can generate subsequent candidate states that lead to a lower-cost final incumbent path during the common multi-RS refinement stage.
Third, the proposed planner does not uniformly dominate the baseline in every intermediate metric. In scene_3, final generated nodes and final cost decrease, but final planning time, expanded nodes, and RS attempts increase. In scene_5, generated nodes and final cost decrease, but expanded nodes and RS attempts increase by 10.00%. This non-dominance behavior is consistent with the heuristic nature of local-geometry-aware scheduling. The proposed planner reduces low-value successor generation, but the remaining selected branches may still require difficult collision checking or RS closure attempts.
The first limitation comes from top-K primitive scheduling. A primitive that appears locally unattractive may still be useful for a globally favorable maneuver. If such a primitive is removed during top-K filtering, bounded continuation cannot recover that branch later. Direction-diversity compensation reduces this risk, but it cannot eliminate it completely. Therefore, the top-K filtering is heuristic and does not provide a formal completeness guarantee.
The second limitation comes from adaptive rollout length. Longer rollouts can reduce search depth in open regions, but they may also place the AMT in a less favorable heading and require later correction. Shorter rollouts preserve maneuver resolution in confined regions, but they may increase the number of expanded nodes. The progress-reward-based dual-cost update mitigates this bias, but it does not remove the trade-off between expansion scale and future correction cost.
The third limitation comes from the local nature of the geometric descriptors. Obstacle clearance, maneuver margin, goal distance, and heading alignment describe the immediate neighborhood of the AMT. They do not fully encode the global topology of the working face. Therefore, when a globally useful maneuver initially appears locally unfavorable, the proposed planner may lose part of its advantage.
A further limitation is that the present study assumes a known static occupancy-grid map and an accurately localized vehicle pose. Dynamic obstacles, temporal changes of the working-face boundary, incomplete map information, perception errors, localization uncertainty, and sensing latency are not explicitly modeled. In an operating mine, these factors can affect both collision checking and the validity period of a planned path. The current validation is therefore limited to offline spatial path planning, and the planner has not yet been integrated into a complete autonomous-mining-truck stack for closed-loop field operation. Future work will combine the proposed search strategy with online map updating, obstacle prediction, uncertainty-aware collision checking, trajectory tracking, and incremental replanning before conducting on-vehicle field validation.
The proposed framework is not inherently restricted to the specific AMT used in this study. For other low-speed Ackermann-steered industrial vehicles with comparable nonholonomic motion characteristics, such as yard tractors, agricultural transport vehicles, or car-like logistics vehicles, the framework can be transferred by re-parameterizing the vehicle geometry, wheelbase, steering limit, collision footprint, rollout bounds, local-clearance thresholds, and maneuver-cost weights. However, vehicles with substantially different kinematic structures, such as articulated trucks or differential-drive platforms, would require corresponding modifications to the vehicle model and motion-primitive library rather than direct parameter substitution.
Overall, the proposed planner improves the efficiency–quality trade-off of Hybrid A* for AMT path planning at open-pit mine working faces. Its most stable benefit is the reduction of generated nodes, while its final path-quality improvement is closely related to bounded continuation after the first feasible RS closure.
6. Conclusions
This paper proposed an adaptive bounded Hybrid A* planner for AMTs operating at open-pit mine working faces. The proposed method addresses the inefficiency of conventional Hybrid A* in confined unstructured environments by integrating local-geometry-aware top-K motion primitive scheduling, adaptive rollout-length assignment, progress-reward-based dual-cost update, and bounded continuation after the first feasible Reeds–Shepp closure. Experimental results in abstract mine-like scenarios and real-map-derived mining working-face scenarios demonstrate that the proposed planner effectively reduces redundant successor generation, improves computational efficiency, and enhances final returned path quality. In the abstract mine-like scenarios, the proposed planner reduces average final planning time by 54.73%, generated nodes by 74.10%, and final path cost by 12.76%. In the real-map-derived mining working-face scenarios with irregular obstacle boundaries, it reduces average final planning time by 25.12%, generated nodes by 37.98%, and final path cost by 7.15%. The comparison between first-solution and final-returned-path results further shows that the first feasible RS closure should not be treated as the final solution; instead, bounded continuation enables the planner to refine the initial feasible candidate and obtain a lower-cost final path. These results confirm that the proposed framework improves the efficiency–quality trade-off of Hybrid A* for AMT path planning in confined and geometrically irregular working face environments. The current validation remains limited to known static maps and offline simulation; future work will address dynamic obstacles, perception and localization uncertainty, online replanning, and closed-loop on-vehicle field validation.
Acknowledgments
The authors express their gratitude to the scholars who have contributed to the field of path planning.
Author Contributions
Methodology, Z.M. and R.Z.; writing—original draft preparation, Z.M.; writing—review and editing, R.Z. All authors have read and agreed to the published version of the manuscript.
Institutional Review Board Statement
Not applicable.
Informed Consent Statement
Not applicable.
Data Availability Statement
The data that support the findings of this study are available from the corresponding author upon reasonable request.
Conflicts of Interest
The authors declare no conflicts of interest.
Funding Statement
This research received no external funding.
Footnotes
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.
References
- 1.Cai L., Guan H., Zhou Z.Y., Xu F.L., Jia X., Zhan J. Parking planning under limited parking corridor space. IEEE Trans. Intell. Transp. Syst. 2023;24:1962–1981. doi: 10.1109/tits.2022.3219651. [DOI] [Google Scholar]
- 2.Zhang S., Jian Z., Deng X., Chen S., Nan Z., Zheng N. Hierarchical motion planning for autonomous driving in large-scale complex scenarios. IEEE Trans. Intell. Transp. Syst. 2022;23:13291–13305. doi: 10.1109/tits.2021.3123327. [DOI] [Google Scholar]
- 3.Li L., Yu G., Li H., Xia Q., Zhang X., Cai H. Proceedings of the 2024 IEEE 22nd International Conference on Industrial Informatics (INDIN) IEEE; Piscataway, NJ, USA: 2024. Prediction of driving departure of mining autonomous transport vehicles based on GRU network; pp. 1–7. [Google Scholar]
- 4.Li H., Chen P., Yu G., Zhou B., Han Z., Liao Y. Collaborative trajectory planning for autonomous mining trucks: A grouping and prioritized optimization based approach. IEEE Trans. Veh. Technol. 2024;73:6283–6300. doi: 10.1109/tvt.2023.3343703. [DOI] [Google Scholar]
- 5.Li H., Chen P., Yu G., Zhou B., Li Y., Liao Y. Trajectory planning for autonomous driving in unstructured scenarios based on deep learning and quadratic optimization. IEEE Trans. Veh. Technol. 2024;73:4886–4903. doi: 10.1109/tvt.2023.3330581. [DOI] [Google Scholar]
- 6.Yu G., Li H., Wang Y., Chen P., Zhou B. A review on cooperative perception and control supported infrastructure-vehicle system. Green Energy Intell. Transp. 2022;1:100023. doi: 10.1016/j.geits.2022.100023. [DOI] [Google Scholar]
- 7.Dolgov D., Thrun S., Montemerlo M., Diebel J. Practical Search Techniques in Path Planning for Autonomous Driving; Proceedings of the First International Symposium on Search Techniques in Artificial Intelligence and Robotics; Chicago, IL, USA. 13–14 July 2008. [Google Scholar]
- 8.Reeds J.A., Shepp L.A. Optimal Paths for a Car That Goes Both Forwards and Backwards. Pac. J. Math. 1990;145:367–393. doi: 10.2140/pjm.1990.145.367. [DOI] [Google Scholar]
- 9.Hu J., Liu D., Rakheja S., Zhang Y., Sun C., Gao H. Trajectory Planning for Autonomous Vehicles in Narrow Parking Lot with Improved Hybrid A*. Automot. Innov. 2025;8:866–881. doi: 10.1007/s42154-024-00346-4. [DOI] [Google Scholar]
- 10.Kim M., Ahn J., Park J. TargetTree-RRT*: Continuous-Curvature Path Planning Algorithm for Autonomous Parking in Complex Environments. IEEE Trans. Autom. Sci. Eng. 2024;21:606–617. doi: 10.1109/TASE.2022.3225821. [DOI] [Google Scholar]
- 11.Cao Y., Li B., Deng Z. Optimization-Based Automated Parking Trajectory Planning in Unstructured Environments with Efficient Obstacle Query. IEEE Trans. Intell. Transp. Syst. 2025;26:15422–15435. doi: 10.1109/TITS.2025.3605300. [DOI] [Google Scholar]
- 12.Li B., Ouyang Y., Li X., Cao D., Zhang T., Wang Y. Mixed-Integer and Conditional Trajectory Planning for an Autonomous Mining Truck in Loading/Dumping Scenarios: A Global Optimization Approach. IEEE Trans. Intell. Veh. 2023;8:1512–1522. doi: 10.1109/TIV.2022.3214777. [DOI] [Google Scholar]
- 13.Li H., Yu G., Chen P., Li Y., Xia Q. A Human-Like Parking Trajectory Planning Approach for Autonomous Vehicle Load Tasks in Mining Site. Automot. Innov. 2025;8:913–934. doi: 10.1007/s42154-025-00358-8. [DOI] [Google Scholar]
- 14.Guo Y., Guo Z., Wang Y., Yao D., Li B., Li L. A Survey of Trajectory Planning Methods for Autonomous Driving—Part I: Unstructured Scenarios. IEEE Trans. Intell. Veh. 2024;9:5407–5434. doi: 10.1109/TIV.2023.3337318. [DOI] [Google Scholar]
- 15.Tazaki Y., Okuda H., Suzuki T. Parking trajectory planning using multiresolution state roadmaps. IEEE Trans. Intell. Veh. 2017;2:298–307. doi: 10.1109/tiv.2017.2769882. [DOI] [Google Scholar]
- 16.Li B., Yin Z., Ouyang Y., Zhang Y., Zhong X., Tang S. Online trajectory replanning for sudden environmental changes during automated parking: A parallel stitching method. IEEE Trans. Intell. Veh. 2022;7:748–757. doi: 10.1109/tiv.2022.3156429. [DOI] [Google Scholar]
- 17.Gupta A., Divekar R. Autonomous parallel parking methodology for Ackerman configured vehicles. ACEEE Int. J. Commun. 2010;1:22–27. [Google Scholar]
- 18.Han Z., Wu Y., Li T., Zhang L., Pei L., Xu L., Li C., Ma C., Xu C., Shen S., et al. An efficient spatial-temporal trajectory planner for autonomous vehicles in unstructured environments. IEEE Trans. Intell. Transp. Syst. 2024;25:1797–1814. doi: 10.1109/tits.2023.3315320. [DOI] [Google Scholar]
- 19.Zhang X., Liniger A., Borrelli F. Optimization-Based Collision Avoidance. IEEE Trans. Control Syst. Technol. 2021;29:972–983. doi: 10.1109/TCST.2019.2949540. [DOI] [Google Scholar]
- 20.Sun C., Li Q., Li B., Li L. A Successive Linearization in Feasible Set Algorithm for Vehicle Motion Planning in Unstructured and Low-Speed Scenarios. IEEE Trans. Intell. Transp. Syst. 2022;23:3724–3736. doi: 10.1109/TITS.2020.3041075. [DOI] [Google Scholar]
- 21.Li B., Acarman T., Zhang Y., Ouyang Y., Yaman C., Kong Q., Zhong X., Peng X. Optimization-Based Trajectory Planning for Autonomous Parking with Irregularly Placed Obstacles: A Lightweight Iterative Framework. IEEE Trans. Intell. Transp. Syst. 2022;23:11970–11981. doi: 10.1109/TITS.2021.3109011. [DOI] [Google Scholar]
- 22.Ning J., Cui X., Gao X., Li T., Tong S., Chen C.P. Fuzzy Event-Driven Optimal Quantized Control for USVs under Thruster and Positioning Constraints: An Adaptive Dynamic Programming Method. IEEE Trans. Fuzzy Syst. 2026;34:2601–2613. doi: 10.1109/TFUZZ.2026.3696383. [DOI] [Google Scholar]
- 23.Liu W., Li Z., Li L., Wang F.Y. Parking Like a Human: A Direct Trajectory Planning Solution. IEEE Trans. Intell. Transp. Syst. 2017;18:3388–3397. doi: 10.1109/TITS.2017.2687047. [DOI] [Google Scholar]
- 24.Lin Y.L., Li L., Dai X.Y., Zheng N.N., Wang F.Y. Master General Parking Skill via Deep Learning; Proceedings of the 2017 IEEE Intelligent Vehicles Symposium (IV); Los Angeles, CA, USA. 11–14 June 2017; pp. 941–946. [DOI] [Google Scholar]
- 25.Zhang P., Xiong L., Yu Z., Fang P., Yan S., Yao J., Zhou Y. Reinforcement learning-based end-to-end parking for automatic parking system. Sensors. 2019;19:3996. doi: 10.3390/s19183996. [DOI] [PMC free article] [PubMed] [Google Scholar]
- 26.Pivtoraiko M., Knepper R.A., Kelly A. Differentially Constrained Mobile Robot Motion Planning in State Lattices. J. Field Robot. 2009;26:308–333. doi: 10.1002/rob.20285. [DOI] [Google Scholar]
- 27.Li B., Wang K., Shao Z. Time-optimal maneuver planning in automatic parallel parking using a simultaneous dynamic optimization approach. IEEE Trans. Intell. Transp. Syst. 2016;17:3263–3274. doi: 10.1109/tits.2016.2546386. [DOI] [Google Scholar]
- 28.Wang N., Li X., Zhang K., Wang J., Xie D. A survey on path planning for autonomous ground vehicles in unstructured environments. Machines. 2024;12:31. doi: 10.3390/machines12010031. [DOI] [Google Scholar]
- 29.LaValle S. Rapidly-Exploring Random Trees: A New Tool for Path Planning. Department of Computer Science, Iowa State University; Ames, IA, USA: 1998. Research Report 9811. [Google Scholar]
- 30.Orthey A., Chamzas C., Kavraki L.E. Sampling-based motion planning: A comparative review. Annu. Rev. Control Robot. Auton. Syst. 2024;7:285–310. doi: 10.1146/annurev-control-061623-094742. [DOI] [Google Scholar]
- 31.Jones M., Djahel S., Welsh K. Path-planning for unmanned aerial vehicles with environment complexity considerations: A survey. ACM Comput. Surv. 2023;55:234. doi: 10.1145/3570723. [DOI] [Google Scholar]
- 32.Dong X., Wang Y., Fang C., Ran K., Liu G. Fhq-rrt*: An improved path planning algorithm for mobile robots to acquire high-quality paths faster. Sensors. 2025;25:2189. doi: 10.3390/s25072189. [DOI] [PMC free article] [PubMed] [Google Scholar]
- 33.Wu Q., Tang Q., Ma L., Zhao D., Lei J. MEG-RRT*: A Hierarchical Hybrid Path Planning Framework for Warehouse AGVs Using Multi-Objective Evolutionary Guidance. Sensors. 2026;26:2221. doi: 10.3390/s26072221. [DOI] [PMC free article] [PubMed] [Google Scholar]
- 34.Vorobieva H., Glaser S., Minoiu-Enache N., Mammar S. Automatic Parallel Parking in Tiny Spots: Path Planning and Control. IEEE Trans. Intell. Transp. Syst. 2015;16:396–410. doi: 10.1109/TITS.2014.2335054. [DOI] [Google Scholar]
- 35.Metin F., Sezer V. Analysis and Improvement of Geometric Parallel Parking Methods with Respect to the Minimum Final Lateral Distance to the Parking Spot. Int. J. Intell. Transp. Syst. Res. 2021;19:441–455. doi: 10.1007/s13177-021-00256-3. [DOI] [Google Scholar]
- 36.Zips P., Böck M., Kugi A. Optimisation Based Path Planning for Car Parking in Narrow Environments. Robot. Auton. Syst. 2016;79:1–11. doi: 10.1016/j.robot.2016.02.004. [DOI] [Google Scholar]
- 37.Hu J., Feng Y., Li S., Wang H., So J., Zheng J. Mirroring the Parking Target: An Optimal-Control-Based Parking Motion Planner with Strengthened Parking Reliability and Faster Parking Completion. IEEE Trans. Intell. Transp. Syst. 2024;25:16157–16170. doi: 10.1109/TITS.2024.3428552. [DOI] [Google Scholar]
- 38.Feng Z., Chen S.E., Chen Y., Zheng N. Model-Based Decision Making with Imagination for Autonomous Parking; Proceedings of the IEEE Intelligent Vehicles Symposium; Changshu, Suzhou, China. 26–30 June 2018; pp. 2216–2223. [DOI] [Google Scholar]
- 39.Zhang S., Li K., He R., Meng Z., Chang Y., Jin X., Bai R. Trajectory Planning for Autonomous Driving in Unstructured Scenarios Based on Graph Neural Network and Numerical Optimization. arXiv. 20242406.08855 [Google Scholar]
- 40.Yuan Z., Wang Z., Li X., Li L., Zhang L. Hierarchical Trajectory Planning for Narrow-Space Automated Parking with Deep Reinforcement Learning: A Federated Learning Scheme. Sensors. 2023;23:4087. doi: 10.3390/s23084087. [DOI] [PMC free article] [PubMed] [Google Scholar]
- 41.Jiang M., Li Y., Zhang S., Chen S., Wang C., Yang M. HOPE: A Reinforcement Learning-Based Hybrid Policy Path Planner for Diverse Parking Scenarios. arXiv. 20242405.20579 [Google Scholar]
- 42.Li C., Ji Z., Chen Z., Qin T., Yang M. ParkingE2E: Camera-Based End-to-End Parking Network, From Images to Planning. arXiv. 20242408.02061 [Google Scholar]
- 43.Zhao Z., Bi L. A New Challenge: Path Planning for Autonomous Truck of Open-Pit Mines in the Last Transport Section. Appl. Sci. 2020;10:6622. doi: 10.3390/app10186622. [DOI] [Google Scholar]
Associated Data
This section collects any data citations, data availability statements, or supplementary materials included in this article.
Data Availability Statement
The data that support the findings of this study are available from the corresponding author upon reasonable request.
