Planning for Constrained Systems in Minimal Coordinates

Thomas Cohn

Amazon Robotics Visits RLG, Fall 2025

Setup: Kinematic Constraints

 Learning the Metric of Task Constraint Manifolds for Constrained Motion Planning, Zha et. al.

Sampling-Based Planning

Trajectory Optimization

Existing Approaches

Sampling-Based Methods for Motion Planning with Constraints, Kingston et. al.

Direct Collocation Methods for Trajectory
Optimization in Constrained Robotic Systems
, Bordabla et. al.

Last Time: Parametrizing the Constraint Manifold

Last Time: Parametrizing the Constraint Manifold

Now: A Testing Suite for More General Parametrizations

Each Optimization IK Problem Performs Better with a Parametrization

Parametrizations to Test...

  • Learned IK functions (e.g. generative modeling)
  • Algebraic Methods (IK-Geo, IKFast)
  • Eigenvalue IK methods

Goal: completely general solutions -- no by-hand derivations required

With Lucas Tang, Alex Amice

Last Time: IRIS-NP Regions

Now: Better Region Generation

Generalize IRIS-ZO and IRIS-NP2 to plan on a parametrization

  • 100-300x Speedup
  • 5-8x Fewer Hyperplanes
  • Larger Volume
  • Smaller Fraction in Collision

With Peter Werner and Rebecca Jiang

Last Time: Planning with GcsTrajOpt

Now: Changing IK Branches

Robot Arm Path Planning Using Modified Particle Swarm Optimization based on D* algorithm, Sadiq et. al.

With Seiji Shaw

Planning for Constrained Systems in Minimal Coordinates

Thomas Cohn

Amazon Robotics Visits RLG, Fall 2025

Slides for Amazon (Fall 2025)

By tcohn

Slides for Amazon (Fall 2025)

  • 24