Problema con 3 sensores Ping Parallax

[color=red][u][b]PARTE 2[/b][/u][/color]


[color=green]    //Especificamos los vibradores como salida de datos[/color]
  pinMode(vibrador,OUTPUT); 
  pinMode(vibrador2,OUTPUT); 
  pinMode(vibrador3,OUTPUT); 
  
[color=green]     //----------------------------------------
     //         VIBRADOR 1   (DELANTERO)
     //----------------------------------------
//Si Sensor 1 es menor a 50cm y mayor a 10cm activamos Vibrador 1.

  //Si esta entre 10cm y 60cm[/color]
  if((cm>=10)&&(cm<=60))
  {
      [color=green]// Si esta entre 25cm y 60cm[/color]
      if((cm>=25)&&(cm<=60))
        {      
             [color=green] //Si esta entre 45cm y 60cm[/color]
              if((cm>=45)&&(cm<=60))
              {
                    for(int fadeValue = 0 ; fadeValue <= 64; fadeValue +=5) 
                       { 
                        analogWrite(vibrador, fadeValue);                                     
                       }
              }
              else
              {    [color=green]//Si NO esta entre 45cm y 60cm, esta entre 25cm y 45cm[/color]
                    for(int fadeValue = 0 ; fadeValue <= 127; fadeValue +=5) 
                       { 
                        analogWrite(vibrador, fadeValue);                                     
                       }
              }
        }
       else
        { 
          [color=green]//Si NO esta entre 25cm y 60cm, esta entre 10cm y 25cm[/color]
          for(int fadeValue = 0 ; fadeValue <= 255; fadeValue +=5) 
               { 
                analogWrite(vibrador, fadeValue);                                     
               }
        }     
  }
  else
  {
       [color=green] //Si NO esta entre 10cm y 60cm, esta a menos de 10cm o a mas de 60cm, APAGAMOS vibrador.[/color]
         for(int fadeValue = 0 ; fadeValue <= 0; fadeValue +=5) 
           { 
            analogWrite(vibrador, fadeValue);                                    
           }    
  } 
  
  
  
  
  
  
  
  
  
    [color=green] //----------------------------------------
     //         VIBRADOR 2   (DERECHO)
     //----------------------------------------[/color]
[color=green]//Si Sensor 1 es menor a 50cm y mayor a 10cm activamos Vibrador 1.[/color]
if((cm2>=10)&&(cm2<=60))
  {
      [color=green]// Si esta entre 25cm y 60cm[/color]
      if((cm2>=25)&&(cm2<=60))
        {      
              [color=green]//Si esta entre 45cm y 60cm[/color]
              if((cm2>=45)&&(cm2<=60))
              {
                    for(int fadeValue = 0 ; fadeValue <= 64; fadeValue +=5) 
                       { 
                        analogWrite(vibrador2, fadeValue);                                     
                       }
              }
              else
              {  [color=green]  //Si NO esta entre 45cm y 60cm, esta entre 25cm y 45cm[/color]
                    for(int fadeValue = 0 ; fadeValue <= 127; fadeValue +=5) 
                       { 
                        analogWrite(vibrador2, fadeValue);                                     
                       }
              }
        }
       else
        { 
          [color=green]//Si NO esta entre 25cm y 60cm, esta entre 10cm y 25cm[/color]
          for(int fadeValue = 0 ; fadeValue <= 255; fadeValue +=5) 
               { 
                analogWrite(vibrador2, fadeValue);                                     
               }
        }     
  }
  else
  {
       [color=green] //Si NO esta entre 10cm y 60cm, esta a menos de 10cm o a mas de 60cm, APAGAMOS vibrador.[/color]
         for(int fadeValue = 0 ; fadeValue <= 0; fadeValue +=5) 
           { 
            analogWrite(vibrador2, fadeValue);                                    
           }    
  } 
 
 
 
 
 
 
 
 
  

   [color=green]  //----------------------------------------
     //         VIBRADOR 3   (IZQIUERDO)
     //----------------------------------------     [/color]
[color=green]//Si Sensor 1 es menor a 50cm y mayor a 10cm activamos Vibrador 1.[/color]
if((cm3>=10)&&(cm3<=60))
  {
      [color=green]// Si esta entre 25cm y 60cm[/color]
      if((cm3>=25)&&(cm3<=60))
        {      
              [color=green]//Si esta entre 45cm y 60cm[/color]
              if((cm3>=45)&&(cm3<=60))
              {
                    for(int fadeValue = 0 ; fadeValue <= 64; fadeValue +=5) 
                       { 
                        analogWrite(vibrador3, fadeValue);                                     
                       }
              }
              else
              {    [color=green]//Si NO esta entre 45cm y 60cm, esta entre 25cm y 45cm[/color]
                    for(int fadeValue = 0 ; fadeValue <= 127; fadeValue +=5) 
                       { 
                        analogWrite(vibrador3, fadeValue);                                     
                       }
              }
        }
       else
        { 
[color=green]          //Si NO esta entre 25cm y 60cm, esta entre 10cm y 25cm[/color]
          for(int fadeValue = 0 ; fadeValue <= 255; fadeValue +=5) 
               { 
                analogWrite(vibrador3, fadeValue);                                     
               }
        }     
  }
  else
  {
[color=green]        //Si NO esta entre 10cm y 60cm, esta a menos de 10cm o a mas de 60cm, APAGAMOS vibrador.[/color]
         for(int fadeValue = 0 ; fadeValue <= 0; fadeValue +=5) 
           { 
            analogWrite(vibrador3, fadeValue);                                    
           }    
  }   

  Serial.print(cm);
  Serial.print("cm");
  Serial.print("   ");
  Serial.print(cm2);
  Serial.print("cm2");
  Serial.print("   ");
  Serial.print(cm3);
  Serial.print("cm3");
  Serial.println();


[color=green]  //Tiempo de muestreo expresado en milisegundos[/color]
  delay(10);
} [color=green]//Cerramos el LOOP[/color]



[color=green]  //Convertimos las medidas de microsegundos a centimetros[/color]
long microsecondsToCentimeters(long microseconds)
{
[color=green]  // The speed of sound is 340 m/s or 29 microseconds per centimeter.
  // The ping travels out and back, so to find the distance of the
  // object we take half of the distance travelled.[/color]
  return microseconds / 29 / 2;
}

long microsecondsToCentimeters2(long microseconds)
{
[color=green]  // The speed of sound is 340 m/s or 29 microseconds per centimeter.
  // The ping travels out and back, so to find the distance of the
  // object we take half of the distance travelled.[/color]
  return microseconds / 29 / 2;
}

long microsecondsToCentimeters3(long microseconds)
{
[color=green]  // The speed of sound is 340 m/s or 29 microseconds per centimeter.
  // The ping travels out and back, so to find the distance of the
  // object we take half of the distance travelled.[/color]
  return microseconds / 29 / 2;
}
[/color]

Lo que necesitaría es un ejemplo de uso o creación de funciones, tampoco voy a pedir que se me haga el trabajo, como es lógico xDD
Muchas gracias por vuestra ayuda! :slight_smile: