Re-adding roboteq_node unit test. Need to finish the convertWheelToTwist Function.