標(biāo)題: arduino多超聲波同時(shí)控制的方法 [打印本頁(yè)]

作者: MT不吃雞    時(shí)間: 2018-7-25 17:42
標(biāo)題: arduino多超聲波同時(shí)控制的方法
#include <Servo.h>    // 聲明調(diào)用Servo.h
float distance1;
float distance2;
float distance3;
#define T1 3
#define R1 4         //第一個(gè)超聲波
#define T2 5         //第二個(gè)超聲波
#define R2 6
#define T3 7        //第三個(gè)超聲波
#define R3 8
#define LED 2       //LED的引腳

void setup()
{
pinMode(T1,OUTPUT);
pinMode(T2,OUTPUT);
pinMode(T3,OUTPUT);
pinMode(R1,INPUT);
pinMode(R2,INPUT);
pinMode(R3,INPUT);
pinMode(LED,OUTPUT);
Serial.begin(9600);
}

void loop()
{

  /********第一個(gè)超聲波的距離***************/
digitalWrite(T1,LOW);   
delayMicroseconds(2);//拉低電平
digitalWrite(T1,HIGH);//給12us的高電平   
delayMicroseconds(10);//拉低電平
digitalWrite(T1,LOW);

distance1=pulseIn(R1,HIGH)/58;     
delay(10);
/*****************************************/

  /********第二個(gè)超聲波的距離***************/
digitalWrite(T2,LOW);   
delayMicroseconds(2);//拉低電平
digitalWrite(T2,HIGH);//給12us的高電平   
delayMicroseconds(10);//拉低電平
digitalWrite(T2,LOW);

distance2=pulseIn(R2,HIGH)/58;     
delay(10);
/*****************************************/

  /********第3個(gè)超聲波的距離***************/
digitalWrite(T3,LOW);   
delayMicroseconds(2);//拉低電平
digitalWrite(T3,HIGH);//給12us的高電平   
delayMicroseconds(10);//拉低電平
digitalWrite(T3,LOW);

distance3=pulseIn(R3,HIGH)/58;     
delay(10);
/*****************************************/

if(distance2<30)
{

  digitalWrite(LED,HIGH);
  }
  else
  {

    digitalWrite(LED,LOW);
    }



}







歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1