HALo:Hilbert-space Active Localizability
for Scalar Field Navigation

Anonymous Authors

TLDR A Hilbert-space accelerated method for computing full-rank Fisher information for scalar field navigation.

Overview

This paper presents Hilbert-space Active Localizability, a method that uses the reduced-rank Hilbert-space GP to calculate an efficient proxy for a full-rank Fisher information matrix. The method uses the eigen basis to create an addition to the canonical FIM to recover the full-rank FIM.

The following are the list of contributions of this paper in brief:

  1. Closed-form Hessian basis for Hilbert-space predicted scalar fields: We derive the exact Hessian of a Hilbert-space Gaussian process posterior mean in closed form via the eigenbasis's second-order derivative, extending the closed form gradient computation to full second-order structure.
  2. Rank recovery for scalar-field Fisher information: While the Fisher information indicates localizability, in scalar fields it remains rank deficient due to directional constraints. We recover the rank via a curvature augmentation using eigenbasis Hessian computations.
  3. MPPI-based validation of curvature-augmented localizability: We demonstrate that contributions (1) and (2) make a tractable embedding of the localizability in an MPPI without per-rollout gradient computations, showing improved localization performance.
An overview video is given below:

Mechanism

A GP defines the measurement model, where $z$ is corrupted by zero-mean Gaussian noise, the FIM can be written as: $$ I_\mathbf{x}(z) = \frac{1}{\sigma^2}J_\mathbf{x} J_\mathbf{x}^\top, ~J_\mathbf{x} = \frac{\partial \mathbf{z}}{\partial \mathbf{x}} $$ This measure in general is considered rank-deficient due to the directional constraints on the scalar field.

To address this we build a Hessian additive term to recover the full rank FIM. $$ H(\mathbf{x}) = \sum_j w_j\, H_j(\mathbf{x}), \qquad [H_j(\mathbf{x})]_{kl} = \frac{\partial^2\phi_j}{\partial x_k\partial x_l}(\mathbf{x}) $$ which gives the exact Hessian of the posterior mean at any query point, in closed form, consistent with the gradient and value computations above using the eigenbasis, providing efficient $\mathcal{O}(Pmd^2)$ computations per rollout after an initial $O(m^3)$ computation.

The Hessian is used to compute the full rank FIM and in turn a localizability term that penalizes information poor regions of the scalar field.

$$ I(\mathbf{x}) = \mathbb{E}[I_\mathbf{x}] + \gamma\, H(\mathbf{x})H(\mathbf{x})^\top $$

where $\gamma$ absorbs the patch second-moment scale $M$. The scalar localizability score used by the planner is the smallest eigenvalue of $I(\mathbf{x})$, corresponding to the worst-constrained direction under the Cram\'er-Rao bound:

$$ \ell(\mathbf{x}) = \lambda_{\min}\big(I(\mathbf{x})\big) $$

Results

We explore the impact of HALo on the scalar field navigation task. We have two different experiments run, (1) simulation results, where we test the feasability and usefulness of the proposed mechanism, and (2) tests and comparisons on a real scalar field.

Simulation Results

The simulation results are compared on a synthetic map with $n=10$ trials traversing across the field. The scalar field has a single high intensity region.


Increasing the localizability weight in simulation steers the robot toward informative regions of the field, cutting average localization error by up to 3x (1.18 → 0.38 RMSE) and improving goal-reaching success from 70% to 90%, with no loss of consistency across trials.

Real Scalar Field Experiment

The framework was compared head to head on two other SoTA architectures. (i) InfoMagNav, (ii) E-RRT, (iii) InfoGainGreedy, (iv) MPPI-Baseline, and (v) Rank Deficient FIM.

Method N RMSE$_{\text{avg}}$ (m) RMSE$_{\text{final}}$ (m) Path Eff.
E-RRT 5 $0.623 \pm 0.305$ $1.078 \pm 0.648$ $0.741 \pm 0.084$
InfoGainGreedy 4 $0.681 \pm 0.248$ $1.605 \pm 0.639$ $0.988 \pm 0.006$
InfoMagNav 5 $0.350 \pm 0.110$ $0.534 \pm 0.320$ $0.991 \pm 0.005$
MPPI 5 $0.108 \pm 0.021$ $0.078 \pm 0.048$ $0.918 \pm 0.079$
MPPI+FIM 5 $0.117 \pm 0.017$ $0.145 \pm 0.085$ $0.911 \pm 0.054$
HALo 5 $0.085 \pm 0.017$ $0.059 \pm 0.030$ $0.928 \pm 0.071$

On a real magnetic anomaly field, HALo delivered the lowest localization error of any method tested (0.085 m average RMSE) while staying path-efficient — outperforming entropy-based, greedy, and standard Fisher-information baselines.

Conclusions and Limitations

HALo solves the rank-deficiency problem in scalar-field localization by deriving a closed-form curvature correction to the Fisher information field, embedding it in an MPPI planner without added computational cost. It improves localization accuracy and reliability in both simulation and on a real magnetic field. Open questions remain around adapting to locally complex regions of the field, capturing global (not just local) ambiguity, and validating the full pipeline on physical hardware in real time.

This website was inspired by TILTED