57 lines
1.0 KiB
C++
Executable File
57 lines
1.0 KiB
C++
Executable File
#include <Servo.h>
|
|
|
|
Servo myservo_X;
|
|
bool estado_termo;
|
|
byte medio;
|
|
|
|
void setup() {
|
|
myservo_X.attach(9);
|
|
Serial.begin(9600);
|
|
}
|
|
|
|
void loop() {
|
|
|
|
/* Movimiento Servo, accion On (120) - Off (45)
|
|
* mitad real (75?)
|
|
* actuar a 3 fases por lado
|
|
|
|
myservo_X.write(120);
|
|
delay(1000);
|
|
Serial.println("ON");
|
|
myservo_X.write(45);
|
|
delay(1000);
|
|
Serial.println("OFF");
|
|
*/
|
|
termo(estado_termo);
|
|
}
|
|
|
|
void termo(bool estado) {
|
|
if (!estado) {
|
|
Serial.println("ON");
|
|
myservo_X.write(120);
|
|
delay(500);
|
|
myservo_X.write(110);
|
|
delay(500);
|
|
myservo_X.write(120);
|
|
delay(500);
|
|
myservo_X.write(110);
|
|
delay(500);
|
|
myservo_X.write(120);
|
|
delay(2000);
|
|
estado_termo = !estado_termo;
|
|
} else {
|
|
Serial.println("OFF");
|
|
myservo_X.write(45);
|
|
delay(500);
|
|
myservo_X.write(62);
|
|
delay(500);
|
|
myservo_X.write(45);
|
|
delay(500);
|
|
myservo_X.write(62);
|
|
delay(500);
|
|
myservo_X.write(45);
|
|
delay(2000);
|
|
estado_termo = !estado_termo;
|
|
}
|
|
}
|