diff --git a/THE DOOR MAN b/THE DOOR MAN new file mode 100644 index 0000000..8d44e9e --- /dev/null +++ b/THE DOOR MAN @@ -0,0 +1,116 @@ +#include +const int servo_Pin_parpados = 3; +const int servo_Pin_ojos_derecha_X = 7; +const int servo_Pin_ojos_izquierda_X = 5; +const int servo_Pin_ojos_derecha_Y = 10; +const int servo_Pin_ojos_izquierda_Y = 9; + +Servo servo_parpados; +Servo servo_derecha_ojosY; +Servo servo_izquierda_ojosY; +Servo servo_derecha_ojosX; +Servo servo_izquierda_ojosX; + + +const int inputPinPIR = 12; + + +const int pinLED = 13; + + +int statePIR = LOW; + +int leer_inicio_PIR = 0; + +void setup() { + + pinMode(inputPinPIR, INPUT); + + pinMode(pinLED, OUTPUT); + + + servo_parpados.attach(servo_Pin_parpados); + servo_derecha_ojosX.attach(servo_Pin_ojos_derecha_X); + servo_izquierda_ojosX.attach(servo_Pin_ojos_izquierda_X); + servo_derecha_ojosY.attach(servo_Pin_ojos_derecha_Y); + servo_izquierda_ojosY.attach(servo_Pin_ojos_izquierda_Y); + + servo_parpados.write(160); + servo_derecha_ojosX.write(15); + servo_izquierda_ojosX.write(15); + servo_derecha_ojosY.write(5); + servo_izquierda_ojosY.write(107); + + + Serial.begin(9600); + Serial.println("Start"); +} +void loop() { + + leer_inicio_PIR = digitalRead(inputPinPIR); + if (leer_inicio_PIR == HIGH) { + digitalWrite(pinLED, HIGH); + if (statePIR == LOW) { + + abrir_ojos(); + delay(3000); + girar_ojos_izquiersa(); + delay(3000); + girar_ojos_derecha(); + delay(3000); + girar_ojo_diagonal_derecha(); + delay(3000); + girar_ojo_diagonal_izquieda(); + delay(3000); + posicion_inicial(); + delay(3000); + cerrar_ojos(); + delay(3000); + + statePIR = HIGH; + } + } else { + if(statePIR == HIGH) { + delay(3000); + + digitalWrite(pinLED, LOW); + cerrar_ojos(); + delay(1000); + statePIR = LOW; + + } + } +} + +void abrir_ojos() { + servo_parpados.write(180); +} +void cerrar_ojos() { + servo_parpados.write(80); +} +void girar_ojos_izquiersa() { + servo_derecha_ojosX.write(120); + servo_izquierda_ojosX.write(120); +} +void girar_ojos_derecha() { + servo_derecha_ojosX.write(20); + servo_izquierda_ojosX.write(20); +} +void girar_ojo_diagonal_derecha() { + servo_derecha_ojosX.write(20); + servo_izquierda_ojosX.write(20); + servo_derecha_ojosY.write(90); + servo_izquierda_ojosY.write(90); +} +void girar_ojo_diagonal_izquieda() { + servo_derecha_ojosX.write(120); + servo_izquierda_ojosX.write(120); + servo_derecha_ojosY.write(90); + servo_izquierda_ojosY.write(90); +} +void posicion_inicial() { + servo_derecha_ojosX.write(45); + servo_izquierda_ojosX.write(45); + servo_derecha_ojosY.write(45); + servo_izquierda_ojosY.write(45); +}