← Search

Sangli Teng

11 accepted papers

2026

Ego-Vision World Model for Humanoid Contact Planning

ICRA 2026poster

Enabling humanoid robots to exploit physical contact, rather than simply avoid collisions, is crucial for autonomy in unstructured environments. Traditional optimization-based planners struggle with contact complexity, while on-policy reinforcement learning (RL) is sample-inefficient and has limited…

2026

Stein Variational Ergodic Surface Coverage with SE(3) Constraints

ICRA 2026poster

Surface manipulation tasks require robots to generate trajectories that comprehensively cover complex 3D surfaces while maintaining precise end-effector poses. Existing ergodic trajectory optimization (TO) methods demonstrate success in coverage tasks, while struggling with point-cloud targets due t…

2025

Discrete-Time Hybrid Automata Learning: Legged Locomotion Meets Skateboarding

RSS 2025poster

This paper introduces Discrete-time Hybrid Automata Learning (DHAL), a framework using on-policy Reinforcement Learning to identify and execute mode-switching without trajectory segmentation or event function learning. Hybrid dynamical systems, which include continuous flow and discrete mode switchi…

Cited by 5PDFScholar
2025

Max Entropy Moment Kalman Filter for Polynomial Systems with Arbitrary Noise

NeurIPS 2025poster

Designing optimal Bayes filters for nonlinear non-Gaussian systems is a challenging task. The main difficulties are: 1) representing complex beliefs, 2) handling non-Gaussian noise, and 3) marginalizing past states. To address these challenges, we focus on polynomial systems and propose the Max Entr…

Cited by 0SourceScholar
2025

Riemannian Direct Trajectory Optimization of Rigid Bodies on Matrix Lie Groups

RSS 2025poster

Designing dynamically feasible trajectories for rigid bodies is a fundamental problem in robotics. Although direct trajectory optimization is widely applied to solve this problem, state-of-the-art methods overlook the manifold structures of rigid bodies, resulting in slow convergence. This paper in…

Cited by 2PDFScholar
2023

Convex Geometric Motion Planning on Lie Groups via Moment Relaxation

RSS 2023poster

This paper reports a novel result: with proper robot models on matrix Lie groups, one can formulate the kinodynamic motion planning problem for rigid body systems as \emph{exact} polynomial optimization problems that can be relaxed as semidefinite programming (SDP). Due to the nonlinear rigid body d…

Cited by 19SourcePDFScholar
2023

Convex Geometric Trajectory Tracking Using Lie Algebraic MPC for Autonomous Marine Vehicles

RA-L 2023

Controlling marine vehicles in challenging environments is a complex task due to the presence of nonlinear hydrodynamics and uncertain external disturbances. Despite nonlinear model predictive control (MPC) showing potential in addressing these issues, its practical implementation is often constrain

Cited by 14SourcecodeScholar
2023

Fully Proprioceptive Slip-Velocity-Aware State Estimation for Mobile Robots via Invariant Kalman Filtering and Disturbance Observer

IROS 2023poster

This paper develops a novel slip estimator using the invariant observer design theory and Disturbance Observer (DOB). The proposed state estimator for mobile robots is fully proprioceptive and combines data from an inertial measurement unit and body velocity within a Right Invariant Extended Kalman…

Cited by 19SourcecodeScholar
2022

An Error-State Model Predictive Control on Connected Matrix Lie Groups for Legged Robot Control

IROS 2022poster

This paper reports on a new error-state Model Predictive Control (MPC) approach to connected matrix Lie groups for robot control. The linearized tracking error dynamics and the linearized equations of motion are derived in the Lie algebra. Moreover, given an initial condition, the linearized trackin…

Cited by 35SourcecodeScholar
2021

Legged Robot State Estimation in Slippery Environments Using Invariant Extended Kalman Filter with Velocity Update

ICRA 2021poster

This paper proposes a state estimator for legged robots operating in slippery environments. An Invariant Extended Kalman Filter (InEKF) is implemented to fuse inertial and velocity measurements from a tracking camera and leg kinematic constraints. The misalignment between the camera and the robot-fr…

Cited by 58SourceScholar