A traction-force control method for manipulator with tool's gravity compensation

Ning LI,Fanle MENG,Bowei ZENG,Hui DING,Guangzhi WANG
DOI: https://doi.org/10.3969/j.issn.1002-3208.2017.01.01
2017-01-01
Abstract:Objective To develop a traction force control method for manipulator with tool's gravity compensation according to the need of force-position interaction in real time with operators in surgery and rehabilitation training.Methods We firstly use six-degree force transducer mounted on the end of the manipulator to detect traction force,then translate it to the displacement of the manipulator's nominal position and update the motion velocity by force-displacement and force-velocity transfer algorithm,finally,drive the manipulator towards the direction of the traction force.A gravity compensation algorithm is implemented in this method in order to eliminate the deviations of the tool's gravity.Results Experiments simulate the registration process of the stereotactic frameless surgery,and the data set suggests that the tool's gravity compensates within ±0.2 N at the steady state.Maximum force control loop frequency is 30 Hz and maximum system latency is 52 ms.Conclusions The manipulator can be driven and avoid the obstacle by traction force easily and smoothly,and the outcome of the gravity compensation is significant.
What problem does this paper attempt to address?