オートレベリングセンサ BLTouch(3DTouch) 単独動作確認

#include <Servo.h>

const int Z_LimitSensorPin = 2;
const int ServoPin = 3;
const int LED_pin = 13;
Servo myservo;

volatile bool pinDownFlag = LOW;

void setup() {
  Serial.begin(9600);
  pinMode(LED_pin,OUTPUT);
  attachInterrupt(digitalPinToInterrupt(Z_LimitSensorPin), Z_LimitChanged, CHANGE);
  myservo.attach(ServoPin);
}

void loop() {
  String input;
  if (Serial.available() > 0) {
    input = Serial.readStringUntil('\n');
    input.replace("\r","");
    if(input == "PIN_UP"){
      Serial.println("PIN_UP");
      myservo.write(90);
    }
    if(input == "PIN_DOWN"){
      myservo.write(10);
      Serial.println("PIN_DOWN");
      pinDownFlag = true;
    }
    if(input == "RESET"){
      myservo.write(160);
      Serial.println("RESET");
    }
    if(input == "SELF_TEST"){
      myservo.write(120);
      Serial.println("SELF_TEST");
    }
    //BLTouch V2.1以降のみ
    if(input == "SW_MODE"){
      myservo.write(60);
      Serial.println("SW_MODE");
    }
  }
}

//Zmin変化時割り込み処理
void Z_LimitChanged()
{
  if(digitalRead(Z_LimitSensorPin)){
    Serial.println("Z Limit : ON");
    if(pinDownFlag){
      myservo.write(90);
      Serial.println("PIN_UP");
    }
  }else{
    Serial.println("Z Limit : OFF");
  }
}