//-------------------khai bao bienn-----------

int TT=0;
//---------------- define pin ------------------
#define LOA 11
#define ROLE 12
#define TRIG 8
#define ECHO 7

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

unsigned long xung;
int distance, khoangcach;
void do_khoang_cach()
{
digitalWrite(TRIG , LOW); delayMicroseconds(2);
digitalWrite(TRIG , HIGH);delayMicroseconds(10);
digitalWrite(TRIG , LOW);
xung = pulseIn(ECHO, HIGH, 5000);
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 > 1)&&(khoangcach <= 40))

{ delay(10);
do_khoang_cach();
if ((khoangcach > 1)&&(khoangcach <= 40))
{
TT=!TT; delay(10);
if(TT==0) {tat_den();delay(3000); }
else {bat_den();delay(3000); }
}
}

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

-------------------------------------------

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_den()
{ pip_1();
digitalWrite(ROLE,HIGH);
}
void tat_den()
{ pip_2();
digitalWrite(ROLE,LOW);
}