Convert to a python module that can be easily installed on ROS1 and ROS2
Convert to a python module that can be easily installed on ROS1 and ROS2