Подключение четырех-контактного мотора.
1. Красный контакт - питание 5 В
2. Cигнальный №1
3. Cигнальный №2
4. Черный - питание (GND)

int trigPin = 13;
int echoPin = 12;
void setup()
{
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
Serial.begin(9600);
}
int dist()

{
int duration, distance;
// для большей точности установим значение LOW на пине Trig
digitalWrite(trigPin, 0);
delayMicroseconds(2);
// включим излучатель ультразвука на короткое время
digitalWrite(trigPin, 1);
delayMicroseconds(10);
// выключаем излучатель
digitalWrite(trigPin, 0);
// узнаем длительность высокого сигнала на пине Echo
duration = pulseIn(echoPin, 1, 10000);
// рассчитаем расстояние
distance = duration/58;
return distance;
}