Ultrasonic sensors and motor operation

#define SENSOR_TR 6
#define SENSOR_EC 7

 

//변수 선언

void Init();
float Read_Distance();
int DEvent();

 

//pinMode 설정

void Init()
{
   pinMode(SENSOR_TR, OUTPUT);
   pinMode(SENSOR_EC, INPUT);
}

 

//거리읽기

float Read_Distance()
{
   digitalWrite(SENSOR_TR, LOW);
   delayMicroseconds(2);
   digitalWrite(SENSOR_TR, HIGH);
   delayMicroseconds(10);
   digitalWrite(SENSOR_TR, LOW);
  
   float fDistance = pulseIn(SENSOR_EC, HIGH) / 29.0 / 2.0;  
//      Serial.println(fDistance);  // for test

    return fDistance;
}

 

// 이벤트

int DEvent()
{
    float fTemp = Read_Distance();

    
    if (fTemp >= 10)   
    {
        return 180;
    }
    else
    {
        return 0;
    }
}

KakaoTalk_20201126_201941107.mp4

3.00MB