Restructure as a ros package

[an-dr]

General recommendations:

• http://wiki.ros.org/Packages
• https://github.com/leggedrobotics/ros_best_practices/wiki

Example of the mixed py/cpp package:

• https://github.com/Alive-OS/aliveos_middle