set sensible servo values, add servo safety