Robofun 機器人論壇

標題: 該如何獨立運作3個不同或以上的超音波感測? [打印本頁]

作者: 比利 時間: 2018-5-9 21:24
標題: 該如何獨立運作3個不同或以上的超音波感測?
該如何獨立運作不同的超音波?
程式需求:  三個超音波各有3個相應的led 燈當有物體接近或離開各個超音波會亮
我是用mega版，超音波是hc-hr04
有試做之後發現監控視窗出來的都是0公分或是51公分
是哪裡有問題?
程式如下

int ledPin1 = 3;
int ledPin2 = 4;
int ledPin3 = 5;

int trigPin1 = 6;
int echoPin1 = 7;

int trigPin2 = 8;
int echoPin2 = 9;

int trigPin3 = 10;
int echoPin3 = 11;

void setup() {
  Serial.begin (9600);
  pinMode(trigPin1, OUTPUT);
  pinMode(echoPin1, INPUT);

  pinMode(trigPin2, OUTPUT);
  pinMode(echoPin2, INPUT);

  pinMode(trigPin3, OUTPUT);
  pinMode(echoPin3, INPUT);

  pinMode(ledPin1, OUTPUT);
  pinMode(ledPin2, OUTPUT);
  pinMode(ledPin3, OUTPUT);
}

void firstsensor(){
  int duration1, distance1;
  digitalWrite (trigPin1, HIGH);
  delayMicroseconds (10);
  digitalWrite (trigPin1, LOW);
  duration1 = pulseIn (echoPin1, HIGH);
  distance1 = (duration1/2) / 29.1;

   Serial.print("1st Sensor: ");
   Serial.print(distance1);
   Serial.print("cm ");

  if (distance1 < 30) {
digitalWrite (ledPin1, HIGH);
  } else {
digitalWrite (ledPin1, LOW);
  }
}
void secondsensor(){
int duration2, distance2;
digitalWrite (trigPin2, HIGH);
delayMicroseconds (10);
digitalWrite (trigPin2, LOW);
duration2 = pulseIn (echoPin2, HIGH);
distance2 = (duration2/2) / 29.1;

   Serial.print("2nd Sensor: ");
   Serial.print(distance2);
   Serial.print("cm ");

if (distance2 < 20) {
   digitalWrite (ledPin2, HIGH);
}
else {
   digitalWrite (ledPin2, LOW);
}
}
void thirdsensor(){ // This function is for third sensor.
int duration3, distance3;
digitalWrite (trigPin3, HIGH);
delayMicroseconds (10);
digitalWrite (trigPin3, LOW);
duration3 = pulseIn (echoPin3, HIGH);
distance3 = (duration3/2) / 29.1;

   Serial.print("3rd Sensor: ");
   Serial.print(distance3);
   Serial.print("cm");

if (distance3 < 10) {
   digitalWrite (ledPin3, HIGH);
}
else {
   digitalWrite (ledPin3, LOW);
}
}

void loop() {
Serial.println("\n");
firstsensor();
secondsensor();
thirdsensor();
delay(100);
}

作者: 超新手 時間: 2018-5-10 08:14
試試看
在不改程式的情況下, 先拔掉其中兩個超音波的電源
結果會怎樣?

作者: 比利 時間: 2018-5-10 12:52
結果是一樣的

作者: 超新手 時間: 2018-5-10 12:58
是不是接錯了?
看來程式是OK
所以不管有沒有物體, 距離都是 0 或 51 嗎?

作者: 比利 時間: 2018-5-10 13:16
應該不是接錯了我跟我朋友有都檢查好幾次
我只測試1個示波器時是有功能的但到2個以上功能就不能了 (硬體方面都沒有動

會是程式衝突嗎?

作者: 超新手 時間: 2018-5-10 14:42
我試過沒問題, 除了沒加3 個 LED
都可正常讀到距離值

DSC_0325.JPG (189.89 KB, 下載次數: 205)

作者: 超新手 時間: 2018-5-10 14:51
對了, 超音波會互相影響, 使用時要朝向不同方位

歡迎光臨 Robofun 機器人論壇 (https://robofun.net/forum/)