Cleaned up rsd_camera_functions and converted to catkin cmake