RAMBA: 4D Radar Mapping by Bundle Adjustment

Jianzhu Huai 1, Yiwen Chen 1, Binliang Wang 1 · 2026

Read RAMBA: 4D Radar Mapping by Bundle Adjustment by Jianzhu Huai 1, Yiwen Chen 1, Binliang Wang 1 (2026) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2605-25041.txt.

Introduction

Jianzhu Huai, Yiwen Chen, and Binliang Wang present RAMBA, a bundle method for fully matching mapping with 4D radar. From poses and frames of a radar-inertial odometry front end, RAMBA jointly refines frame states. It uses spread-weighted errors, motion preintegration factors, and ego-motion constraints. Time matching plus loop closure guard against drift and returns. On ColoRadar and SNAIL Radar data, RAMBA sharpens maps. It usually beats radar-inertial odometry and pose-graph rivals on path accuracy.

Catalog record

CREATORJianzhu Huai 1, Yiwen Chen 1, Binliang Wang 1
YEAR2026
COLLECTIONPAPERS
FORMATTXT
FILE SIZE18600
LICENSEhttp://creativecommons.org/licenses/by-sa/4.0/
RIGHTSCC BY SA
SOURCEarXiv

Source: https://arxiv.org/abs/2605.25041

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

RAMBA: 4D Radar Mapping by Bundle Adjustment Jianzhu Huai 1, Yiwen Chen 1, Binliang Wang 1 Abstract 4D radar is increasingly attractive for robotic mapping because it provides range, azimuth, elevation, and Doppler measurements while remaining robust in adverse visibility conditions. Although recent radar and radar–inertial odometry methods have achieved promising online state estimation performance, offline global map refinement for 4D radar remains underexplored. This paper presents RAMBA , a radar bundle-adjustment framework for globally consistent 4D radar mapping. Given initial poses and radar frames from a radar–inertial odometry front-end, RAMBA jointly refines radar frame states using covariance-weighted geometric residuals, IMU preintegration factors, and radar ego-velocity constraints. The geometric residuals extend pairwise GICP to a multi-frame optimization by forming voxel-based correspondences across selected frames and weighting each residual with point covariances. To improve robustness against drift and revisits, RAMBA enforces temporal consistency during correspondence formation while explicitly supporting loop-closure constraints. Experiments on the ColoRadar and SNAIL Radar datasets show that RAMBA improves map consistency and usually enhances trajectory accuracy over radar–inertial odometry and pose-graph optimization baselines. keywords 4D Radar Mapping, Bundle Adjustment, Generalized Iterative Closest Point 1 Introduction 4D radars have attracted increasing interest for robotic perception because they remain effective in adverse conditions such as darkness, dust, smoke, rain, and fog. Compared with conventional automotive radars that mainly provide planar coordinates and relative Doppler velocity, modern 4D radars also sense elevation, which makes them more suitable for geometric odometry and mapping. Recent studies have shown strong progress in radar odometry and radar–inertial state estimation [ 2 , 15 ] . Learning-based radar mapping has also been investigated [ 11 ] . However, most existing radar methods focus on online pose estimation or learned scene reconstruction. In contrast, offline map refinement for radar remains largely unexplored, even though analogous LiDAR problems have benefited substantially from global optimization methods such as [ 13 , 8 ] . In this paper, we propose RAMBA , an offline 4D radar mapping framework based on bundle adjustment. Starting from initial poses and radar frames produced by a radar–inertial odometry front-end, we refine the radar frame states to improve global mapping consistency, measured by covariance-weighted point-to-point distances. In essence, our method extends pairwise generalized iterative closest point (GICP) to the multi-frame setting. Candidate correspondences are formed within voxels of a voxel grid built from all selected frames, and each residual is weighted by the sum of the two point covariances. The geometric constraints are jointly optimized with IMU preintegration and radar ego-velocity constraints. To reduce false associations caused by drift and revisits, RAMBA enforces temporal consistency when forming correspondences and explicitly allows constraints around loop closures. We evaluate the method on the ColoRadar and SNAIL Radar datasets. The proposed refinement consistently improves map quality and usually improves trajectory accuracy over the initial radar–inertial odometry and pose graph optimization. To the best of our knowledge, this is the first geometric offline bundle-adjustment framework for consistent 4D radar mapping. 1.1 Related Work Radar odometry and radar–inertial estimation have advanced rapidly in recent years [ 2 , 14 , 10 , 15 ] . These methods provide promisingly accurate pose estimates in real time, but the resulting maps can still suffer from accumulated drift and revisit inconsistency. For spinning radars, DR-BA [ 9 ] refines mapping consistency by making all overlapping radar intensities agree in the same map frame. For single-chip 4D radars, learning-based radar mapping method [ 11 ] addresses radar map densification but uses the ground truth trajectory. In the LiDAR domain, offline trajectory and map refinement have been studied extensively. Representative examples include graph-based and bundle-adjustment-based methods [ 7 , 13 , 4 , 8 ] . These methods demonstrate the value of jointly refining multiple frames using geometric constraints. However, transferring them directly to radar is not straightforward, because radar points are substantially noisier and often do not support reliable normal estimation. As a result, surfel constraints such as those in [ 8 ] and point-to-plane constraints such as those in [ 13 ] are less suitable for radar mapping. Our method is most closely related in spirit to LiDAR bundle adjustment [ 13 ] , but differs in several important aspects. First, we use covariance-weighted point-to-point distances like [ 5 ] rather than point-to-plane distances, which are better suited to the noisy range measurements of radar frames. Second, we construct constraints from all valid point pairs collected in a world-frame voxel grid, rather than matching each keyframe only to a local submap, since radar point clouds are typically much sparser than LiDAR point clouds. Third, we operate only on stationary radar points filtered by the front-end GNC process, which helps suppress dynamic clutter by exploiting the Doppler information naturally available in radar measurements. 1.2 Overview of the Proposed Method The inputs to RAMBA are the initial states and undistorted radar frames from a radar–inertial odometry front-end, e.g., 4D iRIOM [ 15 ] . We first select keyframes according to overlap and detect loop candidates using PointNetVLAD [ 1 ] . Verified loop closures are then used to guide offline refinement. For each keyframe, we first estimate point covariances using a voxel grid built from its temporal neighborhood. For computational simplicity, only the diagonal entries of the covariance matrices are retained. We then construct point-to-point constraints for mapping using the current keyframe states and a world-frame voxel grid. Finally, we optimize the keyframe poses, world-frame velocities, and IMU biases by jointly minimizing the voxel-based generalized point-to-point cost, IMU preintegration residuals, and ego-velocity residuals. After keyframe optimization, we recover all frame poses by pose graph optimization using the optimized keyframe constraints together with adjacent-frame relative pose constraints. 2 Method 2.1 Keyframe Selection and Loop Verification Before offline optimization, we run a radar–inertial odometry front-end and retain only stationary radar points using the GNC-based filtering already available in the front-end. We then select keyframes based on overlap. A sliding-window map is built from the most recent 21 keyframes and represented by a voxel grid. A new frame is promoted to a keyframe when its overlap with the current sliding-window map falls below a threshold. In our experiments, we use a threshold of 0.6 for SNAIL Radar and 0.5 for ColoRadar. For each keyframe, we aggregate its 21-frame temporal neighborhood and build a local voxel grid for covariance estimation. Each point is assigned a covariance \mathbf{C}_{f_{ij}} computed from the points in its corresponding voxel. To simplify computation, we retain only the diagonal entries and denote the resulting diagonal covariance again by \mathbf{C}_{f_{ij}} . The corresponding world-frame covariance is \mathbf{C}_{ij}=\mathbf{R}_{WB,j}\mathbf{C}_{f_{ij}}\mathbf{R}_{WB,j}^{\top}. (1) Loop candidates are detected by PointNetVLAD [ 1 ] and verified by a local GICP alignment. Specifically, we build two 5-frame submaps centered at the query frame and the candidate loop frame, respectively. Each point is assigned the covariance of its voxel in the corresponding submap, and the relative pose is refined using covariance-weighted point-to-point constraints. Only verified loop closures are retained. The voxel size used in the associated voxel-grid operations is 0.12 m on ColoRadar and 0.5 m on SNAIL Radar. 2.2 Voxel-Based Feature Association Let the optimized state of keyframe j be \mathbf{x}_{j}=\left(\mathbf{R}_{WB,j},\mathbf{t}_{WB,j},\mathbf{v}_{j}^{W},\mathbf{b}_{g,j},\mathbf{b}_{a,j}\right), (2) where \mathbf{R}_{WB,j} and \mathbf{t}_{WB,j} denote the pose of the IMU/body frame

Read the complete text