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