超声波壁障小车实现及代码-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 left;

Servo rig