Arduino Uno +伺服电机(SG-90)+超声波传感器(HC-S04)检测到障碍物

时间:2018-01-05 18:39:46

标签: c++ arduino servo arduino-ultra-sonic

我是Arduino的新手。目标是编写一个程序,如果有太多物体堆积在皮带上,可以阻止假想的传送带(读取伺服电机),这是由HC-S04传感器检测到的。如果距离超过最小阈值(1000),则电动机可以自由旋转。如果没有,它应该停止。使用下面的代码,我得到一个伺服电机旋转,无论物体是否在它前面。 试图取出并更改delay。它只是旋转得更快或更慢,但仍然忽略了障碍物距离。试过评论sensorValue = map(sensorValue, 0, 255, 0, 4000);,但它并没有影响结果。

#include <Servo.h>
#include <Wire.h>

Servo servo;
const int trigPin= 9;
const int echoPin= 10;
const int threshold = 1000;

void setup() {
pinMode(trigPin, OUTPUT);
pinMode(echoPin,INPUT);
Serial.begin(9600);
servo.attach(8);

}

void loop() {
  int sensorValue = digitalRead(echoPin);
  sensorValue = map(sensorValue, 0, 255, 0, 4000);
  if (sensorValue >= threshold) {
    digitalWrite(8,HIGH);
    delay(10);
   }

  else {
    digitalWrite(8,LOW);
   delay(10);
  }
}

1 个答案:

答案 0 :(得分:0)

通过输出sensorValue内容进行调试 - 这将允许您检查触发了哪个分支。

(不能发表评论,因为我的代表不够高)。

您可以使用调试值来检查,配置和校准传感器。