adaptive motion planning and tracking for humanoid robots