Track papers across labs, topics, and trends.
Search papers, labs, and topics across Lattice.
This paper introduces a two-stage factor graph-based approach for state and trajectory estimation of cable-driven tensegrity robots, fusing RGB-D camera data with cable length sensor measurements. The method incorporates Mahalanobis distance-based clustering for noise handling and Chebyshev polynomials for velocity and intermediate state estimation. Experiments on both simulated and real-world data demonstrate the approach's ability to provide high-fidelity, continuous-time estimates compared to an ICP-based algorithm, enabling better control and system understanding.
Factor graphs, combined with Chebyshev polynomials, unlock robust state estimation for tensegrity robots, outperforming ICP-based methods in handling their complex, underconstrained dynamics.
Tensegrity robots offer compliance and adaptability, but their nonlinear, and underconstrained dynamics make state estimation challenging. Reliable continuous-time estimation of all rigid links is crucial for closed-loop control, system identification, and machine learning; however, conventional methods often fall short. This paper proposes a two-stage approach for robust state or trajectory estimation (i.e., filtering or smoothing) of a cable-driven tensegrity robot. For online state estimation, this work introduces a factor-graph-based method, which fuses measurements from an RGB-D camera with on-board cable length sensors. To the best of the authors'knowledge, this is the first application of factor graphs in this domain. Factor graphs are a natural choice, as they exploit the robot's structural properties and provide effective sensor fusion solutions capable of handling nonlinearities in practice. Both the Mahalanobis distance-based clustering algorithm, used to handle noise, and the Chebyshev polynomial method, used to estimate the most probable velocities and intermediate states, are shown to perform well on simulated and real-world data, compared to an ICP-based algorithm. Results show that the approach provides high fidelity, continuous-time state and trajectory estimates for complex tensegrity robot motions.