Add servo with IR test