Fast Human Whole Body Motion Imitation Algorithm for Humanoid Robots