https://5dok.org/document/zx50vd9o-gpu-assisted-collision-avoidance-for-trajectory-optimization.html