蓝牙主从机+超声波

七禾页

const int TrigPin = 2;    //超声波的trig接arduino的2号数字口
const int EchoPin = 3;  //超声波的Echo接3号口
float cm;
void setup()
{
Serial.begin(9600);     //设置串口通信波特率，这个看你使用的蓝牙模块，一般为9600
pinMode(TrigPin, OUTPUT);
pinMode(EchoPin, INPUT);
}
void loop()
{
digitalWrite(TrigPin, LOW); //低高低电平发一个短时间脉冲去TrigPin    这一部分为测距部分，可以得到距离。
delayMicroseconds(2);
digitalWrite(TrigPin, HIGH);
delayMicroseconds(10);
digitalWrite(TrigPin, LOW);
cm = pulseIn(EchoPin, HIGH) / 58.0; //将回波时间换算成cm
cm = (int(cm * 100.0)) / 100.0; //保留两位小数


Serial.print('+');  
Serial.print(cm);
Serial.print("cm");
Serial.print('=');
delay(500);
}

//从机代码结束