Research on Kinematics Analysis and Trajectory Planning of Novel EOD Manipulator

Abstract

To address the problems of mismatch, poor flexibility and low accuracy of ordinary manipulators in the complex special deflagration work process, this paper proposes a new five-degree-of-freedom (5-DOF) folding deflagration manipulator. Firstly, the overall structure of the explosion-expulsion manipulator is introduced. The redundant degrees of freedom are formed by the parallel joint axes of the shoulder joint, elbow joint and wrist pitching joint, which increase the flexibility of the mechanism. Aiming at a complex system with multiple degrees of freedom and strong coupling of the manipulator, the virtual joint is introduced, the corresponding forward kinematics model is established by D–H method, and the inverse kinematics solution of the manipulator is derived by analytical method. In the MATLAB platform, the workspace of the manipulator is analyzed by Monte Carlo pseudo-random number method. The quintic polynomial interpolation method is used to simulate the deflagration task in joint space. Finally, the actual prototype experiment is carried out using the data obtained by simulation. The trajectory planning using the quintic polynomial interpolation method can ensure the smooth movement of the manipulator and high accuracy of operation. Furthermore, the trajectory is basically consistent with the simulation trajectory, which can realize the work requirements of putting the object into the explosion-proof tank. The new 5-DOF folding deflagration manipulator designed in this paper has stable motion and strong robustness, which can be used for deflagration during the COVID-19 epidemic.