Fix bug with initializing servos.