如何用按钮控制伺服马达旋转角度

LUCY12398

我想做一个刷卡打开的保险柜 但是我的RFID坏了所以没有办法读卡 我就打算在RFID旁边加一个按钮 然后我还有一个碰撞传感器来控制门的开关
原本的工作原理是：RFID读卡->是对的卡->打开保险柜门->放入东西->按冲突传感器把门关上 但是我的RFID不是坏了嘛 所以打算在边上加一个按钮 也就是用按钮控制门打开 用冲突传感器控制保险柜门关 请问下面这个程序该怎么改 我按按钮没有反应 按冲突传感器会回转（RFID的程序我还是希望留着） 请问各位大佬怎么写？

1. #include <SPI.h>
   
2. #include <MFRC522.h>
   
3. #include <Servo.h>
   
4. 
   
5. #define id_0 0xA9
   
6. #define id_1 0x46
   
7. #define id_2 0x79
   
8. #define id_3 0x89
   
9. #define SS_PIN 53 //（复位引脚设置用于SPI通信的SS（片选）引脚设置）
   
10. #define RST_PIN 9 //（重置引脚设置）
    
11. 
    
12. MFRC522 rfid(SS_PIN,RST_PIN);
    
13. MFRC522::MIFARE_Key key;
    
14. 
    
15. Servo servo;
    
16. 
    
17. int crash = 7;
    
18. int cnt = 0;
    
19. int value = 0;
    
20. 
    
21. 
    
22. 
    
23. void setup() {
    
24.   Serial.begin(9600);
    
25.   SPI.begin(); //
    
26.   rfid.PCD_Init(); //（RFID初始化）
    
27.   servo.attach(6);
    
28.   pinMode(crash,INPUT);
    
29.   for(byte i = 0;i < 6 ; i++){
    
30.     key.keyByte[i]=0xff; //（KEY ID初始化）
    
31.   }
    
32.   Serial.println(F("Using the following key:"));
    
33.   printHex(key.keyByte,MFRC522::MF_KEY_SIZE);
    
34. 
    
35. }
    
36. 
    
37. void loop() {
    
38. 
    
39.   if(cnt == 1){
    
40.     servo.write(90);
    
41.   }else{
    
42.     servo.write(0);
    
43.   }
    
44.   if(digitalRead(crash) == 0){
    
45.     cnt = 0;
    
46.   }
    
47.   
    
48.   if(! rfid.PICC_IsNewCardPresent())//（仅在有联系时前进到下一步）
    
49.   return;
    
50.   if(! rfid.PICC_ReadCardSerial()) //（如果正确读取了卡，则移至下一张）
    
51.   return;  
    
52.   Serial.print(" ID :");
    
53.   printHex(rfid.uid.uidByte,rfid.uid.size); //（输出ID）
    
54.   Serial.println("\n");
    
55. 
    
56.   if(rfid.uid.uidByte[0] == id_0 ||
    
57.      rfid.uid.uidByte[0] == id_1 ||  
    
58.      rfid.uid.uidByte[0] == id_2 ||  
    
59.      rfid.uid.uidByte[0] == id_3){ //（当它是正确的地址值时）
    
60.     cnt = 1;
    
61.   }
    
62. }
    
63. 
    
64. void printHex(byte *buffer,byte bufferSize){ //(ID 16进数转换)
    
65.   for(byte i = 0;i<bufferSize;i++){
    
66.     Serial.print(buffer[i] < 0X10 ? "0":" ");
    
67.     Serial.print(buffer[i],HEX);
    
68.   }
    
69. }

复制代码