Wendell roboten (19 / 21 steg)
Steg 19: Program
Här är ett program som körs alla servon och en liten högtalare:////////////////////////// ARDUINO /////////////////////
testar alla servon och ljud
#include < Servo.h >
Servo armRight; skapa objekt för att styra en servo servo
int pos = 0; variabel att lagra servo position
Servo armLeft;
Servo huvud;
Servo wheelRight;
Servo wheelLeft;
int soundPin = 3;
int stigningen.
void setup()
{
armRight.attach(11);
Head.attach(10);
armLeft.attach(9);
wheelRight.attach(6);
wheelLeft.attach(5);
}
void loop()
{
för (pos = 0; pos < 180; pos + = 1) / / går från 0 grader till 180 grader
{/ / i steg om 1 grad
armLeft.write(pos);
armRight.write(pos); berätta servo gå för att placera i variabel "pos"
Head.write(POS);
wheelRight.write(pos);
wheelLeft.write(pos);
pitch = karta (pos, 0, 180, 31,4978); Mappa ställning till tonen
tonen (soundPin, pitch, 200); PIN, Obs, tid?
Delay(15); Waits 15 MS för servo att nå ställning
}
för (pos = 180, pos > = 1; pos-= 1) / / går från 180 grader till 0 grader
{
armLeft.write(pos);
armRight.write(pos); berätta servo gå för att placera i variabel "pos"
Head.write(POS);
wheelRight.write(pos);
wheelLeft.write(pos);
pitch = karta (pos, 0, 180, 31,1000);
tonen (soundPin, pitch, 200); PIN, Obs, tid?
Delay(15);
} / / väntar 15 MS för servo att nå ställning
}