Robot Path Planning: An Object-Oriented Approach
V-Clip: fast and robust polyhedral collision detection