Motion planning with humanoid works