Fast Swing-Up Trajectory Optimization for a Spherical Pendulum on a 7-DoF Collaborative Robot

In this paper, the experimental swing-up of a spherical pendulum mounted on a collaborative robot is presented. The complete mechanical system consists of nine degrees of freedom (DoF). The primary focus of this work is the design of a fast trajectory planning of the swing-up by systematically respecting the kinematic and dynamics constraints. The proposed algorithm consists of two steps: First, an offline trajectory optimization is used to build a database of the swing-up trajectories, with an average computing time of 10 second for one trajectory. Second, a fast trajectory replanner based on a constrained quadratic program is described, which computes the swing-up trajectory for an arbitrary initial configuration of the system with an average computing time of 0.2 second. Simulations and experimental results demonstrate the swing-up of the spherical pendulum using a discrete time-variant linear quadratic regulator as a feedback controller.