Servo reading and working well

Calibrated to one of NSWE coordinates servo sets up in the correct
angle. (Default setup is 0* North)