[Alex]

In the Python API, You can use MoveL_Test() or MoveJ_Test() which returns 0 if the movement is free of collision or any other issues. If the robot can not reach the target pose it returns -2. If the robot can reach the target but it can not make a linear movement it returns -1.

Would a C++ implementation of this methods solve your problem?