• 中国计算机学会会刊
  • 中国科技核心期刊
  • 中文核心期刊

Computer Engineering & Science

Previous Articles     Next Articles

An IMU-based human-machine cooperation
control algorithm of active dancing robot

LIU Zhao1,2,SONG Li-bin2,YU Tao2,GUO Kai2,WANG Zeng-xi2,GENG Mei-xiao2   

  1. (1.Tianjin Research Institute for Advanced Equipment,Tsinghua University,Tianjin 300304;
    2.Tsingyan Huayu Robot and Automation( Tianjin) Co.,Ltd.,Tianjin 300304,China)
  • Received:2016-06-30 Revised:2016-11-04 Online:2018-01-25 Published:2018-01-25

Abstract:

This paper proposes an IMU (Inertial Measurement Unit) -based human-machine cooperation control algorithm of active dancing robot The robot is equipped with three springs with a certain rigidity at the waist. Kalman filter is used to fuse the triaxial accelerometer data with the three-axis gyroscope data to obtain the changes of attitude angle of the robot under the influence of human partners. The threshold method is used to eliminate the jitter error of attitude angle. Combined with the current state of the robot, the mapping of the relative attitude angle to the velocity vector is obtained. Then, the desired trajectory speed and the human trajectory correction speed are fused to get the robot trajectory and the corrected coordinates of the remaining target points. The algorithm is applied to Waltz CCL (Closed Change Left) trajectory test, and the experimental results show that the algorithm works well.
 

Key words: active dancing robot, human-machine cooperation, Kalman filtering, attitude angles