Humana flera mus fälla Zapper - ingen smärta ögonblicklig död (4 / 4 steg)
Steg 4: Source Code
/ * Humana musen Zapper - Moris.Zen*/
#include < Servo.h >
Servo servo1;
Pins
int ledPin = 13. LED är ansluten till digital stift 13
int AnalogNoseSensorPin = A0; Analoga Pin 0
int relayControlPin = 50;
int servoPin = 15.
Försäkran
int NoseLocationVal = 0; värdet av led sensorn
Konstanter
CONST int DebugSerialSpeed = 9600;
void setup()
{
servo1.attach(servoPin);
pinMode(relayControlPin,OUTPUT);
pinMode (ledPin, produktionen); Anger den digitala pin som utdata
pinMode(AnalogNoseSensorPin,INPUT); spjäll hantera Analog i 0
Serial.BEGIN(DebugSerialSpeed);
}
void loop()
{
digitalWrite (ledPin, hög); anger LED på
Delay(100); väntar på en sekund
digitalWrite (ledPin, låg); framhäver LED
Delay(100); väntar på en sekund
servo1.write(150); / / nära lucka
pinMode (servoPin, ingång); //silence Servo
NoseLocationVal = analogRead(AnalogNoseSensorPin); Optisk sensor
om (NoseLocationVal < 50) {//Check om musen är inne
digitalWrite(relayControlPin,LOW); ZAP det
Delay(1000); / / Zap för 1 SEK
digitalWrite(relayControlPin,HIGH); Stoppa Zap
pinMode(servoPin,OUTPUT); Aktivera Servo
servo1.write(20); / / öppen lucka
Delay(2000); / / vänta på musen falla
servo1.write(150); / / nära lucka
Delay(1000); / / wait för lucka att stänga
}
annat digitalWrite(relayControlPin,HIGH); Ingen chock
Serial.println(NoseLocationVal);
}