A Linear and Exact Algorithm for Whole-Body Collision Evaluation via Scale Optimization