通过光电模块自动感知舵机转一圈并休息八秒,虽然不够精准,足够用了。

#include <Servo.h>

Servo myservo;

int p2;

void setup() {
  Serial.begin(9600);
  myservo.attach(9);
  //pinMode(13, OUTPUT);
  //digitalWrite(13, HIGH);
  pinMode(3, INPUT_PULLUP);

}

void loop() {
  p2 = digitalRead(3);
  Serial.print(p2);
  //delay(15);
  if (p2) {
    Serial.println("LED off");
    myservo.writeMicroseconds(1400);
    delay(1000);
    myservo.writeMicroseconds(1500);
    digitalWrite(13, LOW);
    delay(8000);
  } else {
    Serial.println("LED on");
    myservo.writeMicroseconds(1400);
    digitalWrite(13, HIGH);
  }
}


标签: none

评论已关闭