超聲波壁障小車實現及代碼-01

/*

日期:2016.03.19

IDE 版本:1.5.6

功能：利用SR04超聲波傳感器進行測距，並用串口顯示測出的距離值

*/



// 設定SR04連接的Arduino引腳

const int TrigPin = 3;

const int EchoPin = 2;

float distance;

void setup()

{   // 初始化串口通信及連接SR04的引腳

        Serial.begin(9600);

        pinMode(TrigPin, OUTPUT);

    // 要檢測引腳上輸入的脈衝寬度，需要先設置爲輸入狀態

        pinMode(EchoPin, INPUT);

    Serial.println("Ultrasonic sensor:");

}

void loop()

{

    // 產生一個10us的高脈衝去觸發TrigPin

        digitalWrite(TrigPin, LOW);

        delayMicroseconds(2);

        digitalWrite(TrigPin, HIGH);

        delayMicroseconds(10);

        digitalWrite(TrigPin, LOW);

    // 檢測脈衝寬度，並計算出距離

        distance = pulseIn(EchoPin, HIGH) / 58.00;

        Serial.print(distance);

        Serial.print("cm");

        Serial.println();

        delay(1000);

}

---

/*

Date:2016-03-20

Name:超聲波避障小車v1.0

Writer:Kang

Arduino IDE 1.5.6

*/

#include <Servo.h>               //調用舵機庫

Servo left;

Servo rig