Wendell der Roboter (19 / 21 schritt)

Schritt 19: Programm

//////////////////////////  ARDUINO /////////////////////
testet alle Servos und sound

#include < Servo.h >

Servo ArmRight;  Erstellen Sie Servo-Objekt um ein Servo Steuern
Int pos = 0;    Variable, die Servoposition speichern
Servo ArmLeft;
Servo-Kopf;
Servo WheelRight;
Servo WheelLeft;
Int SoundPin = 3;
Int-Stellplatz;

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) / / reicht von 0° bis 180°
{/ / in Schritten von 1 Grad
armLeft.write(pos);
armRight.write(pos);              Servo zu gehen, um die position in der Variable "pos" zu sagen
Head.Write(POS);
wheelRight.write(pos);
wheelLeft.write(pos);
Pitch = Karte (pos, 0, 180, 31,4978); Ton Position zuordnen
Ton (SoundPin, Steigung, 200);    PIN, Hinweis, Zeit?
Delay(15);                       wartet 15ms für das Servo in die Position zu erreichen
}
für (pos = 180; pos > = 1; pos = 1) / / geht von 180 Grad bis 0 Grad
{
armLeft.write(pos);
armRight.write(pos);              Servo zu gehen, um die position in der Variable "pos" zu sagen
Head.Write(POS);
wheelRight.write(pos);
wheelLeft.write(pos);
Pitch = Karte (pos, 0, 180, 31,1000);
Ton (SoundPin, Steigung, 200);    PIN, Hinweis, Zeit?
Delay(15);
} / / wartet 15ms für das Servo in die Position zu erreichen
}