Try the servo library Rate is a little low, but you could get clues from the source on how to change that