WorksComputer Science
Radio-to-Pose Information for Gauge-Drift Correction in Cooperative Localization
Abstract
Cooperative localization uses odometry and inter-robot measurements to estimate the motion of a robot team. These measurements describe only relative geometry, but the team's estimated position and orientation can drift together over time, i.e., gauge drift. In this work, we study correction of this gauge drift using a radio attenuation map registered in the same world coordinate frame used for robot poses. Specifically, we propose Radio-to-Pose Information (RPI), an interface that converts power residuals and their pose derivatives into a Gaussian information matrix and vector pair. RPI builds on the insight that received power is sensitive to shared displacement in the world map. The pose estimator uses the interface together with odometry and inter-robot measurements to update poses and minimize uncertainty. We characterize the shared motions detectable from the map and observed links. For an uncertain shared map, RPI keeps correlations across robots and time and reproduces joint Gaussian pose estimates and covariances. Across simulated Gaussian trials, RPI matches the results of joint estimation. Across 32 paired trials with a registered map, RPI reduces common-position RMSE from m to m in a m arena compared with a baseline that uses radio only to weight relative measurements.
Introduction
To carry out tasks such as exploration, mapping, and environmental monitoring, robot teams rely on coordinated motion and shared observations. When global positioning is unavailable, they can estimate motion through odometry and inter-robot measurements. These observations constrain relative geometry, but the estimated team can move away from its true location as a group. For example, translating every robot estimate by one meter leaves all pairwise distances unchanged. This shared error matters when robots must reach mapped destinations or report observations in world coordinates.
It is also important to precisely estimate uncertainty because the team can know its relative geometry while remaining uncertain about its position in the world. This ambiguity is called gauge freedom. Gauge freedom describes indistinguishable coordinate frames, which in the presence of motion or noise leads to gauge drift. Gauge drift describes the temporal growth of error or uncertainty in these shared-motion directions. Teams construct a reference frame from a prior over their initial poses, but subsequent noisy observations determine how well the team remains localized. For trajectories without a fixed point of reference, common translations and rotations maintain relative observations, but they do not provide useful information about global state.
A radio attenuation map aligned to the world frame can provide a reference because received power depends on both link length and the attenuation field. For example, in Figure 1, a common translation preserves separation and distance loss but changes link attenuation. Using a global attenuation map which captures knowledge of obstacles in the environment can help distinguish the team’s positions by using differences in the received power they observe.
Figure 1. In the left map, when there is no registered attenuation map, equal-length links have identical distance-only predictions. In the right map, when a registered map is present, equal-length links have different power predictions. Colors indicate attenuation in dB/m.
We propose the Radio-to-Pose Information (RPI) interface which leverages this behavior. The RPI is an interface between two components: First, a radio module predicts received power from the current poses and attenuation map, then determines the power mismatch and pose sensitivity as an information matrix and vector. Second, a pose estimator uses this message to compute a correction and its uncertainty.
This paper describes three contributions:
We show that fixed weights on relative measurements add zero direct information about common motion. We characterize which shared motions the attenuation map and observed links can detect.
We propose the Radio-to-Pose Information (RPI) interface, which converts power residuals and pose sensitivity into an information matrix and vector for pose estimation.
We derive centroid covariance growth and a lower bound on mean-squared common-position error under stated motion and measurement assumptions. We evaluate agreement with joint estimation, drift correction, and sensitivity to map error.
Related Work
Cooperative Localization. Relative measurements help robots estimate their positions with respect to one another, but they do not determine the position and orientation of the entire team in the world frame [1], [2]. Gauge fixing chooses a coordinate frame for estimation [3]. Simultaneous localization and mapping (SLAM) adds persistent environmental features and loop closures, which can reduce trajectory drift [4]. However, a map built only from the robot’s own measurements defines position relative to the robot’s chosen coordinate frame rather than an externally registered world frame. Our comparison concerns a cooperative localizer that uses radio to set fixed weights on relative factors.
Radio and Field Maps. Radio tomography estimates spatial attenuation from power measurements and known link positions [5]. Radio SLAM jointly estimates motion and propagation structure using radio observations, including multipath information [6], [7]. Its reference frame depends on the available anchors and priors. Known physical anchors can provide a reference [7], but may not be available. Instead, this paper focuses on studying inter-robot links against a registered attenuation field. This follows the principle of localization against surveyed terrain or magnetic maps [8], [9].
Gaussian Fusion. Factor-graph smoothers combine measurement models and priors through local linearization [4]. Gaussian elimination provides a way to summarize part of this model for another estimator. Distributed smoothing must account for previously shared information when summaries are replaced [10]. Fusion with shared variables must also preserve the induced correlations or use an appropriate conservative approximation [11], [12]. RPI applies these requirements to a radio module whose uncertain map is shared across robots and time. Equivalent radio factors in a factor-graph smoother give the same local Gaussian result when the models and linearizations agree.
Motion and Radio Model Setup
Shared Motion
In the cooperative localization problem, a robot team seeks to estimate each robot’s trajectory in a fixed world frame over an estimation window. Consider robots over a finite set of time steps , called the estimation window, where and are its first and last time steps. Let denote the true pose of robot at time , where is its position and is its heading. Let collect the poses of all robots across the estimation window, representing their trajectories. Each robot estimates its pose using odometry and inter-robot measurements. A centralized server collects these estimates into and solves for the team’s trajectories. Both and contain poses.
In order to represent a gauge drift, a shared rigid transformation rotates every pose by and translates every position by the translation vector , where . Thus, is applied to every pose in , giving and . This shared transformation preserves inter-robot distances, relative poses, and motion expressed in each robot’s own frame.
and motion expressed in each robot’s own frame. Let denote the set of available relative measurements over the estimation window, including relative-position measurements between robots and odometry between consecutive time steps, as shown in Figure 2. Each index identifies one measurement and the number of available measurements is bounded by . For each , let denote the difference between the recorded sensor measurement and the corresponding value predicted using the robot poses in . Since the transformation preserves these predicted values, . A shared translation changes the team’s position in the fixed world frame, while a shared rotation changes its orientation. To determine which shared motions the measurements can detect, we express small translations and rotations as pose perturbations. About an origin , with rotation matrix , a small common translation and rotation produce
Figure 2. This graph represents the robot team at each time step. Solid links represent measurements between robots at the same time, while dashed arrows represent odometry of the same robot across consecutive time steps. Each described compares a recorded measurement with the measurement predicted by the poses.
where describes the shared translation and rotation applied to all robots and time steps. The columns of correspond to the two translation directions and rotation.
Radio Power and Reference
For a radio link between robots and at time , let . The field provides attenuation in dB/m at world location . We predict received power by integrating the field over the spatial domain, weighted by each location’s contribution to the link.
is the reference received power in dBm at distance without mapped attenuation, and is the path loss exponent governing the propagation decrease in received power with distance. The weighting function describes each location ’s contribution to link attenuation, given its position with respect to robot poses. We assume known propagation parameters and Gaussian power noise , where , the radio measurement noise covariance matrix, is independent of the robot poses. The measured power vector , pose Jacobian , and radio information matrix satisfy
where . For a known field, the radio information along a pose perturbation is . By registering the field , we provide a reference in the world frame. If the weights satisfy , transforming the poses to and the map to leaves the predicted powers unchanged. Therefore, estimating the poses and map together cannot determine their absolute position and orientation unless the prior provides a world-frame reference. We provide this reference by setting the map’s position and orientation to the world frame.
Error and Map Information
If gauge drift occurs, the robot team’s collective position (i.e., the centroid) relative to the world map becomes uncertain (§IV-A). We show that while existing techniques based on relative measurements alone cannot solve the gauge drift problem for robot teams (§IV-B), it is possible to use radio field attenuation information from the world map to reduce this source of error (§IV-C).
Team Centroid Error Growth
Relative observations do not measure the motion noise with respect to the centroid; as a result, the team cannot correct common-position drift using this kind of observation. To see why, assume each robot’s heading is known and its position evolves in world coordinates. Then, the position of robot at time step evolves to by , where the process noise , is the displacement given by odometry per time step, and is the motion-noise variance per position coordinate per time step. In this equation, the process noises are independent across robots and time and are independent of the initial state.
Define the team centroid as , where is the number of robots. Assume that is the initial centroid and has covariance . The measurement noise is independent of initial robot positions and process noise.
Averaging the robot dynamics gives , , where and . The average motion noise is independent of the motion noise that changes the robots’ relative positions. The observation history does not reduce uncertainty in or the accumulated centroid noise. Thus,
where denotes the observation history through time . For any estimate based on this history,
Relative Weights
Relative observations improve estimates of the robots’ positions with respect to one another. However, using weighted links alone cannot solve this problem.
If is invariant under the pose transformation , differentiating along a gauge direction gives , where . For the joint pose–map transformation above, the corresponding identity is
The weighted relative information matrix is , where describes nonnegative radio weights and is the indexed measurement noise covariance. Also, from Eq. (1) describes the shared pose motion, and describes the corresponding map change caused by the same translation and rotation.
Proposition 1 (Fixed relative weights). For fixed nonnegative radio weights on invariant relative measurements with covariances ,
Keeping only a subset of the relative factors still provides no information along the gauge directions.
Proof. Each term in the sum is zero, so keeping only some of the factors does not change the result.
The proposition shows that fixed-weight relative measurements provide no direct information about shared translation or rotation. Additional pose information can come from modeling how received radio power depends on the robot poses.
Map and Link Sensitivity
A registered attenuation map can constrain this common motion when shared displacement changes the power predicted for the observed links. Radio sensitivity to shared motion depends on how that motion changes the attenuation sampled by the observed links. Because a shared rigid motion leaves link length unchanged, only the map attenuation term changes the predicted power.
Assume and . Then, substituting ,
where is the spatial variable before applying the rigid transformation . This expresses the attenuation using the original link weights and the field evaluated at the transformed locations. For , differentiating along the shared motion at the identity gives
measures the sensitivity of link ’s predicted power to the shared motion , with a fixed map. Let denote the shared motions satisfying for all . The link sensitivity condition requires every motion that the map reveals outside to produce a nonzero first-order change in at least one observed link’s attenuation integral, despite possible missed variation or cancellation in other links.
Proposition 2 (Detectable shared motion). Let be the set of observed links. With the map and the robots’ relative geometry fixed,
The equality holds under the link sensitivity condition.
Proof. If , everywhere. By Eq. (2), for all links, proving the inclusion. Under the link sensitivity condition, every gives for at least one observed link, establishing equality. ∎
With the map fixed and link weights satisfying , we use Eq. (2) to construct several simple examples of unresolved motion. A constant field has zero spatial gradient, so the radio model cannot detect any shared translation or rotation. If , vertical translation does not change sampled link attenuation. A radial field cannot distinguish rotation about its center. Uncertain field values reduce the information carried by these derivatives. Repeated map patterns can produce the same radio measurements at different team locations. However, the full rank of the shared-motion Jacobian ensures local distinguishability. This means that any small shared translation or rotation of the team changes at least one predicted radio measurement.
RPI Interface
We design RPI using the insight that a radio map aligned to world coordinates can provide a reference for the team’s position. We treat the map’s position and orientation in world coordinates as known. This method accounts for Gaussian uncertainty in its attenuation values as we describe in §V-B. We introduce RPI to pass information from the radio module to the pose estimator, as Figure 3 illustrates.
Figure 3. RPI converts power measurements and map information into for pose estimation. Updated poses feed back to the radio module for relinearization. Revised messages replace previous contributions.
Grid model
We first discretize the attenuation field and compute received power over it. To support nonlinear settings, where the predicted radio power depends nonlinearly on robot positions, we represent the attenuation field by grid values . Within each cell, bilinear interpolation combines its four corner values with weights that sum to one, giving , where denotes the grid spacing and the attenuation value at grid vertex . We then sample this field along each radio link to obtain , the matrix that converts map grid values into attenuation for each link . Attenuation and distance loss use , where .
The vector contains the predicted received powers before mapped attenuation, with entry for each link . is the integration weight of sample along link . We use samples including both endpoints,
with weights
is the spatial weight rise parameter that dictates how fast the weight gradient changes between the mid and endpoints. We set to give nearly uniform weights across the link interior while reducing the endpoint weights. We differentiate the discretized power prediction with respect to the poses at the current estimates, holding the grid values fixed, to obtain the radio pose Jacobian . Then, we differentiate the prediction with respect to the grid values holding the poses fixed, which gives .
Power to Pose Information
We show how the radio module converts received power into an informative pose update. Let denote the map values and their current estimate. At the current pose and map estimates , define the power residual . Assume a map prior , independent of the pose prior, where is the prior map mean and its covariance. Let denote a local pose correction and a map correction. Linearization gives . Then , where . Let denote the pose information matrix and the information vector driving the latest pose correction, both formed from the linearized odometry, relative factors, and pose priors. task refers to the pose-estimation objective before adding radio information. Joint Gaussian estimation solves, with where is the precision matrix that describes how strongly radio prediction errors are penalized in the estimator,
The radio residual is weighted by , and the map-prior deviation by the precision matrix , the inverse of the map-prior covariance. To pass the radio information to a pose-only estimator, define
Eliminating the map correction through the Schur complement of the map information gives the RPI pair
With a known map, we set to its known value, so and . Adding task information gives the Gaussian pose covariance and update
The summed information must be positive definite. For nonlinear iterations, the estimator solves for , updates the poses, and relinearizes.
Proposition 3 (Gaussian pose agreement). With matching factors, priors, weights, coordinates, and linearizations,
Eq. (4)–(5) reproduce the pose mean and covariance obtained by solving Eq. (3) jointly.
Proof. The joint objective is quadratic in . Completing the square in and integrating it leaves plus a constant. The minimizer and covariance are given by Eq. (5).
Shared History
Uncertainty in the shared map can affect pose estimates for multiple robots at different times. RPI therefore combines the radio measurements across robots and time steps before eliminating the map variables. This maintains the cross-robot and cross-time correlations the shared map induces. With respect to Proposition 3, the resulting message gives the exact pose marginal for the Gaussian system.
The pose estimator reconstructs the RPI interface after each relinearization. For robots and time steps, a pose information matrix requires storage. The RPI message contains , the order of the pose variables, and the linearization point.
Evaluation
We evaluate how closely RPI matches joint Gaussian estimation (§VI-B), its ability to correct nonlinear drift (§VI-C), its sensitivity to map error (§VI-D), and the directions constrained by the map (§VI-E).
Methodology
All evaluations generate noisy measurements from known robot trajectories and an attenuation map, then estimate positions with known headings. Methods within each trial share observations and initialization.
For position error , we report common error and relative error , measuring centroid displacement and errors in the team’s relative arrangement, respectively. We evaluate nonlinear RMSE over the final third of each trajectory to emphasize accumulated drift later in the run.
For stacked terminal-position covariance , common uncertainty is , where , . Centroid NEES per coordinate is , with expected value one under a calibrated Gaussian model. Larger values indicate overconfidence. We also evaluate coverage of 95% coordinate intervals in the Gaussian test.
Linear Gaussian Interface Test
We test whether RPI preserves the joint Gaussian pose solution when shared-map correlations affect accuracy. Across 1,000 trials, we record three robots at 12 time steps, giving 72 position coordinates. The measurement Jacobians remain fixed. For this test, we use a simplified map with nine uncertain radio-bias coefficients governed by a spatially correlated Gaussian prior. We set radio, relative-position, and map-coefficient standard deviations to be 0.12 dB, 0.06 m, and 0.25 dB/m, respectively. We vary radio standard deviation from 0.03 to 1.92 dB in the noise-sensitivity experiment.
We consider three configurations: (i) Joint estimates robot positions and one shared map together. (ii) RPI eliminates the map variables and passes their contribution to the pose solver through . (iii) Per-step map assigns an independent map to each time step, preserving within-step correlations but discarding correlations across time.
We expect RPI to outperform Per-step map because it preserves shared-map correlations across time. Similarly, if RPI is a useful abstraction, it would match Joint’s performance. Figure 4 confirms these expectations. RPI and Joint overlap across radio-noise standard deviations from 0.03 to 1.92 dB, with mean terminal centroid error increasing from 0.686 to 0.797 m. As the noise level increases, all three configurations converge to the same pose priors and relative-position measurements.
Figure 4. Gaussian shared-map test over 1,000 paired trials. (a) Mean terminal centroid error versus radio-noise standard deviation. (b) Trajectory and terminal-centroid NEES per coordinate, with nominal value one. (c) Covariance difference relative to Joint. Error bars are 95% intervals from trial means.
Per-step map also underestimates uncertainty. Terminal centroid NEES is 1.890, compared with 1.012 for RPI and Joint, and nominal 95% coordinate coverage falls from approximately 94.7% to 84.88%.
Nonlinear Drift Correction
We test whether RPI reduces common drift while preserving relative accuracy. We simulate four robots moving for 80 steps of 0.5 s and observe all six inter-robot links. Known headings and world-coordinate relative-position measurements leave two common translation directions unconstrained by the relative measurements. We update radio predictions and Jacobians as the estimates change. Methods share relative-factor weights within each map condition, and these weights remain unchanged during optimization.
We compare four methods using the same supplied map, observations, initialization, and fixed relative-factor weights: (i) Scalar uses radio quality only to reweight relative-position factors. (ii) RPI (fixed map) treats the supplied map as exact and adds pose information . (iii) Joint (fixed map) directly adds the nonlinear radio term and optimizes the poses with fixed. (iv) RPI (uncertain map) uses the shared attenuation-value model in Section V.
The uncertain-map method estimates all grid values with a Gaussian prior centered on the supplied map. We use a coefficient standard deviation of 0.25 dB/m and Gaussian spatial correlations with a 3 m length scale. The variance combines an 80% spatially correlated component and a 20% component independent across grid vertices. This covariance remains unchanged across map conditions. We use up to 25 Levenberg–Marquardt iterations, obtaining map increments after each pose update before relinearizing. Terminal uncertainty uses the terminal-position block of the undamped local marginal pose covariance in Eq. (5).
Across 32 paired trials, initial-position, odometry, relative-coordinate, and radio noise standard deviations are 0.5 m, 0.08 m, 0.1 m, and 3 dB. To standardize the test, all methods share fixed radio quality weights on relative factors.
We expect that fixed-map RPI will again match Joint’s common error while preserving its relative accuracy, and will reduce common-position RMSE relative to Scalar. Figure 5 confirms these results: fixed-map RPI and Joint reduce common-position RMSE from Scalar’s 0.542 m to 0.140 m, a 74% reduction, with paired-change interval [−0.494,−0.311] m. Relative RMSE remains near 0.060 m. For fixed-map RPI and Joint, terminal common uncertainty decreases from Scalar’s 0.615 m to 0.189 m. Uncertain-map RPI gives common-position RMSE of 0.158 m and terminal common uncertainty of 0.232 m.
Figure 5. Results from 32 paired nonlinear trials with correct and perturbed maps: (a) common-position RMSE, (b) relative-position RMSE, and (c) terminal common uncertainty. RMSE uses the final third of each trajectory. Error bars show 95% intervals computed from trial means.
Map Error Ablation
We test sensitivity to map error by keeping the true map unchanged while supplying a map shifted by 1 m, attenuation values multiplied by 1.2, or both. Relative-factor weights are recomputed for each supplied map and shared across methods. Fixed-map RPI and Joint treat the supplied map as exact, while uncertain-map RPI uses the same attenuation-value model and prior covariance as in §VI-C.
Figure 5 shows that fixed-map RPI and Joint overlap, with final-third common-position RMSE of 0.981, 0.659, and 1.183 m under registration, attenuation, and combined errors, respectively. Uncertain-map RPI reduces these errors to 0.957, 0.172, and 0.967 m, while maintaining relative RMSE near 0.060 m, and outperforms Scalar’s 0.542 m under attenuation error, but not under registration or combined errors. This occurs because uncertain-map RPI models attenuation-value uncertainty but does not explicitly model registration error, which can bias the position estimates.
Fixed-map RPI and Joint report terminal centroid uncertainty between 0.171 and 0.189 m despite their increased position errors. Uncertain-map RPI reports between 0.217 and 0.233 m. Thus, shared attenuation uncertainty improves robustness to attenuation-scale error but does not resolve registration bias in these experiments.
Directional Map Ablation
Finally, we test which translation directions the map can constrain using constant, -varying, and two-dimensional maps. At the supplied map’s means, we verify that the observed links provide information about zero, one, and two independent directions of shared translation, respectively. Trajectories, non-radio measurements, initialization, and radio-noise realizations remain fixed. Each map generates its own radio observations and is also used for inference, avoiding map mismatch. We compare Scalar, fixed-map RPI, and uncertain-map RPI using the nonlinear procedure in §VI-C.
Figure 6 shows that Scalar has common RMSE of 0.324/0.403 m in all conditions. Fixed-map RPI gives the same errors with the constant map, 0.170/0.403 m with the -varying map, and 0.099/0.091 m with the two-dimensional map. Uncertain-map RPI gives 0.322/0.407, 0.219/0.405, and 0.118/0.094 m, respectively, preserving the directional pattern with slightly higher mean errors in the useful directions. Both RPI variants therefore primarily reduce error in directions informed by the map.
Figure 6. Directional map ablation over 32 paired trials. Final-third common RMSE for maps with translation-information ranks zero, one, and two. Error bars show 95% intervals across trials.
Conclusion
In this work, we showed how a registered attenuation map provides information about shared robot motion that fixed weights on relative measurements cannot directly supply. We introduced RPI, a mathematical interface that converts radio measurements and map information into pose information while preserving shared-map correlations. Our analysis characterizes which shared motions the map and observed links can detect.
Our simulations confirm that RPI matches the pose estimates and covariances from the benchmarked joint optimization method. Our nonlinear experiments show reduced common-position error while maintaining relative-position accuracy, with directional map ablations confirming that correction occurs in map-constrained directions. Map mismatch can increase position error without a corresponding increase in reported uncertainty. Future work will evaluate RPI on real measured radio data and study pose-update convergence. We will release the code upon acceptance.
References
- [1]S. Roumeliotis and G. Bekey, “Distributed multirobot localization,” IEEE Transactions on Robotics and Automation, vol. 18, no. 5, pp. 781–795, 2002.DOI
- [2]G. P. Huang, N. Trawny, A. I. Mourikis, and S. I. Roumeliotis, “Observability-based consistent EKF estimators for multi-robot cooperative localization,” Autonomous Robots, vol. 30, pp. 99–122, Jan. 2011.DOI
- [3]B. Triggs, P. F. McLauchlan, R. I. Hartley, and A. W. Fitzgibbon, “Bundle adjustment — a modern synthesis,” in Vision Algorithms: Theory and Practice (B. Triggs, A. Zisserman, and R. Szeliski, eds.), (Berlin, Heidelberg), pp. 298–372, Springer Berlin Heidelberg, 2000.DOI
- [4]M. Kaess, H. Johannsson, R. Roberts, V. Ila, J. Leonard, and F. Dellaert, “iSAM2: Incremental smoothing and mapping using the Bayes tree,” Intl. J. of Robotics Research, IJRR, vol. 31, pp. 216–235, Feb. 2012.DOI
- [5]J. Wilson and N. Patwari, “Radio tomographic imaging with wireless networks,” IEEE Transactions on Mobile Computing, vol. 9, p. 621–632, May 2010.DOI
- [6]E. Leitinger, F. Meyer, F. Hlawatsch, K. Witrisal, F. Tufvesson, and M. Z. Win, “A belief propagation algorithm for multipath-based slam,” IEEE Transactions on Wireless Communications, vol. 18, p. 5613–5629, Dec. 2019.DOI
- [7]X. Li, E. Leitinger, F. Tufvesson, and F. Meyer, “Probabilistic occupancy grid for radio-based slam,” 2026.arxiv.org/abs/2603.03559
- [8]J. D. Carroll and A. J. Canciani, “Terrain-referenced navigation using a steerable laser measurement sensor,” NAVIGATION: Journal of the Institute of Navigation, vol. 68, no. 1, pp. 115–134, 2021.DOI
- [9]J. H. Ramos, J. Shin, K. Volle, P. Buzaud, K. Brink, and P. Ganesh, “Information-aware guidance for magnetic anomaly based navigation,” in 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 6347–6354, 2022.arxiv.org/abs/2208.00988
- [10]A. Cunningham, V. Indelman, and F. Dellaert, “Ddf-sam 2.0: Consistent distributed smoothing and mapping,” in 2013 IEEE International Conference on Robotics and Automation, pp. 5220–5227, 2013.
- [11]O. Dagan and N. R. Ahmed, “Exact and approximate heterogeneous bayesian decentralized data fusion,” Trans. Rob., vol. 39, p. 1136–1150, Apr. 2023.DOI
- [12]O. Dagan and N. R. Ahmed, “Conservative filtering for heterogeneous decentralized data fusion in dynamic robotic systems,” in 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 5840–5847, 2022.DOI





