Collision Detection and Safe Reaction of Manipulator Based on Disturbance Observer

ZHONG Cong-wei,XIANG Ji,WEI Wei,ZHANG Yuan-hui,CHEN Peng
DOI: https://doi.org/10.3785/j.issn.1008-973x.2012.06.023
2012-01-01
Abstract:When a robot manipulator collides with an object or human body in its workspace,the motor on the joint would be damaged and the person would be hurt.To guarantee the safety of human body and the equipment,a disturbance observer,which is designed to evaluate the influence of the collision force,was developed.The disturbance observer is deduced from preservation of momentum.The observation result would exponentially attenuate to zero when the manipulator is not influenced by the external force,and approach to the force when it is colliding with some objects.When the observation result and its derivative exceed the given thresholds,the collision were detected.For the damage limiting of the robot or the safety of the human body,two different safe reaction methods for velocity mode and torque mode control were presented.The experiments with the collision objects,balloon and human body,were carried out.The collison could be effectively detected within 200 ms after contact and the manipulator was rapidly controlled to move reversely away from the collision region.The experimental results demonstrated that the safety of manipulator and human body could be guaranteed by the proposed collision detection and safe reaction method.
What problem does this paper attempt to address?