int trigPin = 22;

int echoPin = 24;

int led = 26;

int trigPin2 = 28;

int echoPin2 = 30;
int led2 = 31;

int trigPin3 = 32;

int echoPin3 = 33;
int led3 = 34;

int trigPin4 = 35;

int echoPin4 = 36;
int led4 = 37;

int trigPin5 =38;

int echoPin5 = 39;
int led5 = 40;

int trigPin6 = 41;

int echoPin6 = 42;
int led6 = 43;

long previousMillis = 0;
long interval = 200;

void setup()

{
Serial.begin (9600);

pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(led, OUTPUT);

pinMode(trigPin2, OUTPUT);
pinMode(echoPin2, INPUT);
pinMode(led2, OUTPUT);

pinMode(trigPin3, OUTPUT);
pinMode(echoPin3, INPUT);
pinMode(led3, OUTPUT);

pinMode(trigPin4, OUTPUT);
pinMode(echoPin4, INPUT);
pinMode(led4, OUTPUT);
 pinMode(trigPin5, OUTPUT);
pinMode(echoPin5, INPUT);
pinMode(led5, OUTPUT);

pinMode(trigPin6, OUTPUT);
pinMode(echoPin6, INPUT);
pinMode(led6, OUTPUT);

void loop()
{
unsigned long currentMillis = millis();

if(currentMillis - previousMillis > interval)

{
previousMillis = currentMillis;

Sensor ();
Sensor2 ();
Sensor3 ();
Sensor4 ();
Sensor5 ();
Sensor6 ();
}

void Sensor()
{
long duration, distance;

digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);

duration = pulseIn(echoPin, HIGH);

distance = (duration/2) / 29.1;

if (distance < 10)

{
digitalWrite(led, HIGH);
}
else
{
 digitalWrite(led,LOW);
}

void Sensor2()
{
long duration, distance;

digitalWrite(trigPin2, LOW);
delayMicroseconds(2);
digitalWrite(trigPin2, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin2, LOW);

duration = pulseIn(echoPin2, HIGH);

distance = (duration/2) / 29.1;

if (distance < 10)

{
digitalWrite(led2, HIGH);
}
else
{
digitalWrite(led2,LOW);
}

void Sensor3()
{
long duration, distance;

digitalWrite(trigPin3, LOW);
delayMicroseconds(2);
digitalWrite(trigPin3, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin3, LOW);

duration = pulseIn(echoPin3, HIGH);

distance = (duration/2) / 29.1;

if (distance < 10)

{
digitalWrite(led3, HIGH);
 }
else
{
digitalWrite(led3,LOW);
}

void Sensor4()
{
long duration, distance;

digitalWrite(trigPin4, LOW);
delayMicroseconds(2);
digitalWrite(trigPin4, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin4, LOW);

duration = pulseIn(echoPin4, HIGH);

distance = (duration/2) / 29.1;

if (distance < 10)

{
digitalWrite(led4, HIGH);
}
else
{
digitalWrite(led4,LOW);
}

void Sensor5()
{
long duration, distance;

digitalWrite(trigPin5, LOW);
delayMicroseconds(2);
digitalWrite(trigPin5, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin5, LOW);

duration = pulseIn(echoPin5, HIGH);

distance = (duration/2) / 29.1;
 if (distance < 10)
{
digitalWrite(led5, HIGH);
}
else
{
digitalWrite(led5,LOW);
}

void Sensor6()
{
long duration, distance;

digitalWrite(trigPin6, LOW);
delayMicroseconds(2);
digitalWrite(trigPin6, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin6, LOW);

duration = pulseIn(echoPin6, HIGH);

distance = (duration/2) / 29.1;

if (distance < 10)

{
digitalWrite(led6, HIGH);
}
else
{
digitalWrite(led6,LOW);
}

Inicio

Inicializan las variables de entrada, salida para cada uno perifericos (sensor ultrasnico, motor )