Position Control and Vibration Suppression for Flexible-Joint Surgical Robot

To achieve vibration suppression and precise position control for minimally invasive surgical robot during intraoperative operation, a compound control method composed of an input shaper and a pole-placement predictive function controller (PPFC) is proposed. First, the flexible-joint dynamic model of the 3-degree of freedom remote center motion (RCM) mechanisms of minimally invasive surgery robot is linearized by using the gravity compensation, and then the linearized dynamic model is decomposed into four parallel first-order sub-models. Next, PPFC is used to realize the position tracking of the robotic arm in the movement, and ZV input shaping is used to suppress the residual vibration of flexible-joint manipulator after stopping motion. Finally, the comparative experiments are conducted to evaluate the performance of the proposed method.

[1]  M. M. Bridges,et al.  Redesign of robust controllers for rigid-link flexible-joint robotic manipulators actuated with harmonic drive gearing , 1995 .

[2]  Ch. Arber,et al.  On the predictive functional control of an elastic industrial robot , 1986, 1986 25th IEEE Conference on Decision and Control.

[3]  R Haber,et al.  Pole-placement Predictive Functional Control for under-damped systems with real numbers algebra. , 2017, ISA transactions.

[4]  Alessandro De Luca,et al.  A PD-type regulator with exact gravity cancellation for robots with flexible joints , 2011, 2011 IEEE International Conference on Robotics and Automation.

[5]  Petar V. Kokotovic,et al.  An integral manifold approach to the feedback control of flexible joint robots , 1987, IEEE J. Robotics Autom..

[6]  P. Kopacek,et al.  Composite computed torque control of robots with elastic motor transmission , 1991 .

[7]  Shuguo Wang,et al.  Optimization and preoperative adjustment design of remote center motion mechanism for minimally invasive surgical robot , 2015, ROBIO 2015.

[8]  Mark W. Spong,et al.  Adaptive control of flexible-joint manipulators , 1989, IEEE Control Systems Magazine.

[9]  Alessandro De Luca,et al.  A general algorithm for dynamic feedback linearization of robots with elastic joints , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[10]  Warren P. Seering,et al.  Preshaping Command Inputs to Reduce System Vibration , 1990 .

[11]  William Singhose,et al.  Useful applications of closed-loop signal shaping controllers , 2008 .

[12]  Jurek Z. Sasiadek,et al.  Modeling and Direct Adaptive Control of a Flexible-Joint Manipulator , 2012 .