Stap 4: Broncode
/ * Humane muis Zapper - Moris.Zen*/
#include < Servo.h >
Servo servo1;
pinnen
int ledPin = 13; LED aangesloten op digital pin 13
int AnalogNoseSensorPin = A0; Analoge Pin 0
int relayControlPin = 50;
int servoPin = 15;
Declerations
int NoseLocationVal = 0; waarde van de led sensor
Constanten
Const int DebugSerialSpeed = 9600;
VOID Setup
{
servo1.attach(servoPin);
pinMode(relayControlPin,OUTPUT);
pinMode (ledPin, OUTPUT); Hiermee stelt u de digitale pen als uitvoer
pinMode(AnalogNoseSensorPin,INPUT); gaspedaal handvat analoge 0
Serial.begin(DebugSerialSpeed);
}
void loop
{
digitalWrite (ledPin, hoge); Hiermee stelt u de LED op
delay(100); wacht een seconde
digitalWrite (ledPin, laag); de LED vertrekt
delay(100); wacht een seconde
servo1.write(150); / / trap deur dicht
pinMode (servoPin, INPUT); //silence Servo
NoseLocationVal = analogRead(AnalogNoseSensorPin); Optische sensor
Als (NoseLocationVal < 50) {//Check als muis is binnen
digitalWrite(relayControlPin,LOW); Zappen
delay(1000); / / zappen voor 1 Sec
digitalWrite(relayControlPin,HIGH); Stoppen van Zap
pinMode(servoPin,OUTPUT); Servo activeren
servo1.write(20); / / Open Trap deur
delay(2000); / / wait voor muis te vallen
servo1.write(150); / / trap deur dicht
delay(1000); / / wait voor trap deur te sluiten
}
anders digitalWrite(relayControlPin,HIGH); Geen schok
Serial.println(NoseLocationVal);
}