Stap 19: programma
Hier is een programma dat wordt uitgevoerd van alle servo's en een kleine luidspreker:////////////////////////// ARDUINO /////////////////////
Test alle servo's en geluid
#include < Servo.h >
Servo armRight; maken van servo-object om te bepalen van een servo
int pos = 0; variabele op te slaan van de servo positie
Servo armLeft;
Servo hoofd;
Servo wheelRight;
Servo wheelLeft;
int soundPin = 3;
int de toonhoogte;
VOID Setup
{
armRight.attach(11);
Head.attach(10);
armLeft.attach(9);
wheelRight.attach(6);
wheelLeft.attach(5);
}
void loop
{
voor (pos = 0; pos < 180; pos += 1) / / gaat van 0 graden tot 180 graden
{/ / in stappen van 1 graad
armLeft.write(pos);
armRight.write(pos); servo naar positie in de variabele 'pos' vertellen
Head.write(POS);
wheelRight.write(pos);
wheelLeft.write(pos);
toonhoogte = kaart (pos, 0, 180, 31,4978); positie naar Toon kaart
Toon (soundPin, toonhoogte, 200); PIN, opmerking, tijd?
delay(15); wacht 15ms voor de servo te bereiken de positie
}
voor (pos = 180; pos > = 1; pos-= 1) / / gaat van 180 graden tot 0 graden
{
armLeft.write(pos);
armRight.write(pos); servo naar positie in de variabele 'pos' vertellen
Head.write(POS);
wheelRight.write(pos);
wheelLeft.write(pos);
toonhoogte = kaart (pos, 0, 180, 31,1000);
Toon (soundPin, toonhoogte, 200); PIN, opmerking, tijd?
delay(15);
} / / wacht 15ms voor de servo te bereiken de positie
}