Efficient Kinematic Planning for Mobile Manipulators with Non-holonomic Constraints Using Optimal Control

Abstract

This work addresses the problem of kinematic trajectory planning for mobile manipulators with non-holonomic constraints, and holonomic operational-space tracking constraints. We obtain whole-body trajectories and time-varying kinematic feedback controllers by solving a Constrained Sequential Linear Quadratic Optimal Control problem. The employed algorithm features high efficiency through a continuous-time formulation that benefits from adaptive step-size integrators and through linear complexity in the number of integration steps. In a first application example, we solve kinematic trajectory planning problems for a 26 DoF wheeled robot. In a second example, we apply Constrained SLQ to a real-world mobile manipulator in a receding-horizon optimal control fashion, where we obtain optimal controllers and plans at rates up to 100 Hz.

arXiv comment7 pages

References in corpus (1)

• An Efficient Optimal Planning and Control Framework For Quadrupedal Locomotion

Cited by in corpus (8)

• Keep Rollin' - Whole-Body Motion Control and Planning for Wheeled Quadrupedal Robots
• Mobile Robotic Fabrication at 1:1 scale: the In situ Fabricator
• The Control Toolbox - An Open-Source C++ Library for Robotics, Optimal and Model Predictive Control
• Automatic Differentiation of Rigid Body Dynamics for Optimal Control and Estimation
• A Projection Approach to Equality Constrained Iterative Linear Quadratic Optimal Control
• Design and Motion Planning for a Reconfigurable Robotic Base
• Modeling and Control of a Hybrid Wheeled Jumping Robot
• Multi-stage warm started optimal motion planning for over-actuated mobile platforms