How to compute the direction to the closest environment?
The clearance function in StateValidityChecker class only returns the distance to the nearest invalid state or check whether a direction is valid. But how to compute the direction to the nearest invalid state? I also didn't find it in the FCL and PQP collision checking libraries. Thx.