如何用按钮控制伺服马达旋转角度
我想做一个刷卡打开的保险柜 但是我的RFID坏了所以没有办法读卡 我就打算在RFID旁边加一个按钮 然后我还有一个碰撞传感器来控制门的开关原本的工作原理是:RFID读卡->是对的卡->打开保险柜门->放入东西->按冲突传感器把门关上 但是我的RFID不是坏了嘛 所以打算在边上加一个按钮 也就是用按钮控制门打开 用冲突传感器控制保险柜门关 请问下面这个程序该怎么改 我按按钮没有反应 按冲突传感器会回转(RFID的程序我还是希望留着) 请问各位大佬怎么改?
#include <SPI.h>
#include <MFRC522.h>
#include <Servo.h>
#define id_0 0xA9
#define id_1 0x46
#define id_2 0x79
#define id_3 0x89
#define SS_PIN 53 //(复位引脚设置用于SPI通信的SS(片选)引脚设置)
#define RST_PIN 9 //(重置引脚设置)
MFRC522 rfid(SS_PIN,RST_PIN);
MFRC522::MIFARE_Key key;
Servo servo;
int crash = 7;
int cnt = 0;
int value = 0;
void setup() {
Serial.begin(9600);
SPI.begin(); //
rfid.PCD_Init(); //(RFID初始化)
servo.attach(6);
pinMode(crash,INPUT);
for(byte i = 0;i < 6 ; i++){
key.keyByte=0xff; //(KEY ID初始化)
}
Serial.println(F("Using the following key:"));
printHex(key.keyByte,MFRC522::MF_KEY_SIZE);
}
void loop() {
if(cnt == 1){
servo.write(90);
}else{
servo.write(0);
}
if(digitalRead(crash) == 0){
cnt = 0;
}
if(! rfid.PICC_IsNewCardPresent())//(仅在有联系时前进到下一步)
return;
if(! rfid.PICC_ReadCardSerial()) //(如果正确读取了卡,则移至下一张)
return;
Serial.print(" ID :");
printHex(rfid.uid.uidByte,rfid.uid.size); //(输出ID)
Serial.println("\n");
if(rfid.uid.uidByte == id_0 ||
rfid.uid.uidByte == id_1 ||
rfid.uid.uidByte == id_2 ||
rfid.uid.uidByte == id_3){ //(当它是正确的地址值时)
cnt = 1;
}
}
void printHex(byte *buffer,byte bufferSize){ //(ID 16进数转换)
for(byte i = 0;i<bufferSize;i++){
Serial.print(buffer < 0X10 ? "0":" ");
Serial.print(buffer,HEX);
}
}
页:
[1]