Added switch statement to drive servo using Axis_1