enable pin modes and servo is working