Collision detection for 3D rigid body motion planning with narrow passages | IEEE Conference Publication | IEEE Xplore