Motion Planning for Mobile Manipulators with a Non-Holonomic Constraint Using the FSP (Full Space Parameterization) Method

摘要

The efficient utilization of the motion capabilities of mobile manipulators, i.e., manipulators mounted on mobile platforms, requires the resolution of the kinematically redundant system formed by the addition of the degrees of freedom (DOF) of the platform to those of the manipulator. At the velocity level, the linearized Jacobian equation for such a redundant system represents an underspecified system of algebraic equations, which can be subject to a varying set of contraints such as a non-holonomic constraint on the platform motion, obstacles in the workspace, and various limits on the joint motions. A method, which we named the Full Space Parameterization (FSP), has recently been developed to resolve such underspecified systems with constraints that may vary in time and in number during a single trajectory. In this article, we first review the principles of the FSP and give analytical solutions for constrained motion cases with a general optimization criterion for resolving the redundancy. We then focus on the solutions to (1) the problem introduced by the combined use of prismatic and revolute joints (a common occurrence in practical mobile manipulators), which makes the dimensions of the joint displacement vector components non-homogeneous, and (2) the treatment of a non-holonomic constraint on the platform motion. Sample implementations on several large-payload mobile manipulators with up to 11 DOF are discussed. Comparative trajectories involving combined motions of the platform and manipulator for problems with obstacle and joint limit constraints, and with non-holonomic contraints on the platform motions, are presented to illustrate the use and efficiency of the FSP approach in complex motion planning problems.