Bidirectional Incremental Generalized Hybrid A* (Bi-IGHA*)

Preprint
1University of Washington, 2Technion–Israel Institute of Technology
Structurally efficient anytime planning in continuous spaces
Overview video for Bi-IGHA*.

Abstract

Similar to our prior work on IGHA*, we focus on efficient anytime kinodynamic planning for systems with complex dynamics in unstructured environments where precomputing motion primitives is infeasible. While IGHA* was motivated by the need to decouple how the tree is searched with what tree is being searched over, it remains susceptible to accidental freezing of vertices that are needed to reach the goal. For example, Fig.1 shows an example of IGHA* vs Bi-IGHA* on a Reeds–Shepp style goal in (x, y, θ). On a Reeds–Shepp style goal in (x, y, θ), IGHA* misses the true goal test in the full space by freezing a critical vertex, wasting expansions, and forcing resolution refinement. While classical bidirectional search is typically motivated by reduced effective search depth, our key insight is that Bi-IGHA* additionally benefits from a mitigation of the frozen vertex barrier through near-meets. Bi-IGHA* preserves the core guarantees of IGHA*, including monotonic improvement of solution cost and termination with the best path, while delivering significant speedup on benchmarks.

Animated comparison: IGHA* vs Bi-IGHA* motivating anecdote
Figure 1. IGHA* vs Bi-IGHA* on the motivating example (colors as in the paper: forward expansions, frozen vertices, collisions, backward tree, near-meet, final path). The goal condition uses a Reeds–Shepp distance threshold in (x, y, θ), not just proximity in the plane.

Method overview

Bi-IGHA* instantiates two IGHA* searches that share the current best path cost for branch-and-bound and periodically check for feasible near-meets between the forward and backward trees. When multiple opposing vertices qualify, the implementation selects the meet that minimizes the sum of costs plus the local connection cost. Forward and backward searches can change resolutions independently; if one side terminates, the other continues until its queue is exhausted.

Bi-IGHA* flow diagram
Figure 2. High-level flow: two anti-parallel IGHA* loops with shared bounds and near-meet handling (rasterized from the paper PDF).
The implication of the above is that Bi-IGHA* can achieve the same solution quality as IGHA* at a lower resolution with fewer expansions.

IGHA* at base resolution
IGHA* — base resolution (no solution yet)
Bi-IGHA* at base resolution
Bi-IGHA* — same base resolution (solution found)
IGHA* best solution at finer resolution
IGHA* — best solution after refinement
Bi-IGHA* best solution at lower resolution
Bi-IGHA* — best solution at lower resolution than IGHA*
Figure 3. Same scenario as in the paper: unidirectional vs Bi-IGHA* at matched snapshots (animated).

Results

How does Bi-IGHA* compare to IGHA* on open-loop benchmarks?

We evaluate kinematic (3D), kinodynamic car (4D), and hovercraft (6D) systems across Moving AI and BeamNG-style maps, comparing Bi-IGHA* to forward-only IGHA* and to the faster of forward/reverse IGHA* (“Min”), for both first-solution and best-solution expansion counts. Fig. 7 shows that any Bi-IGHA* variant consistently delivers ~10x speedups over any IGHA* variant. In classical bidirectional search, the gains are typically due to reduced effective search depth as we're burning the candle from both ends. However, we found that the effect of mitigating the frozen vertices is powerful enough such that if compare the expected reduction in branching factor that classical bidirectional search would achieve for IGHA*, against the actual reduction in branching factor that Bi-IGHA* achieves, we see that Bi-IGHA* has a lower effective branching factor (B* > 1 implies greater than expected reduction in branching factor). This is illustrated in Fig. 8.

R3 success
ℝ³ success
R3 cost
ℝ³ cost
R4 success
ℝ⁴ success
R4 cost
ℝ⁴ cost
R6 success
ℝ⁶ success
R6 cost
ℝ⁶ cost
Figure 7. Success rate and cost vs expansions in open loop (Bi-IGHA* vs IGHA* vs SST reference in paper).
Branching factor analysis
Figure 8. Additional analysis of branching / B* behaviour from the paper. B* > 1 implies greater than expected reduction in branching factor.

How does this speed up translate to closed-loop performance?

Using the same MPPI-based closed-loop stack and BeamNG-style benchmarking as the IGHA* paper, Bi-IGHA* achieves similar mission success and cost while tolerating much (4x) smaller expansion budgets—important when planning shares compute with perception and control.

Playback success rate
Playback success
Playback cost
Playback cost
In-the-loop performance
In-the-loop
Qualitative in-simulation comparison: IGHA* vs Bi-IGHA*

Simulation (qualitative) — full width below the metric panels.

Figure 9. Closed-loop metrics (top row): playback-derived budgets and success vs time under matched compute. Below: in-simulation comparison (GIF) at full content width, illustrating starvation / stalling at low expansion limits for unidirectional IGHA* vs continued progress with Bi-IGHA*.

Anecdotes. Full-frame comparison clips (unclipped).

Anecdote 1
Anecdote 2

BibTeX (draft)