director icon indicating copy to clipboard operation
director copied to clipboard

Fix infeasible plan detection

Open patmarion opened this issue 8 years ago • 0 comments

A common problem is that planning code calls single shot IK to plan an end pose, then plans a posture goal to the end pose. The end pose may be infeasible (info 13) because it violates constraints, but the posture plan is info 1, because it successfully plans to the end pose.

We have some custom code in the valve task which copies the info 13 value from the single shot ik into the info field of the posture plan, but we don't have general support for this.

We could extend the computePostureGoal function so that it can be given an info error code to insert into the plan message is publishes.

patmarion avatar Mar 10 '16 15:03 patmarion