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

eobeom

我想做一个刷卡打开的保险柜 但是我的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[i]=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[0] == id_0 || 
     rfid.uid.uidByte[0] == id_1 ||  
     rfid.uid.uidByte[0] == id_2 ||  
     rfid.uid.uidByte[0] == id_3){ //（当它是正确的地址值时）
    cnt = 1; 
  }
}

void printHex(byte *buffer,byte bufferSize){ //(ID 16进数转换)
  for(byte i = 0;i<bufferSize;i++){
    Serial.print(buffer[i] < 0X10 ? "0":" ");
    Serial.print(buffer[i],HEX);
  }
}