准备用两个红外探头控制一个舵机的转动，探头是3.3V，舵机时5V的，写出来后舵机根本不按照写的转动，无规律的转，然后又试了一个探头控制舵机，是好的，两个探头控制源程序如下，哪个大佬帮忙看下是咋回事/? 感觉程序应该没错了，会不会是硬件连接问题，舵机和探头均未加电阻，板子是Arduion UNO,
#include <Servo.h> // 声明调用Servo.h库
Servo myservo; // 创建一个舵机对象
int zhi = 60; //变量zhi用来储存舵机位置
void setup() {
myservo.attach(5); // 将引脚5上的舵机与声明的舵机对象连接起来
pinMode(2, INPUT_PULLUP); //将引脚4连接到探头1上拉 左
pinMode(3, INPUT_PULLUP); //将引脚5连接到探头2 右
}
void loop() {
int va = digitalRead(2); //定义探头1信号为va 左
int vb = digitalRead(3); //定义探头2信号为vb 右
if(va == HIGH && vb== HIGH) //直游
{
for(zhi =60; zhi < 120; zhi += 1){ // 舵机从60°转到120°，每次增加1°
myservo.write(zhi); // 给舵机写入角度
delay(15); // 延时15ms让舵机转到指定位置
}
for(zhi = 120; zhi>=60; zhi-=1) { // 舵机从120°转回到60°，每次减小1°
myservo.write(zhi); // 写角度到舵机
delay(15); // 延时15ms让舵机转到指定位置
}
}
if(va == LOW && vb == HIGH) //左游
{
for(zhi =60; zhi < 100; zhi += 1){ // 舵机从60°转到100°，每次增加1°
myservo.write(zhi); // 给舵机写入角度
delay(15); // 延时15ms让舵机转到指定位置
}
for(zhi = 100; zhi>=60; zhi-=1) { // 舵机从100°转回到60°，每次减小1°
myservo.write(zhi); // 写角度到舵机
delay(15); // 延时15ms让舵机转到指定位置
}
}
if(va == HIGH && vb == LOW) //右游
{
for(zhi =80; zhi < 120; zhi += 1){ // 舵机从80°转到120°，每次增加1°
myservo.write(zhi); // 给舵机写入角度
delay(15); // 延时15ms让舵机转到指定位置
}
for(zhi = 120; zhi>=80; zhi-=1) { // 舵机从120°转回到80°，每次减小1°
myservo.write(zhi); // 写角度到舵机
delay(15); // 延时15ms让舵机转到指定位置
}
}
|
QQ好友和群
QQ空间
腾讯微博
腾讯朋友
收藏
淘帖
顶
踩
