Manipulation planning with goal sets using constrained trajectory optimization

Goal sets are omnipresent in manipulation: picking up objects, placing them on counters or in bins, handing them off — all of these tasks encompass continuous sets of goals. This paper describes how to design optimal trajectories that exploit goal sets. We extend CHOMP (Covariant Hamiltonian Optimization for Motion Planning), a recent trajectory optimizer that has proven effective on high-dimensional problems, to handle trajectory-wide constraints, and relate the solution to the intuition of taking unconstrained steps and subsequently projecting them onto the constraints. We then show how this projection simplifies for goal sets (i.e. constraints that affect only the end-point). Finally, we present experiments on a personal robotics platform that show the importance of exploiting goal sets in trajectory optimization for day-to-day manipulation tasks.

• Publication year

  2011

• Venue

  IEEE International Conference on Robotics and Automation

• Publication date

  2011-05-09

• Fields of study

  Computer Science, Engineering

• Identifiers
  DOI 10.1109/ICRA.2011.5980538
• External record

  Open on Semantic Scholar

• Source metadata

  Semantic Scholar

• No claims are published for this paper.

• No concepts are published for this paper.

• HERB: a home exploring robotic butler

  2010cited by this paper
• Manipulation planning with Workspace Goal Regions

  2009cited by this paper
• CHOMP: Gradient optimization techniques for efficient motion planning

  2009cited by this paper
• Learning to search: structured prediction techniques for imitation learning

  2009cited by this paper
• El-E: An Assistive Robot that Fetches Objects from Flat Surfaces

  2008cited by this paper
• Elastic Strips: A Framework for Motion Generation in Human Environments

  2002cited by this paper
• RRT-connect: An efficient approach to single-query path planning

  2000cited by this paper
• A variational calculus framework for motion planning

  1997cited by this paper
• Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces

  1996cited by this paper
• Real-time modification of collision-free paths

  1994cited by this paper
• The Mathematical Theory of Optimal Processes

  1965cited by this paper
• Mathematical Theory of Optimal Processes

  1962cited by this paper

• SwitchOpt: Trajectory Optimization with Adaptive Grasp Target Switching

  2026cites this paper
• Narrow Passage Path Planning via Homotopy-Preserving Collision Constraint Interpolation

  2026cites this paper
• Toward Generalist Neural Motion Planners for Robotic Manipulators: Challenges and Opportunities

  2026cites this paper
• Deep Reactive Policy: Learning Reactive Manipulator Motion Planning for Dynamic Environments

  2025cites this paper
• Neural MP: A Neural Motion Planner

  2025cites this paper
• A Review of Pedestrian Trajectory Prediction Methods Based on Deep Learning Technology

  2025cites this paper
• SeGMan: Sequential and Guided Manipulation Planner for Robust Planning in 2D Constrained Environments

  2025cites this paper
• PyRoki: A Modular Toolkit for Robot Kinematic Optimization

  2025cites this paper
• Grasping Trajectory Optimization with Point Clouds

  2024influential citation
• Quadrotor Trajectory Planning with Tetrahedron Partitions and B-Splines in Unknown and Dynamic Environments

  2024cites this paper
• Narrow Passage Path Planning Using Collision Constraint Interpolation

  2024cites this paper
• Neural MP: A Generalist Neural Motion Planner

  2024cites this paper
• H-MaP: An Iterative and Hybrid Sequential Manipulation Planner

  2024cites this paper
• Physics-informed Neural Motion Planning on Constraint Manifolds

  2024cites this paper
• Fast Kinodynamic Planning on the Constraint Manifold With Deep Neural Networks

  2023cites this paper
• Accelerating Motion Planning via Optimal Transport

  2023cites this paper
• Trajectory Optimization for Manipulation Considering Grasp Selection and Adjustment

  2023influential citation
• Variable Grasp Pose and Commitment for Trajectory Optimization

  2023cites this paper
• Ready, Set, Plan! Planning to Goal Sets Using Generalized Bayesian Inference

  2023cites this paper
• Zero-Shot Constrained Motion Planning Transformers Using Learned Sampling Dictionaries

  2023cites this paper
• Quasistatic contact-rich manipulation via linear complementarity quadratic programming

  2022cites this paper
• Neural Grasp Distance Fields for Robot Manipulation

  2022influential citation
• Control Optimization of Small-Scale Thrust-Vectoring Vertical/Short Take-Off and Landing Vehicles in Transition Phase

  2022cites this paper
• Creating Better Collision-Free Trajectory for Robot Motion Planning by Linearly Constrained Quadratic Programming

  2021cites this paper
• A Hybrid Approach for Autonomous Collision-Free UAV Navigation in 3D Partially Unknown Dynamic Environments

  2021cites this paper
• Generating Reactive Approach Motions Towards Allowable Manifolds using Generalized Trajectories from Demonstrations

  2020cites this paper
• Corridor-Based Shared Autonomy for Teleoperated Driving

  2020cites this paper
• GOMP: Grasp-Optimized Motion Planning for Bin Picking

  2020cites this paper
• A Generalization of the CHOMP Algorithm for UAV Collision-Free Trajectory Generation in Unknown Dynamic Environments

  2020cites this paper
• Multimodal trajectory optimization for motion planning

  2020influential citation
• Manipulation Planning and Control for Shelf Replenishment

  2019cites this paper
• TORM: Collision-Free Trajectory Optimization of Redundant Manipulator given an End-Effector Path

  2019cites this paper
• Manipulation Planning with Multimodal End Point Optimization for Obtaining Multiple Solutions

  2019cites this paper
• Imitation of Human Motion by Low Degree-of-Freedom Simulated Robots and Human Preference for Mappings Driven by Spinal, Arm, and Leg Activity

  2019cites this paper
• Characterizing Input Methods for Human-to-Robot Demonstrations

  2019cites this paper
• Lazy Evaluation of Goal Specifications Guided by Motion Planning

  2019cites this paper
• Head Pose Estimation and Trajectory Forecasting

  2019cites this paper
• Manipulation Trajectory Optimization with Online Grasp Synthesis and Selection

  2019influential citation
• Real-time Safe Navigation Strategy for Mobile Robots in 3D:A Deforming Path Approach

  2019cites this paper
• Forecasting People Trajectories and Head Poses by Jointly Reasoning on Tracklets and Vislets

  2019cites this paper
• MX-LSTM: Mixing Tracklets and Vislets to Jointly Forecast Trajectories and Head Poses

  2018cites this paper
• Human Action Recognition and Prediction: A Survey

  2018cites this paper
• Configuration Space Metrics

  2018cites this paper
• Goal state driven trajectory optimization

  2018cites this paper
• "Seeing is Believing": Pedestrian Trajectory Forecasting Using Visual Frustum of Attention

  2018cites this paper
• DESIRE: Distant Future Prediction in Dynamic Scenes with Interacting Agents

  2017cites this paper
• Combining Semantic and Geometric Features for Object Class Segmentation of Indoor Scenes

  2017cites this paper
• Finding shorter paths for robot arms using their redundancy

  2017cites this paper
• Scene understanding using deep learning

  2017cites this paper
• Guaranteeing Reactive Missions for Complex Robotic Systems

  2017cites this paper
• DESIRE : Deep Stochastic IOC RNN Encoder-decoder for Distant Future Prediction in Dynamic Scenes with Multiple Interacting Agents

  2016cites this paper
• Robust Rearrangement Planning Using Nonprehensile Interaction

  2016cites this paper
• On the Fundamental Importance of Gauss-Newton in Motion Optimization

  2016cites this paper
• Gaussian Process Motion planning

  2016cites this paper
• Viewpoint-based legibility optimization

  2016cites this paper
• A System for Multi-step Mobile Manipulation: Architecture, Algorithms, and Experiments

  2016cites this paper
• Warping the workspace geometry with electric potentials for motion optimization of manipulation tasks

  2016cites this paper
• Goal Set Inverse Optimal Control and Iterative Replanning for Predicting Human Reaching Motions in Shared Workspaces

  2016cites this paper
• Legible Robot Motion Planning

  2015cites this paper
• Understanding the geometry of workspace obstacles in Motion Optimization

  2015cites this paper
• A general technique for fast comprehensive multi-root planning on graphs by coloring vertices and deferring edges

  2015cites this paper
• Trajectory Optimization With Particle Swarm Optimization for Manipulator Motion Planning

  2015cites this paper
• Synthesis of nonlinear continuous controllers for verifiably correct high-level, reactive behaviors

  2015cites this paper
• Direct Loss Minimization Inverse Optimal Control

  2015cites this paper
• Motion planning with sequential convex optimization and convex collision checking

  2014cites this paper
• Fast and dynamically stable optimization-based planning for high-DOF human-like robots

  2014cites this paper
• Integrating human observer inferences into robot motion planning

  2014cites this paper
• High-DOF Robots in Dynamic Environments Using Incremental Trajectory Optimization

  2014cites this paper
• Space-time functional gradient optimization for motion planning

  2014cites this paper
• Continuous trajectory optimization for autonomous humanoid door opening

  2013cites this paper
• Motion planning from demonstrations and polynomial optimization for visual servoing applications

  2013cites this paper
• Hierarchical Optimization-based Planning for High-DOF Robots

  2013cites this paper
• Pregrasp Manipulation as Trajectory Optimization

  2013cites this paper
• Multigrid CHOMP with Local Smoothing

  2013influential citation
• Generating Legible Motion

  2013cites this paper
• Real-time optimization-based planning in dynamic environments using GPUs

  2013cites this paper
• CHOMP: Covariant Hamiltonian optimization for motion planning

  2013cites this paper
• Reachability and Capability Analysis for Manipulation Tasks

  2013cites this paper
• A policy-blending formalism for shared control

  2013cites this paper
• Legibility and predictability of robot motion

  2013cites this paper
• Learning objective functions for manipulation

  2013cites this paper
• On on-line sampled-data optimal learning for dynamic systems with uncertainties

  2013cites this paper
• Finding Locally Optimal, Collision-Free Trajectories with Sequential Convex Optimization

  2013cites this paper
• Assistive Teleoperation : A New Domain for Interactive Learning – Extended Abstract –

  2012cites this paper
• Herb 2.0: Lessons Learned From Developing a Mobile Manipulator for the Home

  2012cites this paper
• ITOMP: Incremental Trajectory Optimization for Real-Time Replanning in Dynamic Environments

  2012cites this paper
• Learning from Experience in Manipulation Planning: Setting the Right Goals

  2011cites this paper
• Learning force control policies for compliant manipulation

  2011cites this paper