Direct trajectory optimization of macro-micro robotic system using a Gauss pseudospectral framework

Abstract

Trajectory planning is a crucial aspect of macro-micro robotic systems (MMRSs), especially when the system has high degrees of freedom (DOFs). In the field of robotic polishing, the MMRS is usually composed of an industrial robot and an end-effector, which is responsible for polishing force control. Therefore, the compliance of the macro-robot can be minimized by trajectory planning to reduce its impact on the micro-robot. This study proposes a trajectory planning strategy based on Gauss pseudospectral method for a 9-DOF MMRS. Different from traditional sequential solution strategies, it can be used to obtain an approximate global optimal trajectory. Firstly, the velocity-level kinematics model of MMRS is built, which comprehensively considers the workpiece placement pose and task redundancy. Secondly, an optimal control model for trajectory planning is developed through an effective variable allocation. On the premise of considering traditional trajectory smoothness constraints, a constraint on manipulability is additionally analyzed to avoid reaching a singular configuration during compliance optimization. Thirdly, a Gauss pseudospectral framework based on the optimal control model is proposed, and the costate mapping theorem is proved. The latter provides a theoretical basis for the efficiency and accuracy of the proposed method. Finally, comparison results demonstrate the effectiveness of the proposed method.