问题遇到的现象和发生背景
#include <Servo.h>
Servo myservo;
int TrgPin = A0; // 设置超声波发送引脚
int EcoPin = A1; // 设置超声波接收引脚
int PWM = 3; // 设置舵机引脚
float dist;
void setup() {
myservo.attach(PWM); //绑定舵机的引脚号
Serial.begin(9600); // 设置串口波特率
pinMode(TrgPin, OUTPUT); // 设置引脚为输出模式
pinMode(EcoPin, INPUT); // 设置引脚为接收模式
}
void loop() {
digitalWrite(TrgPin, LOW); // 向超声波引脚输出低位电压0
delayMicroseconds(8); // 等待8毫秒
digitalWrite(TrgPin, HIGH); //向超声波引脚输出高位电压1
delayMicroseconds(10); // 等待10毫秒
digitalWrite(TrgPin, LOW); //向超声波引脚输出低位电压0
dist = pulseIn(EcoPin, HIGH) /58; // 读取接收超声波数据,并且将模拟信号换算成cm
Serial.print("Distance:"); // 向串口发送数据
Serial.print(dist); // 向串口发送数据
Serial.println("cm"); // 向串口发送数据
delay(300); // 等待 800毫秒
if (dist <10){ // 判断距离是否小过10CM
myservo.write(60); // 控制舵机旋转
delay(20); // 等待 20毫秒
} else {
myservo.write(0); // 控制舵机旋转
}
}
运行结果及报错内容
超声波检测到距离小于10cm时反而不转动,大于10cm反而动,转动时超过了180度,由于我的舵机是180度的,超过后卡齿发出巨大的噪声
我想要达到的结果
超声波检测到距离小于10cm时转动60度,大于10cm不动