tesseract_planning
tesseract_planning copied to clipboard
After adding point clouds to the environment, the solving speed significantly slows down.
I suspect this is due to slow collision detection.
The first picture is the point cloud I added, and the second picture is the collision detection code of my inverse kinematic solution. I am sure that the collision detection slows down the solution. Do you have any good suggestions ? Thanks you very much !