Environment: Ubuntu 16.04 + MoveIt Kinetic
Not documented yet ...
- Re-organize the code.
- Add support for doxygen.
- Add docker file.
- Add TESTs. (include URDF and SRDF files)
- Code and Tests for collision environment???
- Try out new concepts, e.g. collision env???