Sonar sensor to arduino to servo