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

我是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);
  }
}

最佳答案

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

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

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