Proximity query based on second order cone programming using convex superquadrics: a static collision detection algorithm for narrow-phase

This paper aims to find an objects representation scheme with high precision and to compute the objects’ separation distance effectively in final analysis. Proximity queries have been used widely in robot trajectory planning, automatic assembly planning, virtual surgery and many other applications. The core of proximity query is the precise computation of (minimum) separation distance in narrow phase, and specific object representation scheme corresponds to different methods of separation distance computation.

In this paper, a second-order cone programming (SOCP)-based (minimum) separation distance computation algorithm was proposed. It treats convex superquadrics, descriptive primitives of complex object as the study objects. The separation distance between two convex superquadrics was written as a general nonlinear programming (NLP) problem with superquadric constraints and then transformed into an SOCP problem with the method of conic formulation of superquadric constraints. Finally, a primal-dual interior point method embedded in MOSEK was used for solving the SOCP problem.

The proposed algorithm achieved exact separation distance computation between convex superquadrics, with a relative error of 10-6. It is particularly suitable for proximity queries in narrow phase of static collision detection algorithms. Further, the proposed algorithm achieved continuous collision detection between rectilinear translation superquadrics.

The proposed algorithm in narrow phase of static collision detection algorithms makes objects’ separation distance effectively computed. Proximity queries are easy and more accurate to perform in this way.