1 research outputs found
Inducing Multi-Convexity in Path Constrained Trajectory Optimization for Mobile Manipulators
In this paper, we propose a novel trajectory optimization algorithm for
mobile manipulators under end-effector path, collision avoidance and various
kinematic constraints. Our key contribution lies in showing how this highly
non-linear and non-convex problem can be solved as a sequence of convex
unconstrained quadratic programs (QPs). This is achieved by reformulating the
non-linear constraints that arise out of manipulator kinematics and its
coupling with the mobile base in a multi-affine form. We then use techniques
from Alternating Direction Method of Multipliers (ADMM) to formulate and solve
the trajectory optimization problem. The proposed ADMM has two similar
non-convex steps. Importantly, a convex surrogate can be derived for each of
them. We show how large parts of our optimization can be solved in parallel
providing the possibility of exploiting multi-core CPUs/GPUs. We validate our
trajectory optimization on different benchmark examples. Specifically, we
highlight how it solves the cyclicity bottleneck and provides a holistic
approach where diverse set of trajectories can be obtained by trading-off
different aspects of manipulator and mobile base motion.Comment: 8 pages, under review at Conference on Decision and Control (CDC
2019