Humanoid Path Planner