Initial conversion to using ROS Serial API