1. Introduction
Under the dual pressures of continuous global population growth and tight arable land resources, the smart agricultural system, with the core goals of precision, efficiency, and sustainability, is developing rapidly. Aiming to increase agricultural output and resource utilization efficiency, reduce labor intensity, and ensure food safety, smart agriculture uses technologies such as the Internet of Things (IoT), big data, artificial intelligence, and robotics to monitor and make decisions on the environment, soil, crop growth conditions, and production processes in real time [
1,
2,
3]. In facility-based agriculture such as greenhouse farms, key indicators such as temperature, humidity, light and water, and fertilizer can be precisely monitored and managed. The automation and intelligence of agricultural equipment is another important aspect to ensure the efficient and stable production process.
Against this backdrop, the automatic navigation technology for agricultural machinery is a key element of smart agriculture, with path planning constituting the core of such systems [
4,
5]. In facility-based environments such as greenhouses, the working areas are mostly characterized by multiple rows of symmetry, narrow and long corridors, and dense obstacles. When performing tasks, intelligent transportation vehicles need to pass through complex U-shaped areas, and this poses significant challenges to the robustness and safety of the path planning. To ensure the crops are not damaged and to enhance the delivery efficiency, the planned path not only needs to comply with the kinematic constraints of the vehicle but also needs to generate a feasible trajectory with low oscillation and high smoothness and maintain an adequate safety distance from the corridor walls and obstacles.
Conventional path planning algorithms primarily encompass graph search-based methods (e.g., A-star and Dijkstra), sampling-based approaches (e.g., RRT), optimization-based techniques (e.g., gradient descent), and curve interpolation methods (e.g., Dubins and Bézier curves) [
6]. Among these, the A-star algorithm is commonly used for global path planning in static maps due to its stability and heuristic characteristics [
7,
8]. A-star algorithm uses a heuristic function to search for the shortest path on a grid map. However, in situations with dense obstacles, it is prone to generating a large number of redundant nodes and resulting in decreased computational efficiency [
9]. In a real agricultural environment, the A-star algorithm faces challenges such as excessive node expansion, abrupt curvature changes, and inability to accommodate dynamic constraints [
10,
11].
To address these issues, the Hybrid A-star algorithm was developed. This method combines the heuristic search framework of A-star with the trajectory generation mechanism in continuous space. It enhances the feasibility and smoothness of the path by integrating kinematically feasible extension strategies (such as Reeds-Shepp or Dubins paths) [
12,
13]. The Hybrid A-star algorithm has demonstrated excellent performance in automatic parking [
14,
15,
16], complex structural environments, and intelligent agricultural scenarios [
17,
18,
19].
To further enhance the path planning performance of the Hybrid A-star algorithm in complex constraint environments, researchers have proposed various improvement strategies. From the standpoint of path continuity, some researchers apply Bézier curves or cubic splines to smooth the discrete paths generated by the Hybrid A-star algorithm, which enhance the stability of path tracking control [
20]. Some studies have incorporated G2 continuity constraints during the path generation stage to ensure the smoothness of curvature changes, thereby improving path quality and compatibility with vehicle control systems [
21]. To address the challenges of excessive node expansions in the Hybrid A-star algorithm when dealing with high-resolution maps, Cui et al. [
22] proposed an improved method based on geometric curves and direction guidance. During the planning stage, multiple controllable arcs are implemented, and the path expansion direction is dynamically guided by the local geometric structure, effectively reducing the expansion of invalid nodes and improving the search efficiency. To further reduce the search space, some studies have incorporated the Jump Point Search (JPS) algorithm into the initial guidance stage of the ant colony optimization. As reported in the literature [
23], initializing pheromone distribution with jump points expedites early iterations by directing the algorithm toward more promising solution regions. The above studies all demonstrate that the Hybrid A-star algorithm has excellent scalability and integration capabilities and is suitable for path planning tasks in facility agriculture that involve multiple types of obstacles and highly coupled kinematic constraints.
In recent years, research on path planning for facility-based agricultural such as greenhouses and orchards has exhibited significant trends of integration, multi-level structure, and high real-time performance. In orchard operation, in order to meet the actual requirements of the grass-cutting robot for operation in the dense planting rows, Li et al. [
24] proposed a path generation strategy based on safety corridors and secondary planning. Their approach divides the environment into high-security zones and drivable areas and then performs trajectory optimization. It effectively avoids obstacles while maintaining high controllability. For articulated tractor path optimization, some scholars have utilized a multi-objective function that integrates genetic algorithms with a multi-segment structure encoding method to comprehensively optimize the path length, the number of turns, and the alignment accuracy. It demonstrates that multi-dimensional performance indicators are gradually gaining attention in agricultural path planning [
25]. Overall, agricultural path planning is progressing towards structural adaptation and model integration, emphasizing the deployability and stability of algorithms in actual operation systems.
However, in large-scale greenhouse or multi-narrow corridor environments, the conventional Hybrid A-star algorithm often exhibits insufficiencies in node expansion owing to unnecessary exploration into dead zones. The adopted fixed heuristic poses challenges in balancing search efficiency with path quality. To overcome these limitations, this study proposes a novel Hybrid A-star algorithm path planning method based on directional guidance and segmented heuristic weighting, which takes into account both search efficiency and path feasibility. The proposed approach introduces two principal enhancements: directional node expansion and adaptive heuristic weighting. First, the JPS algorithm is employed to extract key jump points from the planned path and utilize them as the direction guiding points for the Hybrid A-star algorithm. The guiding nodes expand successively in the direction of the key jump points to avoid the ineffective node expansion. Secondly, by calculating the difference in reference heading angles between adjacent key jump points and combining with axis alignment detection, determine whether the current path segment is a straight segment or a turning segment. Higher heuristic weights are allocated to straight segments to accelerate the search process along linear corridors, whereas lower weights are retained for turning segments to preserve trajectory smoothness and planning quality.
2. Proposed Path Planning Framework and Methodology
2.1. Overview of the Proposed Path Planning Framework
In structured agriculture environments such as greenhouses, U-shaped obstacles are frequently encountered. When applying the Hybrid A-star algorithm for path planning in these settings, the search process often extends into dead zones, resulting in a large number of invalid node expansions and decreased computational efficiency. As shown in
Figure 1a, a typical tomato greenhouse is depicted. For path planning purposes, the structural layout of the greenhouse is abstracted into a 2D grid map.
Figure 1b shows the corresponding path generated by the Hybrid A-star algorithm. In the grid representation, black cells indicate obstacle regions, white cells represent navigable workspace, and the blue box underscores an area where the algorithm expands into a dead zone, leading to inefficient and unnecessary node exploration.
A preliminary path is quickly generated using the JPS algorithm between the start and goal positions, from which a sequence of key jump points is extracted. These jump points act as directional references for the subsequent Hybrid A-star planning process, effectively reducing unnecessary exploration into dead zones. For each jump point, a reference heading angle is calculated based on the coordinates of two adjacent jump points. By analyzing heading angle differences and axis alignment between successive segments, the path is classified into either turning or straight segments. Each segment is then assigned a dynamic heuristic coefficient, resulting in a segment-wise heuristic coefficient list. This allows accelerated node expansion in straight-line regions and enhanced path smoothness in turning regions. When the expanding node enters a predefined tolerance region around the next jump point, the algorithm switches to the corresponding heuristic coefficient for that segment. The total cost function integrates the travel cost, steering continuity penalty, and directional deviation penalty, thereby promoting efficient forward exploration while constraining node expansion in non-optimal directions. The overall algorithm workflow is shown in
Figure 2.
2.2. Vehicle Kinematic Model and Node Expansion Strategy
The improved Hybrid A-star algorithm proposed in this study is formulated based on an Ackermann-steering vehicle model. The kinematic structure of the Ackermann model is presented in
Figure 3. In the diagram,
represent the coordinates of the rear axle center,
denotes the vehicle’s orientation (heading angle), and
represents the front-wheel steering angle. In addition to these motion parameters, the figure also presents key geometric parameters of the vehicle, including
(vehicle length),
(front overhang),
(wheelbase),
(rear overhang), and
(vehicle width). Based on the Ackermann kinematic constraints and the vehicle’s geometric configuration, the minimum turning radius
can be calculated as:
The Hybrid A-star algorithm enhances the conventional A-star algorithm by incorporating the vehicle’s kinematic constraints, thereby allowing the generation of paths that are physically feasible and trackable by real vehicles. Unlike the A-star algorithm, which expands nodes strictly based on adjacent grid centers, the Hybrid A-star algorithm utilizes a set of discrete motion primitives defined by step length, turning radius, and front wheel steering angles, as shown in
Figure 4. The red line segments correspond to expansion trajectories, red dots mark the expanded nodes, and the blue solid line shows the generated path. This approach allows successor nodes to occupy arbitrary positions within the grid, rather than being confined to grid cell centers as in the standard A-star algorithm. As a result, the Hybrid A-star algorithm more accurately models continuous motion and supports the planning of kinematically feasible trajectories.
The state of the vehicle is represented by the position and heading angle of the rear-axle center, denoted as
. Assuming each control input consists of a linear displacement
and a front-wheel steering angle
, the relationship between the current node and its successor node can be described using the following kinematic equations:
2.3. Jump Point-Based Global Guidance Mechanism
The JPS algorithm is an optimized variant of the conventional A-star algorithm. In the standard A-star approach, each node expansion involves evaluating potential movements in all eight directions around the current node, making the computation process relatively complex and time-consuming. JPS enhances efficiency by eliminating unnecessary intermediate nodes and retaining only a set of representative key nodes, referred to as jump points, to guide the search. These jump points allow the algorithm to reduce redundancy and accelerate the overall path planning process.
Based on the distribution of obstacles in the map, the neighboring nodes around a given node can be categorized into two types: natural neighbors and forced neighbors. For example, in the absence of surrounding obstacles, consider a scenario where the parent node expands horizontally from node 4 to node
. If a neighboring node
satisfies the condition that the path passing through
is shorter than any alternative path that avoids
, then
is identified as a natural neighbor. This relationship is illustrated by the gray cells in
Figure 5a.
When the expansion direction is either horizontal or vertical, the criteria for identifying natural neighbors can be formally defined as follows:
where
represents path length;
denotes a path from
to
that does not pass through
;
denotes the path
;
is the parent node of
. When expanding diagonally from parent node 6 to node
, a neighboring node
is considered a natural neighbor if the path that passes through node
is longer than the alternative path that bypasses
, as illustrated in
Figure 5b. This condition typically occurs during diagonal expansions under specific geometric constraints.
In an obstacle-free environment, when the expansion direction is diagonal, the criteria for identifying natural neighbors can be defined as follows:
When obstacles are present around the current node, a neighboring node
is identified as a forced neighbor if the cost of the path passing through node
from the parent node is lower than the cost of bypassing
to reach
. In other words, the presence of an obstacle forces the path to include node
to maintain optimality. Such nodes are highlighted in red in
Figure 5c,d, which illustrate typical scenarios where forced neighbors arise owing to the presence of adjacent obstacles.
A neighboring node is considered a forced neighbor if it satisfies both of the following conditions:
- (1)
Node is not a natural neighbor;
- (2)
The path passing through node from the parent node has a lower total cost than any alternative path reaching that avoids .
A node is identified as a jump point if it satisfies at least one of the following conditions:
- (1)
Node is the start or end point;
- (2)
Node has at least one forced neighbor;
- (3)
When expanding diagonally, both the horizontal and vertical neighbors of satisfy either condition 1 or 2;
The path is initially planned on the grid map using the JPS algorithm. Based on the jump point selection criteria, key jump points are extracted from the resulting path and serve as directional guidance references for the Hybrid A-star algorithm. The selection of key jump points is illustrated in
Figure 6.
2.4. Design of Tolerance Region Around Key Jump Points
To ensure collision-free path planning and enable node expansion into regions guided by key jump points, a tolerance region is defined around each jump point, as illustrated in
Figure 7. This tolerance area also enhances the continuity between different path segments that are assigned different heuristic weights.
The tolerance region is defined as a circular area centered at each jump point, with its radius determined based on the vehicle’s geometric dimensions. Let
represent the diagonal distance from the rear-axle center to the frontmost point of the vehicle. Given
(front overhang),
(wheelbase), and
(vehicle width), the radius
of the positional tolerance region is expressed as:
This tolerance ensures that any node entering the vicinity of a jump point can be considered to have successfully reached it, thereby facilitating smooth heuristic transitions and stable trajectory continuity across path segments.
2.5. Segment-Based Heuristic Weighting Strategy
In the traditional Hybrid A-star algorithm, the heuristic weight is typically held constant throughout the planning process. However, maintaining a constant heuristic coefficient makes it challenging to strike an optimal balance between search efficiency in straight-line segments and path smoothness in turning segments. To overcome this limitation, a segment-based heuristic weighting mechanism is proposed. By calculating the heading angle difference between two adjacent key jump points and determining their axis alignment, each path segment is categorized as either a straight or a turning segment. Distinct heuristic weights are then assigned based on this classification: higher weights are used in straight segments to accelerate the search, whereas lower weights are used in turning segments to preserve path quality.
Because the key jump points extracted from the JPS algorithm lack heading information, a reference heading angle
is computed for each key jump point (excluding the start and goal points), based on the coordinates of its adjacent jump points. The reference heading angle
for the
jump point is calculated as:
where
and
are the coordinates of two adjacent jump points, respectively.
To classify path segments and assign appropriate heuristic weights, both the heading angle difference and axial alignment are evaluated for all pairs of adjacent key jump points, including the start and goal points. A path segment between two consecutive jump points and is classified as a turning segment if either of the following conditions is met:
- (1)
The absolute difference between their reference heading angles exceeds a predefined threshold ;
- (2)
The two points are not aligned along the same axis (i.e., they are not directionally collinear).
Otherwise, the segment is classified as a straight segment. The heuristic weight
for each segment is assigned accordingly:
These parameters were empirically tuned through multiple preliminary simulations to balance path smoothness and computational efficiency, and the same values were consistently used across all experiments.
represents the threshold for heading angle difference used to distinguish between straight and turning segments.
represents the heuristic weight for straight segments.
represents the heuristic weight for turning segments.
represents the upper bound for the heuristic weight applied to straight segments.
represents the reference heading angle corresponding to jump point .
represents the difference in the reference heading angles between two adjacent key jump points .
2.6. Cost Function
In the conventional Hybrid A-star algorithm, the total cost function
comprises two parts: the accumulated cost
and the heuristic cost
. The total cost is expressed as:
The heuristic cost estimates the distance from the current node to the goal. It is typically computed using two different methods, and the maximum of the two is selected as the final heuristic value:
The Reeds–Shepp path length , which accounts for vehicle kinematic constraints but does not consider obstacles;
The A-star algorithm path length , which considers static obstacles but ignores the vehicle’s nonholonomic constraints.
Thus, the conventional heuristic function is defined as:
However, in structured environments such as greenhouses, where wide open spaces are absent, a heuristic focused solely on obstacle avoidance often delivers superior performance. Therefore, in this study, we discard the
term and adopt only the obstacle-aware heuristic. Additionally, a segment-based heuristic weighting mechanism is applied according to the path segment classification introduced earlier. The final heuristic function is expressed as:
To better capture the frequency and intensity of steering adjustments during vehicle path tracking, we refine the accumulated cost function
by incorporating both the cumulative steering angle change and a directional guidance penalty. The enhanced accumulated cost is expressed as:
These parameters were empirically tuned through multiple preliminary simulations to balance path smoothness and computational efficiency, and the same values were consistently used across all experiments.
denotes the set expansion step length;
denotes the total change in front wheel steering angles across all steps;
denotes the cumulative heading deviation from the reference heading angle of the corresponding key jump point ;
denotes the steering control input at step i;
is the actual heading angle of the vehicle at step i;
is the reference heading angle corresponding to key jump point ;
denotes the accumulated cost at the child node;
denotes the accumulated cost at the parent node;
, , and are weighting coefficients controlling the contributions of path length, steering effort, and directional penalty, respectively.
2.7. Simulation Setup
The proposed Hybrid A-star algorithm was implemented and evaluated using MATLAB R2020a. All simulations were performed on a laptop computer with the following specifications: AMD R7-7840H CPU, 16 GB RAM, and an NVIDIA GeForce RTX 4060 (8 GB GPU). The test environment consisted of a 50 m × 50 m structured map populated with several elongated U-shaped obstacles, with a grid resolution of 1 m. To evaluate the effect of the segment threshold on the proposed path planning algorithm, a single-factor analysis was conducted. The influence of different threshold settings on planned path length, sum of steering angle changes, computational time, and expanded node count was examined.
Experiments were performed using the Dy–DG–Hybrid A-Star algorithm under Map Setup 2. For each segment threshold configuration, five repeated simulations were carried out, and the average values were used for analysis, as summarized in
Table 1. The results demonstrate that as the segment threshold increases, the planned path length, sum of steering angle changes, and expanded node count remain nearly constant. However, the computational time exhibits a slight nonlinear trend, first decreasing and then increasing marginally. Based on the results in
Table 1, when the segment threshold is set between 10° and 15°, the computational time reaches its minimum, indicating that this range achieves a balanced trade-off between search efficiency and computational stability.
To assess the effectiveness of the proposed method, three path planning algorithms were compared: Standard Hybrid A-star [
26]; Direction-Guided Hybrid A-star (DG–Hybrid A-star), which incorporates directional guidance based on JPS key points; and Direction-Guided and Dynamically Weighted Hybrid A-star (Dy–DG–Hybrid A-star), which integrates both directional guidance and segment-based heuristic weighting. The experimental parameters of the path planning platform are shown in
Table 2.
3. Results and Discussion
Each algorithm was evaluated under two simulation configurations. Setup 1 and setup 2 used the same map and identical starting positions but differed in their goal locations. The path length was computed by discretizing the final path obtained through backtracking, using a fixed interval of 0.1 m, and summing the Euclidean distances between consecutive points.
Table 3 presents the planned path lengths, cumulative steering angle changes, computational times, and the number of expanded nodes for each algorithm under the two simulation setups.
The planned paths generated by the JPS algorithm for setup 1 and setup 2 are illustrated in
Figure 8.
Figure 8a presents the JPS planning result for setup 1, and
Figure 8b presents the corresponding planning result for setup 2.
In setup 1, the planned path lengths of the Hybrid A-star algorithm, DG–Hybrid A-star algorithm, and Dy–DG–Hybrid A-star algorithm were all approximately 15.9 m, indicating that the path lengths remained essentially consistent across all three methods. The cumulative steering angles for the Hybrid A-star, DG–Hybrid A-star, and Dy–DG–Hybrid A-star algorithms were 6.12 radians, 4.20 radians, and 4.20 radians, respectively. Compared to the standard Hybrid A-star, both the DG–Hybrid A-star and the Dy–DG–Hybrid A-star algorithms reduced the cumulative steering angle by 31.37%. The computational times for the Hybrid A-star, DG–Hybrid A-star, and Dy–DG–Hybrid A-star algorithms are 1.80 s, 1.21 s, and 1.12 s, respectively. Compared to the Hybrid A-star algorithm, the computational times of the DG–Hybrid A-star and Dy–DG–Hybrid A-star algorithms are reduced by 32.78% and 37.78%, respectively. The number of expanded nodes for the Hybrid A-star, DG–Hybrid A-star, and Dy–DG–Hybrid A-star algorithms was 119, 109, and 103, respectively. Compared to the Hybrid A-star, the number of expanded nodes for the DG–Hybrid A-star and Dy–DG–Hybrid A-star algorithms was reduced by 8.4% and 13.45%, respectively.
The planned paths under setup 1 for the three algorithms are shown in
Figure 9.
Figure 9a–c present the results of the standard Hybrid A-star, DG–Hybrid A-star, and Dy–DG–Hybrid A-star algorithms, respectively. In
Figure 9, the red dots are the starting points, the green dots are the goal points, the blue solid lines represent the planned paths, and the yellow dots represent the key jump points. The green circles in
Figure 9a represent the parking area, while the red circles in
Figure 9b,c represent the tolerance radius. The parking criteria of all algorithms are consistent.
To further assess the practical performance of the algorithms under varying conditions, simulations were also conducted using setup 2. In setup 2, the planned path lengths for the Hybrid A-star, DG–Hybrid A-star, and Dy–DG–Hybrid A-star algorithms are all 30.3 m, remaining largely unchanged; The cumulative steering angles for the Hybrid A-star, DG–Hybrid A-star, and Dy–DG–Hybrid A-star algorithms are 8.04 radians, 5.76 radians, and 5.28 radians, respectively. Compared to the Hybrid A-star algorithm, the cumulative steering angles of the DG–Hybrid A-star and Dy–DG–Hybrid A-star algorithms are reduced by 28.36% and 34.33%, respectively. The computational times for the Hybrid A-star, DG–Hybrid A-star, and Dy–DG–Hybrid A-star algorithms are 182.98 s, 2.85 s, and 2.26 s, respectively. Compared to the Hybrid A-star algorithm, the computational times for the DG–Hybrid A-star and Dy–DG–Hybrid A-star algorithms are reduced by 98.44% and 98.76%, respectively. The number of expanded nodes for the Hybrid A-star, DG–Hybrid A-star, and Dy–DG–Hybrid A-star algorithms was 2324, 206, and 177, respectively. Compared to the Hybrid A-star algorithm, the number of expanded nodes for the DG–Hybrid A-star and Dy–DG–Hybrid A-star algorithms was reduced by 91.14% and 92.38%, respectively.
The planned paths under setup 2 for the three algorithms are presented in
Figure 10.
Figure 10a–c present the paths generated by the standard Hybrid A-star, DG–Hybrid A-star, and Dy–DG–Hybrid A-star algorithms, respectively. The visual elements in
Figure 10 follow the same definitions as in
Figure 9.
By comparing the path length, cumulative steering angle, computation time, and number of expanded nodes under setup 1 and setup 2, several key conclusions can be drawn. Compared to the original Hybrid A-star algorithm, the proposed DG–Hybrid A-star algorithm significantly reduces redundant node expansions, particularly around U-shaped obstacles, while maintaining a consistent path length. Specifically, DG–Hybrid A-star reduces the cumulative steering angle by 31.37%, computation time by 32.78%, and the number of expanded nodes by 8.4%. In addition, the Dy–DG–Hybrid A-star algorithm, which incorporates segmented heuristic weighting, offers further improvements—reducing computation time by 5% and node expansion by 5.04% compared to the DG–Hybrid A-star.
To more effectively illustrate the comparative performance of key evaluation metrics across the algorithms, both the absolute values and relative improvement rates are illustrated in
Figure 11 and
Figure 12, respectively. In
Figure 11, Dg-H-A represents the DG–Hybrid A-star algorithm, and Dy-Dg-H-A represents the Dy–DG–Hybrid A-star algorithms. In
Figure 12a, Dg-H-A improvement represents the improvement rates of the DG–Hybrid A-Star algorithm compared to the Hybrid A-Star algorithm. In
Figure 12a, the Dy-Dg-H-A improvement represents the improvement rates of the Dy–DG–Hybrid A-Star algorithm compared to the Hybrid A-Star algorithm. Notably, in
Figure 12, as all algorithms produce identical path lengths, only the improvements in the remaining three metrics are evaluated for comparison. The Dy–DG–Hybrid A-star algorithm consistently achieves better performance than the other two methods in terms of steering smoothness, planning efficiency, and search efficiency. In the case of long-distance path planning under setup 2, the DG–Hybrid A-star and Dy–DG–Hybrid A-star algorithms reduce computation time by 98.44% and 98.76%, and the number of expanded nodes by 91.14% and 92.38%, respectively, highlighting the enhanced scalability of the proposed approach.
To further investigate the performance of the proposed algorithm in complex environments and verify its feasibility and stability under realistic conditions, additional obstacles were introduced into the original map to create a more challenging scenario. For this environment, the path planning results of the Standard Hybrid A-Star algorithm, JPS algorithm, DG–Hybrid A-Star algorithm, and Dy–DG–Hybrid A-Star algorithm are summarized in
Table 4.
As shown in the results, the DG–Hybrid A-Star algorithm significantly reduces computational time, cumulative steering angle change, and the number of expanded nodes compared with the standard Hybrid A-Star algorithm. Furthermore, the Dy–DG–Hybrid A-Star algorithm, building upon DG–Hybrid A-Star, achieves further reductions in computation time and node expansion. However, a slight increase in the cumulative steering angle change is observed.
This increase is likely due to the frequent switching of dynamic heuristic coefficients during turning-intensive segments, which may cause some intermediate node expansions to be skipped, resulting in a larger overall steering angle accumulation.
To evaluate the path planning performance of different algorithms in complex environments, four methods were tested under the same obstacle configuration: the Standard Hybrid A-Star algorithm
Figure 13a, the DG–Hybrid A-Star algorithm
Figure 13b, and the Dy–DG–Hybrid A-Star algorithm
Figure 13c.