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.

A new fast filtering algorithm for a 3D point cloud based on RGB-D information.

A point cloud that is obtained by an RGB-D camera will inevitably be affected by outliers that do not belong to the surface of the object, which is due to the different viewing angles, light intensities, and reflective characteristics of the object surface and the limitations of the sensors. An effective and fast outlier removal method based on RGB-D information is proposed in this paper. This method aligns the color image to the depth image, and the color mapping image is converted to an HSV image. Then, the optimal segmentation threshold of the V image that is calculated by using the Otsu algorithm is applied to segment the color mapping image into a binary image, which is used to extract the valid point cloud from the original point cloud with outliers. The robustness of the proposed method to the noise types, light intensity and contrast is evaluated by using several experiments; additionally, the method is compared with other filtering methods and applied to independently developed foot scanning equipment. The experimental results show that the proposed method can remove all type of outliers quickly and effectively.