[1511.03999] Efficient Penetration Depth Computation between Rigid Models using Contact Space Propagation Sampling