Arduino舵机急停代码

以下是一个用于急停Arduino舵机的示例代码：

#include <Servo.h>

Servo myservo;
int servoPin = 9;
int emergencyStopPin = 2;
int previousEmergencyStopState = HIGH;
int servoPosition = 90; // 初始舵机位置

void setup() {
  myservo.attach(servoPin);
  pinMode(emergencyStopPin, INPUT);
}

void loop() {
  int emergencyStopState = digitalRead(emergencyStopPin);

  if (emergencyStopState == LOW && previousEmergencyStopState == HIGH) {
    // 急停按钮按下时
    servoPosition = 90; // 将舵机位置设置为中间，即停止位置
    myservo.write(servoPosition);
    delay(100); // 稍微延迟一下，避免抖动
  }

  previousEmergencyStopState = emergencyStopState;
}

请确保将舵机的控制引脚（servoPin）和急停按钮的引脚（emergencyStopPin）与代码中的引脚定义匹配。这段代码会持续监测急停按钮的状态，一旦按钮被按下，舵机位置会被设置为中间位置，从而实现急停功能。