Software

Flexible Collision Library (FCL)

Code

Check these two papers FCL architecture and FCL pointcloud for technical details

GPU K-nearest neighbor

GPU motion planning