Motion planning a random path using MoveIt! C++ APIs