revised for faster servos