Add servo tests