pub fn astar_torus(
grid: &JointSpaceGrid,
start: GridCell,
goal: GridCell,
) -> Option<ArmPath>Expand description
Performs A* search on a toroidal joint-space grid.
The grid wraps around in both dimensions (since joint angles are periodic).
Returns Some(ArmPath) if a route is found, None otherwise.