cleaning up repo to be integrated with ROS workspace