add turning off servo on nan angle