Humana trampa de multi-ratón Zapper - No muerte instantánea del dolor (4 / 4 paso)

Paso 4: Código de fuente

*/
#include < Servo.h >
Servo1 servo;
pernos de
int ledPin = 13;                                       LED conectado al pin digital 13
int AnalogNoseSensorPin = A0; Pin analógico 0
int relayControlPin = 50;
int servoPin = 15;
Declerations
int NoseLocationVal = 0; valor del sensor led
Constantes
const int DebugSerialSpeed = 9600;
void setup()
{
servo1.Attach(servoPin);
pinMode(relayControlPin,OUTPUT);
pinMode (ledPin, salida);      pone el pin digital como salida
pinMode(AnalogNoseSensorPin,INPUT);  del acelerador manejar analógico en 0
Serial.Begin(DebugSerialSpeed);
}

void loop()
{
digitalWrite (ledPin, HIGH);   el LED se pone en
Delay(100);                  espera un segundo
digitalWrite (ledPin, LOW);    fija el LED apagado
Delay(100);                  espera un segundo
servo1.Write(150); / / cerrar puerta trampa
pinMode (servoPin, entrada); //silence Servo
NoseLocationVal = analogRead(AnalogNoseSensorPin); Sensor óptico
Si (NoseLocationVal < 50) {//Check si el ratón está dentro de
digitalWrite(relayControlPin,LOW); Zap a lo
Delay(1000); / / Zap para 1 seg.
digitalWrite(relayControlPin,HIGH); Dejar de Zap
pinMode(servoPin,OUTPUT); Active Servo
servo1.Write(20); / / abierta la puerta trampa
Delay(2000); / / espera para que ratón, mouse caer
servo1.Write(150); / / cerrar puerta trampa
Delay(1000); / / espere trampilla cerrar
}
digitalWrite(relayControlPin,HIGH) otra cosa; No choque

Serial.println(NoseLocationVal);
}