CS Paper Radar

Lie Group Structure of Six-Degree-of-Freedom Rigid-Body Uncertainty Representation and Propagation

Zhuochen Wang, Panagiotis Tsiotras

eess.SY ·submitted 2026-11-13 22:57 UTC · v2

Abstract

For six-degree-of-freedom rigid-body motion, the choice of Lie-group structure affects both how well the group-theoretic mean and covariance represent the state distribution and how accurately these moments are propagated. A quaternion-based, left-trivialized semidirect-product formulation of the velocity phase space is developed for the actuated body-frame dynamics, with closed-form group operations and Jacobians that avoid matrix-group embeddings. We derive the controlled stochastic dynamics and establish that the direct- and semidirect-product formulations describe the same physical process under the specified noise model. Since the semidirect exponential coordinates account for frame changes between body twists at different poses, they capture pose--twist coupling more naturally. A lunar powered-descent experiment assesses low-order moment representations of uncertainty and propagation performance under the proposed group structure using two distinct algorithms. Compared with direct-product formulations and a linearized baseline, the proposed structure improves the representation of the banana-shaped body-velocity distribution using group-theoretic moments, yields more consistent propagated moments, and produces distribution approximations that agree more closely with the Monte Carlo reference. In this experiment, changing the group structure accounts for most of the observed improvement, highlighting the practical value of the proposed semidirect-product formulation.

Closest papers

Nearest neighbours by meaning across the whole index.

Stochastic Port-Hamiltonian Gaussian Processes for Learning from Noisy Dynamics on Lie Groups

cs.LG ·2026-11-07 ·Thribhuvan Rapolu, Luke McLennan, Chandrajit Bajaj
code/data similarity 0.62
Abstract · 54 pages, 14 figures

Learning predictive models for dynamics is difficult because observations are often sparse and noisy, while the underlying dynamics evolve on nonlinear configuration manifolds and are affected by environmental dissipation and stochastic disturbances. Standard neural dynamics models can fit short-term trajectories but often violate physical structure, accumulate error over long horizons, or rely on parameterizations that introduce singularities such as gimbal lock. We introduce LieSPHGP, a stochastic Gaussian-process framework for learning rigid body dynamics with port-Hamiltonian structure and stability-aware robustness. LieSPHGP represents motion on Lie groups and Lie algebras, enabling coordinate-consistent optimization without singular parameterizations. Learned mass, potential energy, dissipation, and control components retain physical roles and a separate diffusion term represents stochastic forcing. Each component is modeled by Matérn kernel Gaussian processes which capture uncertainty induced by noisy observations. To improve physical validity, Lie group exponential map updates preserve rotational constraints, while positive-definite damping ensures nonnegative deterministic energy dissipation. The implicit-explicit integrator additionally provides unconditional stability for the frozen linear damping subsystem. The resulting model learns predictive dynamics that are robust to noise, respect rigid body geometry, and capture both intrinsic motion and environmental dissipation. Experiments on various noisy rigid body benchmarks show improved prediction accuracy, stronger long-horizon stability, and better satisfaction of manifold constraints compared with neural dynamics baselines. Code, data and interactive results are available on the project website: https://thribhuvanrapolu.github.io/liesphgp/

0.37

Distributed Global Pose Synchronization for Heterogeneous Multiple Rigid Body Systems on SE(3)

eess.SY ·2026-11-09 ·Fengyu Lin, Miaomiao Wang, Housheng Su, Zhigang Zeng, Abdelhamid Tayebi
similarity 0.55
Abstract · 16 pages, 9 figures

This paper addresses the problem of global pose synchronization for heterogeneous multiple rigid-body systems evolving on the matrix Lie group $\SE(3)$. We first construct a new potential function on $\SE(3) \times \mathbb{R}$ with a generalized non-diagonal weighting matrix, together with a set of switching variables governed by continuous-discrete hybrid dynamics. Based on this new potential function and these switching variables, we propose a distributed hybrid feedback control scheme that uses relative pose on $\SE(3)$ and group velocity measurements, endowed with global asymptotic stability guarantees. We then further propose a distributed velocity-free hybrid feedback control scheme that uses relative and absolute pose measurements, without requiring group velocity measurements, while preserving global asymptotic stability. Numerical simulations are presented to demonstrate the performance of the proposed distributed hybrid control schemes.

0.20

Orientation in Extended Position-Based Dynamics: Application to Rigid Bodies and Cosserat Rods

cs.GR ·2026-08-21 ·Samuel Tobin, Caleb Rucker
similarity 0.53
Abstract

Rotational degrees of freedom in Extended Position-Based Dynamics (XPBD) require computations on the nonlinear manifold of 3D rotations. We show that Lie theory provides a clean, unified framework for expressing rotations, constraints, interpolation, and differentiation in XPBD, enabling both improved rigid-body constraints and higher-order finite-element Cosserat rods. We derive explicit Lie-theoretic constraint formulations and their gradients for rigid-body simulation, improving the dynamic consistency of constrained rigid-body simulations in XPBD by a factor of over $10^4$ compared to the state-of-the-art. Our framework naturally extends to finite-element Cosserat rods by enabling on-manifold interpolation of nodal rotations. Linear finite elements outperform the conventional chain-of-rigid-bodies discretization, while higher-order basis functions provide even smoother solutions and faster convergence. Utility is demonstrated in a variety of examples with large deformations and contact.

0.34

Dual Park-Ravani Interpolation of Rigid Motions: Acceleration-Field Continuity and Holonomic Hermite Repair

cs.RO ·2026-08-28 ·Daniel Condurache
similarity 0.52
Abstract · 12 pages. Ancillary Python programs reproduce the numerical verification

The Park-Ravani construction generates a twice continuously differentiable, frame-invariant spline on SO(3) by exponentiating cubic canonical-coordinate polynomials. We show that the construction transfers, without changing form, to the group of orthogonal dual tensors, a representation of rigid displacements. The transferred recurrence is stated compactly through the dual extension of the right Jacobian of the exponential map and its first Fréchet derivative. This yields interpolation of prescribed rigid poses and continuity of the body dual twist and its first derivative. Using the higher-order rigid-body kinematics of dual spatial twists, we then prove that the resulting curve has a continuous physical acceleration field, not merely a continuous quantity obtained by formally differentiating the dual part of a twist. We also distinguish algebraic dual transfer from temporal differential prolongation: their simultaneous first-order use takes place in a hyper-dual algebra, and interpolation of arbitrary prolonged nodal data need not be holonomic. A noncommuting three-pose example verifies the recurrence, all knot continuity statements, and dimensional covariance under a change from meters to millimeters. We define and analyze the first-order holonomy defect of a generic hyper-dual interpolant, exhibit an exact counterexample, and remove the defect by cubic or quintic Hermite interpolation in dual logarithmic coordinates.

0.25

FAST-Sync: Fast Group Synchronization for any Matrix Lie Group

cs.RO ·2026-09-29 ·Shane Holmes, Yiran Luo, Firat Taxpulat, David M. Rosen, Frank Dellaert
top venue similarity 0.51
Abstract · 8 pages, 10 figures, 1 table

Group synchronization (GS) is the problem of estimating a set of $N$ unknown elements $g_1,\ldots, g_N \in \mathcal{G}$ in a group $\mathcal{G}$, given noisy measurements of a subset of their pairwise ratios $g_i^{-1} g_j$. GS problems lie at the core of many state estimation tasks in robotics and computer vision, including 3D vision, robotic mapping, inertial navigation, and molecular reconstruction. Unfortunately, GS problems are typically both high-dimensional and non-convex, and therefore hard to solve in general. In this paper, we present Fast-Sync, a fast linear approximation method for GS that is suitable for initializing local manifold-based optimizers or certifiable global methods. Our approach generalizes chordal initialization to arbitrary matrix Lie groups, and additionally proposes two new key algorithmic enhancements: we show how to exploit both the Kronecker-product structure in the problem data matrix and the topology of the synchronization graph to improve speed, scalability, and accuracy. Experimental evaluation across several GS tasks demonstrates that Fast-Sync provides high-quality initializations that enable local optimizers to efficiently recover globally optimal GS solutions, achieving high success rates even with considerable measurement noise.

0.68

Galilean Robots, Aristotelian Sensors: Joint Spatiotemporal Trajectory Estimation and Extrinsic Calibration

cs.RO ·2026-11-09 ·Abhishek Goudar, Jonathan Kelly, Timothy D. Barfoot
similarity 0.49
Abstract

Multi-sensor state estimation requires accurate spatial and temporal calibration between heterogeneous sensors. Existing spatiotemporal calibration methods typically represent sensor extrinsic parameters as a rigid-body transformation together with a scalar temporal offset, causing the spatial and temporal parameters to enter the estimation problem through separate mechanisms. While the spatial transformation composes directly with the robot pose, accounting for the temporal offset requires evaluating the trajectory at a shifted time, typically through motion compensation, interpolation, or a continuous-time trajectory representation. In this work, we formulate joint trajectory estimation and spatiotemporal calibration using the special Galilean group for the robot trajectory and the Aristotelian subgroup for sensor extrinsics. This representation incorporates the coupling between motion and temporal offset directly through the group structure, avoiding the need for a separately parameterized continuous-time trajectory. We develop twist- and IMU-driven motion priors, accommodate both ideal and non-ideal clocks, and evaluate the framework with camera, position, and range measurements. Simulated and real experiments demonstrate calibration and trajectory-estimation performance comparable to established methods across heterogeneous sensor configurations. Our simplified framework therefore offers a quality-of-life improvement over existing methods without compromising performance.

0.17

Enforcing Symmetries on Pre-trained ML Models for Physics

cs.LG physics.comp-phstat.ML ·2026-11-06 ·Wenjie Zhou, Valentino F. Foit, David W. Hogg, Soledad Villar
similarity 0.49
Abstract · 32 pages, 5 figures, 9 tables

Post-hoc group averaging (or test-time augmentation) is a simple way to impose symmetry on a trained predictor without changing its architecture or retraining it. For finite and compact groups, averaging over a normalized Haar measure on the group gives the Reynolds operator: a canonical projection onto invariant or equivariant predictors with known non-increasing risk guarantees under certain assumptions. This paper provides numerical experiments on physics emulation models that demonstrate the effectiveness of the approach in this setting. We then extend this framework to non-compact group symmetries. For non-compact groups, the Haar measure cannot be normalized, so group averaging cannot be defined in the same way. We replace it with three alternatives: the Weyl unitary trick (which requires complexifying the space and extending the predictor), a data-dependent orthogonal projection (which involves a non-trivial optimization on the space of invariant or equivariant functions), and a frame averaging approach (which involves mapping each point to a set of orbit representatives). We illustrate the constructions theoretically and empirically on the unit-rescaling group and the Lorentz group. Our results show that in the non-compact case, the Weyl trick and frame averaging do not provide a consistent improvement over the baseline, except where the test data is out-of-distribution (an orders-of-magnitude improvement in this case) and, for the Weyl trick, in low-data regimes. The orthogonal projection can provide improvements in-distribution and out-of-distribution. We also observe that models trained directly on invariant features matched or beat the projection of an unconstrained one. We conclude that post-hoc symmetrization extends to non-compact groups, but it does not consistently outperform training a symmetric model.

0.50

One Sensor, Whole Body - 3D Body Pose from a Single Consumer Earbud IMU

cs.CV cs.HC ·2026-09-28 ·Zhilin Guo, Boqiao Zhang, Oszkár Urbán, Josef Bengtson, Hakan Aktas +6 more
benchmarkcode/data similarity 0.49
Abstract · 5 pages, 2 figures, 2 tables. Accepted at the 6th International Workshop on Human-centric Multimedia Analysis (HUMA '26), ACM Multimedia 202…

Consumer earbuds already stream inertial motion data from the head, one of the most widely worn sensor locations on the body. We ask how much of the 3D body pose a single such head IMU can recover, and whether adding more consumer sensors actually helps. We build a multimodal capture pipeline that records four-view RGB-D video together with an AirPods head IMU and two Striv insole IMUs, synchronize the streams post-hoc, and generate pseudo-ground-truth with SAM 3D Body, yielding a 35-take single-subject benchmark spanning gait, turning, vertical, everyday, and clinically inspired motions. Adapting two recurrent model families (IMUPoser and MobilePoser), we show that one head IMU recovers lower-body pose at 79.0 mm rigid-MPJPE and per-foot ground contact at 0.809 macro-F1, and that a causal variant retains most of this accuracy at streaming latency. In paired per-take significance tests across both families, adding the consumer foot IMUs never significantly improves pose and significantly degrades it in two of four model-split combinations; a mounting-bias probe and feet-only ablation identify insole orientation quality, not foot placement, as the mechanism. Extending the output to a 20-joint full-body skeleton maps the boundary: gross distal-arm motion is partially recoverable from the head alone, proximal upper-body pose is not, and staged fine-tuning recovers the leg accuracy that naive joint training sacrifices to multi-task dilution. For learned pose from consumer wearables, sensor reliability, not sensor count, is the binding constraint here. For the devices tested, the earbud is its sweet spot. Code is available at https://github.com/ZhilinGuo/one-sensor-whole-body.

0.62