Étape 4: Source Code
/ * Souris sans cruauté Zapper - Moris.Zen*/
#include < Servo.h >
Servo servo1 ;
broches
int ledPin = 13 ; LED connectée à la broche numérique 13
int AnalogNoseSensorPin = A0 ; Broche analogique 0
int relayControlPin = 50 ;
int servoPin = 15 ;
Declerations
int NoseLocationVal = 0 ; valeur du capteur led
Constantes
const int DebugSerialSpeed = 9600 ;
void setup()
{
SERVO1.Attach(servoPin) ;
pinMode(relayControlPin,OUTPUT) ;
pinMode (ledPin, sortie) ; définit la broche numérique en sortie
pinMode(AnalogNoseSensorPin,INPUT) ; accélérateur Poignée analogique 0
Serial.Begin(DebugSerialSpeed) ;
}
void loop()
{
digitalWrite (ledPin, HIGH) ; définit la LED sur
Delay(100) ; attend une seconde
digitalWrite (ledPin, basse) ; la LED se met
Delay(100) ; attend une seconde
SERVO1.Write(150); / / fermer la trappe
pinMode (servoPin, INPUT); //silence Servo
NoseLocationVal = analogRead(AnalogNoseSensorPin) ; Capteur optique
Si (NoseLocationVal < 50) {//Check si la souris est à l’intérieur
digitalWrite(relayControlPin,LOW) ; Il zap
Delay(1000); / / Zap pour 1 Sec
digitalWrite(relayControlPin,HIGH) ; Arrêter de Zap
pinMode(servoPin,OUTPUT) ; Activer le Servo
SERVO1.Write(20); / / trappe ouverte
Delay(2000); / / attente pour souris à tomber
SERVO1.Write(150); / / fermer la trappe
Delay(1000); / / attendre trappe fermer
}
d’autre digitalWrite(relayControlPin,HIGH) ; Aucun choc
Serial.println(NoseLocationVal) ;
}