A Pneumatically Driven Surgical Manipulator With a Flexible Distal Joint Capable of Force Sensing

摘要

This paper presents a novel forceps manipulator for surgical robot systems. The forceps manipulator has a highly simplified flexible distal joint, which is actuated by push-pull motions of superelastic wires. Pneumatic cylinders are employed for its driving system to realize high backdrivability of the flexible mechanism, enabling external force estimation without using a force sensor. For the kinematic description, we newly introduce a three-degree-of-freedom (DOF) continuum model considering expansion and contraction of the flexible joint, which allows three-axis force sensing on the forceps tip. We also developed a practical dynamic model, including linear-approximated elastic forces and nonlinear friction forces dependent on the joint bending angle. Effectiveness of the dynamic model is validated by open-loop control performance of the joint angles. The position control system is designed using a PID-based cascade controller with a feedforward compensator based on the dynamic model. Resolution of the joint angle control is 1°, satisfying the requirement for laparoscopic surgery. An external force estimation algorithm is developed, which realizes the three-axis sensing of translational forces acting on the forceps tip. The rigid-link approximation model is also employed to treat the calculation in singular attitude, the straight position of the flexible joint. Effectiveness of the force estimator is experimentally validated using a force sensor in two cases. Estimation error is 0.37 N at maximum with a force in a radial direction, and the estimation performance using the three-DOF force estimator is much better than the one using a conventional two-DOF force estimator.