Add servo angle protection to driver

Add servo angle protection to driver