Подключение четырех-контактного мотора.
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 t, s;
digitalWrite(trigPin, 1); // включим излучатель
delay(10/16);
digitalWrite(trigPin, 0); // выключаем излучатель
t = pulseIn(echoPin, 1); // узнаем время
s = 0.034 * t / 2; // // вычисляем расстояние
return (s);
}