Moved a lot of what was in driver util to a more general ros_util package