Code buồng khử khuẩn toàn thân

Code
//------------------khai bao bien----------

int TT=0;

//---------------- define pin ------------------

#define LOA    11

#define ROLE    12

#define TRIG  8

#define ECHO  7



//---------------- valuable ------------------

unsigned long xung;

int distance, khoangcach,lap;

void do_khoang_cach()

{

  digitalWrite(TRIG , LOW);   delayMicroseconds(2);

  digitalWrite(TRIG , HIGH); delayMicroseconds(10);

  digitalWrite(TRIG , LOW);

  xung = pulseIn(ECHO, HIGH, 15000);

  distance = xung / 29.1 / 2;

  if(distance <= 0) {khoangcach = 0;}

  else {khoangcach = distance;}

}



void setup()

{



    pinMode(LOA, OUTPUT);

    pinMode(ROLE, OUTPUT);

    pinMode(TRIG , OUTPUT);

    pinMode(ECHO , INPUT);           



}



void loop()

{                                                                                                                                                                                                     



                   do_khoang_cach();

                   if ((khoangcach > 2)&&(khoangcach <= 150))

                          {  delay(10);

                            do_khoang_cach();

                           if ((khoangcach > 2)&&(khoangcach <= 150))

                             {       

                              bat_den();delay(20000);tat_may();                       

                              }

                       

                       

                           }



}



//--------------------------------------- chuong trinh con -------------------------------------------

void hengio_tat(unsigned long t)

{

  unsigned long  i;



  for(i=0;i<=t;i++)

  {             do_khoang_cach();

              if ((khoangcach > 2)&&(khoangcach <= 150))

                {

                  do_khoang_cach();

                 if ((khoangcach > 2)&&(khoangcach <= 150))

                   {

                    lap =!lap; delay(10);             

                    break;

                   }

                }

  }





}



void pip_1()

{

  digitalWrite(LOA,HIGH);

  delay(200);

  digitalWrite(LOA,LOW);

  delay(100);

}

void pip_2()

{

  digitalWrite(LOA,HIGH);

  delay(100);

  digitalWrite(LOA,LOW);

  delay(50);

  digitalWrite(LOA,HIGH);

  delay(100);

  digitalWrite(LOA,LOW);

  delay(50);

}





void bat_may()

{ pip_1();

  digitalWrite(ROLE,HIGH);

}

void tat_may()

{ pip_2();

  digitalWrite(ROLE,LOW);

}