Research on Collision Avoidance Control of Multi-Arm Medical Robot Based on C-Space

摘要

A multi-arm robot for mandible reconstruction assisted surgery is developed. It has three manipulators and eighteen degrees of freedom. In order to prevent the collision of the manipulator caused by the overlap of the motion space of the manipulator during the space positioning of the whole mandible reconstruction operation, a collision avoidance path planning method for manipulator based on C-space is proposed. In order to obtain the space non-interference posture of one manipulator, and the interference posture of the other manipulators is taken as the obstacle mapping in C-space to obtain the free space after removing obstacles. At the same time, combining with the space position of the system manipulator, the C-space mapping mathematical model of feature points and line segments is studied, and the mapping mathematical model of any point and line segment in the plane is obtained. By introducing admissibility proof lemma to weigh the evaluation function, the improved heuristic A* search algorithm is used to search the best path for collision avoidance. The collision avoidance experiment is carried out through simulation and robot platform, and finally the animal experiment is carried out. These experimental results verify the feasibility and validity of the collision avoidance path planning method for the space manipulator.