Cleaned up code
Cleaned up videoray ROS communication node