Combined our encoder publisher and servo subscriber code into a single Arduino sketch