Open jon-weisz opened 11 years ago
Planning appears to get slow because when it is very near contact with the object, most jumps will lead to "illegal" states. Unfortunately results are much better when the grasp is very close to the object. This means we may want to consider some less stochastic optimization, smaller step sizes, refinining the collision queries to speed up computation, or as a last resort, moving to a faster collision detection library.
in graspPlanningTask::plannerUpdate, the rate at which the planner is running is calculated and put in to the database under the task parameters as the third to last entry.
Figure out at what step the planner starts getting really slow.