Bug fixes with vnh_bridge and Servo

vnh_bridge - moved ADC handling to its own API function
Servo - Fixed an issue where the timer5 was still being used for the
servo.