Humanoid Path Planner (Define non-linear constraints on robot configurations)
