Advertisement
claudiusmarius

TestTCRT5000-002

Apr 26th, 2023
1,186
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 3.62 KB | None | 0 0
  1. //----------------------------------------------------------------------------------------------------------------------------------------------------------------------------
  2.   // Detection de passage bille avec detecteur TCRT5000 unitaires en les faisant travailler en différentiel
  3.   // Possibilite  de determiner le sens de passage
  4.   // Detection de cible atteinte par conduction electrique avec bille d'acier
  5.   // Vidéo YouTube DFT_#A89 DETECTION IR DIFFERENTIELLE - PINBALL-PASSAGE BILLE
  6.   // https://youtu.be/oo4GJQcbkKA
  7.   // Claude DUFOURMONT
  8.   // https://www.youtube.com/c/ClaudeDufourmont
  9.   //----------------------------------------------------------------------------------------------------------------------------------------------------------------------------
  10.  
  11.   #define BrocheLEDRed 6                                       // Droite vers Gauche
  12.   #define BrocheLEDGreen 7                                    // Gauche vers Droite
  13.   #define BrocheLEDBlue 8                                     // Target hit
  14.   #define BrocheTarget 9                                      // A corriger c'est Drain de Q1 plutot.
  15.   #define BrocheBuzzer (A5)
  16.  
  17.   float VanaIR1;                                              // Valeur sur collecteur détecteur 1
  18.   float VanaIR2;                                              // Valeur sur collecteur détecteur 1
  19.   float Vdiff12;                                              // Valeur différentielle Droite Gauche
  20.   float Vdiff21;                                              // Valeur différentielle Gauche Droite
  21.  
  22.   int seuildiff12 = 700;                                      // Seuils
  23.   int seuildiff21 = 700;
  24.  
  25.   void setup()
  26.   {
  27.   //Serial.begin(9600);  
  28.   pinMode(BrocheLEDRed,OUTPUT);  
  29.   pinMode(BrocheLEDGreen,OUTPUT);
  30.   pinMode(BrocheLEDBlue,OUTPUT);
  31.   pinMode(BrocheTarget,INPUT);
  32.   pinMode(BrocheBuzzer,OUTPUT);
  33.   }
  34.  
  35.   void loop()
  36.   {
  37.   digitalWrite (BrocheLEDRed, LOW) ;
  38.   digitalWrite (BrocheLEDGreen, LOW) ;
  39.   digitalWrite (BrocheLEDBlue, LOW) ;
  40.   digitalWrite (BrocheBuzzer, LOW) ;
  41.  
  42.   VanaIR1 = (analogRead (A1))*5;
  43.   VanaIR2 = (analogRead (A3))*5;
  44.   Vdiff12 = (VanaIR1 - VanaIR2);
  45.   Vdiff21 = (VanaIR2 - VanaIR1);
  46.  
  47.  /* Serial.print ("VanaIR1 =           ");
  48.   Serial.println (VanaIR1);
  49.    
  50.   Serial.print ("VanaIR2 =           ");
  51.   Serial.println (VanaIR2);
  52.  
  53.   Serial.print ("Vdiff =           ");
  54.   Serial.println (Vdiff);*/
  55.  
  56.  
  57.   if((Vdiff12 > seuildiff12))
  58.   {  
  59.   digitalWrite (BrocheLEDRed, HIGH) ;
  60.   digitalWrite (BrocheLEDGreen, LOW) ;
  61.   digitalWrite (BrocheLEDBlue, LOW) ;
  62.   digitalWrite (BrocheBuzzer, HIGH) ;
  63.   delay(300);
  64.   }
  65.  
  66.   if((Vdiff21 > seuildiff21))
  67.   {  
  68.   digitalWrite (BrocheLEDRed, LOW) ;
  69.   digitalWrite (BrocheLEDGreen, HIGH) ;
  70.   digitalWrite (BrocheLEDBlue, LOW) ;
  71.   digitalWrite (BrocheBuzzer, HIGH) ;
  72.   delay(300);
  73.   }
  74.  
  75.   if (digitalRead (BrocheTarget) == HIGH)
  76.   {
  77.   digitalWrite (BrocheLEDRed, LOW) ;
  78.   digitalWrite (BrocheLEDGreen, LOW) ;
  79.   digitalWrite (BrocheLEDBlue, HIGH) ;
  80.   digitalWrite (BrocheBuzzer, HIGH) ;
  81.   delay (80);
  82.   digitalWrite (BrocheBuzzer, LOW) ;
  83.   delay (10);
  84.   digitalWrite (BrocheBuzzer, HIGH) ;
  85.   delay (80);
  86.   digitalWrite (BrocheBuzzer, LOW) ;
  87.   delay (10);
  88.   digitalWrite (BrocheBuzzer, HIGH) ;
  89.   delay (80);
  90.   digitalWrite (BrocheBuzzer, LOW) ;
  91.   delay (10);
  92.   digitalWrite (BrocheBuzzer, HIGH) ;
  93.   delay (80);
  94.   digitalWrite (BrocheBuzzer, LOW) ;
  95.   delay (10);
  96.   digitalWrite (BrocheBuzzer, HIGH) ;
  97.   delay (80);
  98.   digitalWrite (BrocheBuzzer, LOW) ;
  99.   delay (10);
  100.   digitalWrite (BrocheLEDBlue, LOW) ;
  101.   delay (100);
  102.   }
  103.  
  104.   }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement