removed unused python and cpp code, updated CMakeLists and package.xml files appropriately