Update CMakeList and structure
In this commit the structure of the package is changed to follow ROS conventions and CMakelists.txt is updated. Furthermore, some files formatting was changed to follow clang-format.
In this commit the structure of the package is changed to follow ROS conventions and CMakelists.txt is updated. Furthermore, some files formatting was changed to follow clang-format.