RAPTOR

RAPid and robust Trajectory Optimization for Robots

Performing trajectory design for humanoid robots with high degrees of freedom is computationally challenging. The trajectory design process also often involves carefully selecting various hyperparameters and requires a good initial guess which can further complicate the development process. This work introduces a generalized gait optimization framework that directly generates smooth and physically feasible trajectories. The proposed method demonstrates faster and more robust convergence than existing techniques and explicitly incorporates closed-loop kinematic constraints that appear in many modern humanoids.


Trajectory Optimization Demos

Digit-v3 walking.

Code and documentation are available here.
Digit walking forward with 0.0 m/s and 0.10 m step height (periodic)
Digit walking forward with 0.5 m/s and 0.15 m step height (periodic)
Digit walking forward with 1.0 m/s and 0.20 m step height (periodic)
Digit turning (periodic)
Digit stepping upward (periodic)
Digit walking forward with different step lengths and step heights (periodic)

Talos walking.

Code and documentation are available here.
Talos walking forward with 0.0 m/s and 0.10 m step height (periodic)
Talos walking forward with 0.5 m/s and 0.15 m step height (periodic)
Talos walking forward with 1.0 m/s and 0.20 m step height (periodic)

Unitree G1 walking.

Code and documentation are available here.
Unitree G1 walking forward with 0.0 m/s and 0.05 m step height (periodic)
Unitree G1 walking forward with 0.375 m/s and 0.075 m step height (periodic)
Unitree G1 walking forward with 0.75 m/s and 0.10 m step height (periodic)

Kinova-gen3

Obstacle Avoidance Trajectories Examples.
Code and documentation are available here for discrete time safety and here for continuous time safety.
Collision Avoidance Exciting Trajectories Examples.
Exciting trajectories for more accurate system identification while ensuring robot safety.
Code and documentation are available here.
Online Payload Identification Examples.
Identifying inertial parameters of end effector online to stack unknown dumbbells vertically on a specific location.
Code and documentation are available here.
Inverse Kinematics Example:
Solving a series of inverse kinematics in seconds!
Code and documentation are available here.

Links


Authors

1 Robotics Institute, University of Michigan, Ann Arbor 2 Mechanical Engineering, University of Michigan, Ann Arbor

This work is developed under RoahmLab.


BibTeX

@article{zhang2024rapidrobusttrajectoryoptimization,
  title={Rapid and Robust Trajectory Optimization for Humanoids},
  author={Bohao Zhang and Ram Vasudevan},
  journal={arXiv preprint arXiv:2409.00303},
  year={2024}
}
					    	

Contact

We are actively developing the codebase and appreciate any feedback!
If you have any questions about the paper, please feel free to contact Bohao Zhang.
If you have any questions about the code and would like to report any bugs or problems, please raise a new issue in the Issues page in the RAPTOR repo. We will try to respond to it as soon as possible.
If you would like to request any related new features and have suggestions on how to improve the performance of RAPTOR, please raise a new discussion in the Discussions page in the RAPTOR repo.


Related Projects

ARMOUR - Autonomous Robust Manipulation via Optimization with Uncertainty-aware Reachability
WAITR - Wrench Analysis for Inertial Transport using Reachability
SPARROWS - Safe Planning for Articulated Robots Using Reachability-based Obstacle Avoidance With Spheres