RRT for Swarm

[TODO]

1. Use it inside src for catkin_ws.
2. Compile the code, using makefile available in this repo and CMakeLists.txt of ROS. (Basically, include opencv files)
3. Import the messages, if required.
4. Build and test.