Arduino sketch for controlling a servo with an IR sensor