snape / RVO2 C++ 987 289 Optimal Reciprocal Collision Avoidance (C++) collision-avoidance cpp motion-planning robotics