Initial package.xml and CmakeLists.txt
Catkinized and converted to CMake.