Wholebody and walk motion planning for humanoid robots