Stap 13: Elektronica-draadloos helm schematische en code
Hier is het schema en de code voor de draadloze helm.
Aangezien er zeer weinig ruimte in de helm het radiosysteem werd aangedreven door een enkele 7.4V NiMH accu. De digitale servo's gebruikt in de helm zijn ontworpen om te worden geëxploiteerd op 7.4V dus een 5V DC/DC converter wordt gebruikt voor de stroomvoorziening voor de Arduino en XBee LEDs.
Hier is de code-
#include "Servo.h" / / de servo-bibliotheek
Servo faceplateServo;
Servo chinServo;
int ledPin1 = 4; controle pin voor LED ogen
int servoPin1 = 2; controle pin voor gezicht plaat servo
int servoPin2 = 3; controle pin voor kin
VOID Setup {}
faceplateServo.attach(servoPin1); de servo op pin 2 hecht aan de servo-object
chinServo.attach(servoPin2); de servo op pin 3 hecht aan de servo-object
faceplateServo.write(30); gezicht plaat servo op 30 graden te draaien
chinServo.write(95); kin servo tot 95 graden roteren
pinMode (ledPin1, OUTPUT); Hiermee stelt u de LED-pin als uitvoer
digitalWrite (ledPin1, hoge); Zet LED ogen
Serial.begin(9600);
}
void loop {}
zoekt u een hoofdletter A via de seriële poort en uitschakelen van de LED
Als (Serial.available() > 0) {}
Als (Serial.read() == 'A') {/ / label leest over XBee
digitalWrite (ledPin1, laag); zwenking vandoor LED ogen
delay(500); een halve seconde wachten
faceplateServo.write(95); de servo plaat gezicht tot 95 graden roteren
chinServo.write(20); de kin servo tot 20 graden draaien
delay(4000); 4 seconden
chinServo.write(95); de kin servo tot 95 graden roteren
faceplateServo.write(30); draaien van het gezicht plaat servo op 30 graden
digitalWrite (ledPin1, hoge); Zet LED ogen
}
}
}
