Table of Contents
Fetching ...

GRL-SNAM: Geometric Reinforcement Learning with Path Differential Hamiltonians for Simultaneous Navigation and Mapping in Unknown Environments

Aditya Sai Ellendula, Yi Wang, Minh Nguyen, Chandrajit Bajaj

TL;DR

GRL-SNAM addresses the Simultaneous Navigation and Mapping (SNAM) problem by introducing a geometric reinforcement learning framework that learns to shape a reduced Hamiltonian over a shared energy landscape using only local observations. It decomposes navigation, sensing, and deformation into three modular policies whose interactions are governed by energy terms that are adapted online via QoIs, enabling stable forward-rollouts without constructing global maps. The method combines offline learning of energy components with online, stagewise adaptation, achieving high navigation quality with minimal mapping effort in deformable-ring and dungeon navigation tasks, and outperforming both classical planners and standard deep RL baselines under identical sensing constraints. The key findings show interpretable energy-field behavior, robust adaptation to perturbations, and strong transfer to unseen layouts, suggesting that physics-informed Hamiltonian supervision offers a practical, data-efficient alternative to reward-centric policy learning for SNAM. Overall, GRL-SNAM demonstrates that embedding geometric priors and online energy reshaping into RL yields efficient, safe, and scalable navigation in unknown environments.

Abstract

We present GRL-SNAM, a geometric reinforcement learning framework for Simultaneous Navigation and Mapping(SNAM) in unknown environments. A SNAM problem is challenging as it needs to design hierarchical or joint policies of multiple agents that control the movement of a real-life robot towards the goal in mapless environment, i.e. an environment where the map of the environment is not available apriori, and needs to be acquired through sensors. The sensors are invoked from the path learner, i.e. navigator, through active query responses to sensory agents, and along the motion path. GRL-SNAM differs from preemptive navigation algorithms and other reinforcement learning methods by relying exclusively on local sensory observations without constructing a global map. Our approach formulates path navigation and mapping as a dynamic shortest path search and discovery process using controlled Hamiltonian optimization: sensory inputs are translated into local energy landscapes that encode reachability, obstacle barriers, and deformation constraints, while policies for sensing, planning, and reconfiguration evolve stagewise via updating Hamiltonians. A reduced Hamiltonian serves as an adaptive score function, updating kinetic/potential terms, embedding barrier constraints, and continuously refining trajectories as new local information arrives. We evaluate GRL-SNAM on two different 2D navigation tasks. Comparing against local reactive baselines and global policy learning references under identical stagewise sensing constraints, it preserves clearance, generalizes to unseen layouts, and demonstrates that Geometric RL learning via updating Hamiltonians enables high-quality navigation through minimal exploration via local energy refinement rather than extensive global mapping. The code is publicly available on \href{https://github.com/CVC-Lab/GRL-SNAM}{Github}.

GRL-SNAM: Geometric Reinforcement Learning with Path Differential Hamiltonians for Simultaneous Navigation and Mapping in Unknown Environments

TL;DR

GRL-SNAM addresses the Simultaneous Navigation and Mapping (SNAM) problem by introducing a geometric reinforcement learning framework that learns to shape a reduced Hamiltonian over a shared energy landscape using only local observations. It decomposes navigation, sensing, and deformation into three modular policies whose interactions are governed by energy terms that are adapted online via QoIs, enabling stable forward-rollouts without constructing global maps. The method combines offline learning of energy components with online, stagewise adaptation, achieving high navigation quality with minimal mapping effort in deformable-ring and dungeon navigation tasks, and outperforming both classical planners and standard deep RL baselines under identical sensing constraints. The key findings show interpretable energy-field behavior, robust adaptation to perturbations, and strong transfer to unseen layouts, suggesting that physics-informed Hamiltonian supervision offers a practical, data-efficient alternative to reward-centric policy learning for SNAM. Overall, GRL-SNAM demonstrates that embedding geometric priors and online energy reshaping into RL yields efficient, safe, and scalable navigation in unknown environments.

Abstract

We present GRL-SNAM, a geometric reinforcement learning framework for Simultaneous Navigation and Mapping(SNAM) in unknown environments. A SNAM problem is challenging as it needs to design hierarchical or joint policies of multiple agents that control the movement of a real-life robot towards the goal in mapless environment, i.e. an environment where the map of the environment is not available apriori, and needs to be acquired through sensors. The sensors are invoked from the path learner, i.e. navigator, through active query responses to sensory agents, and along the motion path. GRL-SNAM differs from preemptive navigation algorithms and other reinforcement learning methods by relying exclusively on local sensory observations without constructing a global map. Our approach formulates path navigation and mapping as a dynamic shortest path search and discovery process using controlled Hamiltonian optimization: sensory inputs are translated into local energy landscapes that encode reachability, obstacle barriers, and deformation constraints, while policies for sensing, planning, and reconfiguration evolve stagewise via updating Hamiltonians. A reduced Hamiltonian serves as an adaptive score function, updating kinetic/potential terms, embedding barrier constraints, and continuously refining trajectories as new local information arrives. We evaluate GRL-SNAM on two different 2D navigation tasks. Comparing against local reactive baselines and global policy learning references under identical stagewise sensing constraints, it preserves clearance, generalizes to unseen layouts, and demonstrates that Geometric RL learning via updating Hamiltonians enables high-quality navigation through minimal exploration via local energy refinement rather than extensive global mapping. The code is publicly available on \href{https://github.com/CVC-Lab/GRL-SNAM}{Github}.
Paper Structure (156 sections, 15 theorems, 126 equations, 17 figures, 6 tables, 3 algorithms)

This paper contains 156 sections, 15 theorems, 126 equations, 17 figures, 6 tables, 3 algorithms.

Key Result

Lemma 3.1

Consider eq:motion:planning:continuous:original:form and assume: (i) control-affine dynamics $v(\boldsymbol q,\boldsymbol u,t;\mathcal{E})=f(\boldsymbol q;\mathcal{E})+A(\boldsymbol q;\mathcal{E})\,u$, (ii) separable running cost $L(\boldsymbol q,\boldsymbol u,t;\mathcal{E})=\ell(\boldsymbol q;\math the optimality conditions can be written (in measure form) as In particular, on interior intervals

Figures (17)

  • Figure 1: Fixed policy vs. online adaptation in dungeon navigation. We display global time step, collision count, and remaining goal distance on top--left of a navigation process under a mapless environment; the inset shows the local sensed view used for decision-making. Top: a fixed RL controller executes a fixed behavior and fails by colliding / entering a collision loop as the local obstacle geometry changes. Bottom: our method performs online correction by adjusting its motion field using only short-horizon feedback (clearance, distance-to-goal, and speed) to avoid obstacles and keep making progress, ultimately reaching the global goal.
  • Figure 2: GRL-SNAM rollout on a cluttered layout (representative episode). Snapshots are ordered left-to-right within each row, with time increasing across rows. Row 1: initialization ($t{=}1$) and early corridor commitment ($t{=}295$), followed by bottleneck entry ($t{=}592$). Row 2:squeeze-through of the narrow passage ($t{=}721$), recovery/re-centering ($t{=}889$), and final approach to the goal ($t{=}1177$). Row 3: successful arrival ($t{=}1354$) and the full-trajectory overlay. Circular stage markers () denote the active hierarchical planning stage selected by the navigator at that snapshot.
  • Figure 3: Comparison between standard RL offline/online adaptation and our physics-grounded approach. Standard methods learn arbitrary policies and struggle with transfer, while our approach learns physically meaningful Hamiltonians that naturally adapt to environmental variations.
  • Figure 4: Conceptual overview: progressive energy-landscape shaping from local sensing.Left: the physical workspace is initially unknown and is revealed only through local sensing around the agent, producing a partial view of nearby obstacles and a stage goal. Right: from this partial context, the agent builds an initial internal “energy terrain” and then repeatedly attempts a short plan toward the stage goal; each attempt produces simple feedback (e.g., collisions/clearance and progress), which is used to refine the terrain. Over successive refinements, the terrain becomes smoother and its low-energy valleys align with traversable corridors, guiding future attempts even under partial observability.
  • Figure 5: Policy-aligned energy decomposition in GRL--SNAM. The sensor policy exposes a sensor configuration cost $E_{\mathrm{sensor}}$, the frame policy induces goal attraction $E_{\mathrm{goal}}$, and the shape policy contributes deformation energy $E_{\mathrm{obj}}$, while all modules share collision barrier terms $b(d_i)$ around active constraints $\mathcal{C}_t$. A meta-policy $g_\xi$ assigns weights $(\beta,\lambda,\{\alpha_i\})$ to these components to form the surrogate potential $\mathcal{R}(q;\eta_\xi^t,\mathcal{E}) = E_{\mathrm{sensor}} + \beta^t E_{\mathrm{goal}} + \lambda^t E_{\mathrm{obj}} + \sum_{i\in\mathcal{C}_t} \alpha_i^t b(d_i)$ used in the Hamiltonian dynamics.
  • ...and 12 more figures

Theorems & Definitions (25)

  • Lemma 3.1
  • Proposition 3.2: Barrier relaxation converges to the state-constrained OCP (log-barrier)
  • proof
  • Lemma A.1: Forward: autonomous pure state constraints induce a (reduced) Hamiltonian flow
  • proof
  • Corollary A.2: Reduced Hamiltonian via a quadratic control penalty
  • proof
  • Proposition A.3: Barrier relaxation $\mu\downarrow 0$ yields a state-constrained limit
  • proof
  • Corollary A.4: IPC barrier inherits the log-barrier limit (primal) and contact-measure form (dual)
  • ...and 15 more