update code for new servo timing