Controller for retargeting the motion from human to humanoid robot