Added stepper angle func, max servo angle reduced