arduino2个超声波传感器的使用 [复制链接]

上一主题下一主题查看指定楼层

离线神奇树叶

1元学习Allegro(1期)

性别:: 帅哥

发帖: 91

金币: 160

提示：会员销售的附件,下载积分 = 版块积分 + 销售积分只看楼主倒序阅读使用道具 0楼发表于: 2019-10-04

#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()
{
}