Clean up
set the servo type first and then override options later. Also set initial servo position