倒車雷達模擬

#define m1  294    //頻率1

#define m5  440    //頻率2

#define h5  880    //頻率3

int red = 2;

int yellow = 3;

int green = 4;

int v=5;                     //蜂鳴器輸出

int trigPin = 12;            //定義 觸發輸出腳位 Trig Pin

int echoPin = 11;            //定義 回音接收腳位 Echo Pin

float duration, distance;    //定義 時間長度duration 與 距離distance 格式為 浮點數

void setup(){

    Serial.begin(9600);        //設定 序列埠 鮑率

    while (!Serial){ ;}          //等待序列埠接通

    pinMode(red, OUTPUT);

    pinMode(yellow, OUTPUT);

    pinMode(green, OUTPUT);

    pinMode(v, OUTPUT);

    pinMode(trigPin, OUTPUT);    //設定 觸發輸出腳位(trigPin)的功能為 輸出(OUTPUT)

    pinMode(echoPin, INPUT);     //設定 回音接收腳位(echoPin)的功能為 輸入(INPUT)

}

void loop(){

    //於 觸發輸出腳位 Trig Pin 產生觸發脈衝(應大於 10微秒)

    digitalWrite(trigPin, LOW);     // 讓觸發腳位trigPin 確實降回低電位，持續 20微秒 (us)

    delayMicroseconds(20);

    digitalWrite(trigPin, HIGH);    // 觸發腳位trigPin 變成高電位，持續 20微秒  (us)

    delayMicroseconds(20);

    digitalWrite(trigPin, LOW);     // 觸發腳位trigPin 再降回低電位，完成脈衝，使HC-SR04產生聲音脈衝出去

    duration = pulseIn(echoPin, HIGH);    // 於回音接收腳位(Echo Pin) 收到高電位(High) 的時間 (微秒 us)

    distance = duration*0.0170;           // 將聲音 "來回" 時間(us) 換算成距離 (cm) [ 假設聲波速率為 340 m/s ]

    if (distance >= 25 ){

      digitalWrite(green, HIGH);

      digitalWrite(yellow, LOW); digitalWrite(red, LOW);

      tone(v, m1, 200);

      delay(250); 

    }

    else if (distance >= 10 and distance <= 25){

      digitalWrite(yellow, HIGH);

      digitalWrite(green, LOW);   digitalWrite(red, LOW);

      tone(v, m5, 150);

      delay(200);

      }              

    else {

      digitalWrite(red, HIGH);

      digitalWrite(green, LOW);   digitalWrite(yellow, LOW);

      tone(v, h5, 100);

      delay(150);

      }

    //Serial.println(distance);    // 將 距離distance 傳送到序列埠暫存器

    Serial.flush();              // 等待序列埠暫存器中的數據傳送至電腦完畢

    delayMicroseconds(duration*1.5);  //避免收到更早發出的聲音脈衝 回音

}