Optimization-based trajectory planning for transport collaboration of heterogeneous systems

Abstract

Abstract This paper describes an optimization-based trajectory planning scheme for handing over an object between a quadrotor and a wheeled robot in a transportation scenario. Concretely, a quadrotor should pick up an object from a moving ground mobile robot and deliver it to its destination. An optimization framework based on discrete mechanics and complementarity constraints is utilized here to jointly ensure dynamic feasibility and determine the position, timing, and coordination of the handover autonomously. Cooperative trajectories of the heterogeneous robot system can be generated simultaneously to satisfy different requirements by adjusting the objective function and constraints. The proposed planning scheme provides a novel paradigm combining trajectory planning and handover decision-making within an optimal control problem.