An Improved Weighted Gradient Projection Method for Inverse Kinematics of Redundant Surgical Manipulators

Different from traditional redundant manipulators, the redundant manipulators used in the surgical environment require the end effector (EE) to have high pose (position and orientation) accuracy to ensure the smooth progress of the operation. When analyzing the inverse kinematics (IK) of traditional redundant manipulators, gradient-projection method (GPM) and weighted least-norm (WLN) method are commonly used methods to avoid joint position limits. However, for the traditional GPM and WLN method, when joints are close to their limits, they stop moving, which greatly reduces the accuracy of the IK solution. When robotic manipulators enter a singular region, although traditional damped least-squares (DLS) algorithms are used to handle singularities effectively, motion errors of the EE will be introduced. Furthermore, selecting singular region through trial and error may cause some joint velocities exceed their corresponding limits. More importantly, traditional DLS algorithms cannot guide robotic manipulators away from singular regions. Inspired by the merits of GPM, WLN, and DLS methods, an improved weighted gradient projection method (IWGPM) is proposed to solve the IK problem of redundant manipulators used in the surgical environment with avoiding joint position limits and singularities. The weighted matrix of the WLN method and the damping factor of the DLS algorithm have been improved, and a joint limit repulsive potential field function and singular repulsive potential field function belong to the null space are introduced to completely keep joints away from the damping interval and redundant manipulators away from the unsafe region. To verify the validity of the proposed IWGPM, simulations on a 7 degree of freedom (DOF) redundant manipulator used in laparoscopic surgery indicate that the proposed method can not only achieve higher accuracy IK solution but also avoid joint position limits and singularities effectively by comparing them with the results of the traditional GPM and WLN method, respectively. Furthermore, based on the proposed IWGPM, simulation tests in two cases show that joint position limits have a great impact on the orientation accuracy, and singular potential energy function has a great impact on the position accuracy.