Collaborative robot has been widespread application prospect, such as homes, manufacturing, and health-care etc. In physical human-robot interaction, the external force appears inevitably in contact with environment or human, especially the interactive tasks such as trajectory tracking requirements and force compliance control. In this article, a method based on interaction intention estimation, which solve the problem of trajectory tracking accuracy and force compliance control in the same direction for the 7-DOF robot, is proposed. The increased virtual force depended on the manipuility performance index and inverse kinematic solution used the kinematic decoupling method based on the redundant angle avoid the singularity of redundant robot. Then, based on interactive intention estimation, a control strategy of variable impedance sliding mode theory in the presence of virtual force and contact force is proposed to achieve the trajectory tracking. We adopted hyperbolic tangent function to alleviate the chattering problem caused by switch function and validated the control system stability by Lyapunov theorem. Finally, Matlab simulations exhibit a 97.8% of high tracking accuracy amid the external force is 43% less than variable impedance parameters. It is therefore proved that the proposed method can achieve asymptotic tracking and the compliant behavior in physical human-robot interaction.
Compliance control based on PSO algorithm to improve the feeling during physical human–robot interaction