Encoder, Compass and servos in same Arduino sketch.
set_offset zeroes encoder.
Will continue to add to both data_subscriber class and rospubsub.