범용 로봇팔과 모듈러 햅틱 컨트롤러를 사용한 수술 로봇 시스템 개발

This paper proposes a low-cost robotic surgery system composed of a general purpose robotic arm, an interface for daVinci surgical robot tools and a modular haptic controller utilizing smart actuators. The 7 degree of freedom (DOF) haptic controller is suspended in the air using the gravity compensation, and the 3D position and orientation of the controller endpoint is calculated from the joint readings and the forward kinematics of the haptic controller. Then the joint angles for a general purpose robotic arm is calculated using the analytic inverse kinematics so that that the tooltip reaches the target position through a small incision. Finally, the surgical tool wrist joints angles are calculated to make the tooltip correctly face the desired orientation. The suggested system is implemented and validated using the physical UR5e robotic arm.