arduino2个超声波传感器的使用

神奇树叶 · 发表于 2019-10-4 14:52:42

马上注册，结交更多好友，享用更多功能，让你轻松玩转社区

您需要登录才可以下载或查看，没有账号？立即注册

×

#include <MsTimer2.h>
#define ECHOPIN_1 A0
#define TRIGPIN_1 A1
#define ECHOPIN_2 A4
#define TRIGPIN_2 A5
float a;
float b;
int i=0;
void setup()
{
  Serial.begin(9600);
  pinMode(ECHOPIN_1, INPUT);
  pinMode(TRIGPIN_1, OUTPUT);
  pinMode(ECHOPIN_2, INPUT);
  pinMode(TRIGPIN_2, OUTPUT);
  MsTimer2::set(500,flash);
  MsTimer2::start();
}
void flash()
{
  switch(i)
  {
case 0:ultra_1();break;
case 1:ultra_2();break;
default:break;
  }
  i++;
  i%=2;
}
void ultra_1()
{
  digitalWrite(TRIGPIN_1, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIGPIN_1, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIGPIN_1, LOW);
  a = pulseIn(ECHOPIN_1, HIGH)/58;

  Serial.println(a);
}
void ultra_2()
{
  digitalWrite(TRIGPIN_2, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIGPIN_2, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIGPIN_2, LOW);
  b = pulseIn(ECHOPIN_2, HIGH)/58;

  Serial.println(b);
}
void loop()
{
}