Burs of free C-space: A novel structure for path planning
FCL: A general purpose library for collision and proximity queries